12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400 |
- /******************************************************************************
- *
- * Copyright 1999-2012 Broadcom Corporation
- *
- * Licensed under the Apache License, Version 2.0 (the "License");
- * you may not use this file except in compliance with the License.
- * You may obtain a copy of the License at:
- *
- * http://www.apache.org/licenses/LICENSE-2.0
- *
- * Unless required by applicable law or agreed to in writing, software
- * distributed under the License is distributed on an "AS IS" BASIS,
- * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
- * See the License for the specific language governing permissions and
- * limitations under the License.
- *
- ******************************************************************************/
- /******************************************************************************
- *
- * This file contains the L2CAP channel state machine
- *
- ******************************************************************************/
- #include <stdio.h>
- #include <stdlib.h>
- #include <string.h>
- #include "bt_common.h"
- #include "bt_target.h"
- #include "btm_int.h"
- #include "btu.h"
- #include "common/time_util.h"
- #include "hcidefs.h"
- #include "hcimsgs.h"
- #include "l2c_int.h"
- #include "l2cdefs.h"
- /******************************************************************************/
- /* L O C A L F U N C T I O N P R O T O T Y P E S */
- /******************************************************************************/
- static void l2c_csm_closed(tL2C_CCB* p_ccb, uint16_t event, void* p_data);
- static void l2c_csm_orig_w4_sec_comp(tL2C_CCB* p_ccb, uint16_t event,
- void* p_data);
- static void l2c_csm_term_w4_sec_comp(tL2C_CCB* p_ccb, uint16_t event,
- void* p_data);
- static void l2c_csm_w4_l2cap_connect_rsp(tL2C_CCB* p_ccb, uint16_t event,
- void* p_data);
- static void l2c_csm_w4_l2ca_connect_rsp(tL2C_CCB* p_ccb, uint16_t event,
- void* p_data);
- static void l2c_csm_config(tL2C_CCB* p_ccb, uint16_t event, void* p_data);
- static void l2c_csm_open(tL2C_CCB* p_ccb, uint16_t event, void* p_data);
- static void l2c_csm_w4_l2cap_disconnect_rsp(tL2C_CCB* p_ccb, uint16_t event,
- void* p_data);
- static void l2c_csm_w4_l2ca_disconnect_rsp(tL2C_CCB* p_ccb, uint16_t event,
- void* p_data);
- static const char* l2c_csm_get_event_name(uint16_t event);
- /*******************************************************************************
- *
- * Function l2c_csm_execute
- *
- * Description This function executes the state machine.
- *
- * Returns void
- *
- ******************************************************************************/
- void l2c_csm_execute(tL2C_CCB* p_ccb, uint16_t event, void* p_data) {
- if (!l2cu_is_ccb_active(p_ccb)) {
- L2CAP_TRACE_WARNING("%s CCB not in use, event (%d) cannot be processed",
- __func__, event);
- return;
- }
- switch (p_ccb->chnl_state) {
- case CST_CLOSED:
- l2c_csm_closed(p_ccb, event, p_data);
- break;
- case CST_ORIG_W4_SEC_COMP:
- l2c_csm_orig_w4_sec_comp(p_ccb, event, p_data);
- break;
- case CST_TERM_W4_SEC_COMP:
- l2c_csm_term_w4_sec_comp(p_ccb, event, p_data);
- break;
- case CST_W4_L2CAP_CONNECT_RSP:
- l2c_csm_w4_l2cap_connect_rsp(p_ccb, event, p_data);
- break;
- case CST_W4_L2CA_CONNECT_RSP:
- l2c_csm_w4_l2ca_connect_rsp(p_ccb, event, p_data);
- break;
- case CST_CONFIG:
- l2c_csm_config(p_ccb, event, p_data);
- break;
- case CST_OPEN:
- l2c_csm_open(p_ccb, event, p_data);
- break;
- case CST_W4_L2CAP_DISCONNECT_RSP:
- l2c_csm_w4_l2cap_disconnect_rsp(p_ccb, event, p_data);
- break;
- case CST_W4_L2CA_DISCONNECT_RSP:
- l2c_csm_w4_l2ca_disconnect_rsp(p_ccb, event, p_data);
- break;
- default:
- L2CAP_TRACE_DEBUG("Unhandled event! event = %d", event);
- break;
- }
- }
- /*******************************************************************************
- *
- * Function l2c_csm_closed
- *
- * Description This function handles events when the channel is in
- * CLOSED state. This state exists only when the link is
- * being initially established.
- *
- * Returns void
- *
- ******************************************************************************/
- static void l2c_csm_closed(tL2C_CCB* p_ccb, uint16_t event, void* p_data) {
- tL2C_CONN_INFO* p_ci = (tL2C_CONN_INFO*)p_data;
- uint16_t local_cid = p_ccb->local_cid;
- tL2CA_DISCONNECT_IND_CB* disconnect_ind;
- tL2CA_CONNECT_CFM_CB* connect_cfm;
- if (p_ccb->p_rcb == NULL) {
- L2CAP_TRACE_ERROR("L2CAP - LCID: 0x%04x st: CLOSED evt: %s p_rcb == NULL",
- p_ccb->local_cid, l2c_csm_get_event_name(event));
- return;
- }
- disconnect_ind = p_ccb->p_rcb->api.pL2CA_DisconnectInd_Cb;
- connect_cfm = p_ccb->p_rcb->api.pL2CA_ConnectCfm_Cb;
- L2CAP_TRACE_EVENT("L2CAP - LCID: 0x%04x st: CLOSED evt: %s",
- p_ccb->local_cid, l2c_csm_get_event_name(event));
- switch (event) {
- case L2CEVT_LP_DISCONNECT_IND: /* Link was disconnected */
- L2CAP_TRACE_API(
- "L2CAP - Calling Disconnect_Ind_Cb(), CID: 0x%04x No Conf Needed",
- p_ccb->local_cid);
- l2cu_release_ccb(p_ccb);
- (*disconnect_ind)(local_cid, false);
- break;
- case L2CEVT_LP_CONNECT_CFM: /* Link came up */
- if (p_ccb->p_lcb->transport == BT_TRANSPORT_LE) {
- p_ccb->chnl_state = CST_ORIG_W4_SEC_COMP;
- l2ble_sec_access_req(p_ccb->p_lcb->remote_bd_addr, p_ccb->p_rcb->psm,
- true, &l2c_link_sec_comp2, p_ccb);
- } else {
- p_ccb->chnl_state = CST_ORIG_W4_SEC_COMP;
- btm_sec_l2cap_access_req(p_ccb->p_lcb->remote_bd_addr,
- p_ccb->p_rcb->psm, p_ccb->p_lcb->handle, true,
- &l2c_link_sec_comp, p_ccb);
- }
- break;
- case L2CEVT_LP_CONNECT_CFM_NEG: /* Link failed */
- /* Disconnect unless ACL collision and upper layer wants to handle it */
- if (p_ci->status != HCI_ERR_CONNECTION_EXISTS ||
- !btm_acl_notif_conn_collision(p_ccb->p_lcb->remote_bd_addr)) {
- L2CAP_TRACE_API(
- "L2CAP - Calling ConnectCfm_Cb(), CID: 0x%04x Status: %d",
- p_ccb->local_cid, p_ci->status);
- l2cu_release_ccb(p_ccb);
- (*connect_cfm)(local_cid, p_ci->status);
- }
- break;
- case L2CEVT_L2CA_CONNECT_REQ: /* API connect request */
- if (p_ccb->p_lcb->transport == BT_TRANSPORT_LE) {
- p_ccb->chnl_state = CST_ORIG_W4_SEC_COMP;
- l2ble_sec_access_req(p_ccb->p_lcb->remote_bd_addr, p_ccb->p_rcb->psm,
- true, &l2c_link_sec_comp2, p_ccb);
- } else {
- /* Cancel sniff mode if needed */
- tBTM_PM_PWR_MD settings;
- memset((void*)&settings, 0, sizeof(settings));
- settings.mode = BTM_PM_MD_ACTIVE;
- BTM_SetPowerMode(BTM_PM_SET_ONLY_ID, p_ccb->p_lcb->remote_bd_addr,
- &settings);
- /* If sec access does not result in started SEC_COM or COMP_NEG are
- * already processed */
- if (btm_sec_l2cap_access_req(p_ccb->p_lcb->remote_bd_addr,
- p_ccb->p_rcb->psm, p_ccb->p_lcb->handle,
- true, &l2c_link_sec_comp,
- p_ccb) == BTM_CMD_STARTED) {
- p_ccb->chnl_state = CST_ORIG_W4_SEC_COMP;
- }
- }
- break;
- case L2CEVT_SEC_COMP:
- p_ccb->chnl_state = CST_W4_L2CAP_CONNECT_RSP;
- /* Wait for the info resp in this state before sending connect req (if
- * needed) */
- if (!p_ccb->p_lcb->w4_info_rsp) {
- /* Need to have at least one compatible channel to continue */
- if (!l2c_fcr_chk_chan_modes(p_ccb)) {
- l2cu_release_ccb(p_ccb);
- (*p_ccb->p_rcb->api.pL2CA_ConnectCfm_Cb)(local_cid,
- L2CAP_CONN_NO_LINK);
- } else {
- l2cu_send_peer_connect_req(p_ccb);
- alarm_set_on_mloop(p_ccb->l2c_ccb_timer,
- L2CAP_CHNL_CONNECT_TIMEOUT_MS,
- l2c_ccb_timer_timeout, p_ccb);
- }
- }
- break;
- case L2CEVT_SEC_COMP_NEG: /* something is really bad with security */
- L2CAP_TRACE_API(
- "L2CAP - Calling ConnectCfm_Cb(), CID: 0x%04x Status: %d",
- p_ccb->local_cid, L2CAP_CONN_TIMEOUT);
- l2cu_release_ccb(p_ccb);
- (*connect_cfm)(local_cid, L2CAP_CONN_SECURITY_BLOCK);
- break;
- case L2CEVT_L2CAP_CONNECT_REQ: /* Peer connect request */
- /* stop link timer to avoid race condition between A2MP, Security, and
- * L2CAP */
- alarm_cancel(p_ccb->p_lcb->l2c_lcb_timer);
- if (p_ccb->p_lcb->transport == BT_TRANSPORT_LE) {
- p_ccb->chnl_state = CST_TERM_W4_SEC_COMP;
- tL2CAP_LE_RESULT_CODE result = l2ble_sec_access_req(
- p_ccb->p_lcb->remote_bd_addr, p_ccb->p_rcb->psm, false,
- &l2c_link_sec_comp2, p_ccb);
- switch (result) {
- case L2CAP_LE_RESULT_INSUFFICIENT_AUTHENTICATION:
- case L2CAP_LE_RESULT_INSUFFICIENT_ENCRYP_KEY_SIZE:
- case L2CAP_LE_RESULT_INSUFFICIENT_ENCRYP:
- l2cu_reject_ble_connection(p_ccb->p_lcb, p_ccb->remote_id, result);
- l2cu_release_ccb(p_ccb);
- break;
- // TODO: Handle the other return codes
- }
- } else {
- /* Cancel sniff mode if needed */
- {
- tBTM_PM_PWR_MD settings;
- memset((void*)&settings, 0, sizeof(settings));
- settings.mode = BTM_PM_MD_ACTIVE;
- BTM_SetPowerMode(BTM_PM_SET_ONLY_ID, p_ccb->p_lcb->remote_bd_addr,
- &settings);
- }
- p_ccb->chnl_state = CST_TERM_W4_SEC_COMP;
- if (btm_sec_l2cap_access_req(p_ccb->p_lcb->remote_bd_addr,
- p_ccb->p_rcb->psm, p_ccb->p_lcb->handle,
- false, &l2c_link_sec_comp,
- p_ccb) == BTM_CMD_STARTED) {
- /* started the security process, tell the peer to set a longer timer
- */
- l2cu_send_peer_connect_rsp(p_ccb, L2CAP_CONN_PENDING, 0);
- }
- }
- break;
- case L2CEVT_TIMEOUT:
- L2CAP_TRACE_API(
- "L2CAP - Calling ConnectCfm_Cb(), CID: 0x%04x Status: %d",
- p_ccb->local_cid, L2CAP_CONN_TIMEOUT);
- l2cu_release_ccb(p_ccb);
- (*connect_cfm)(local_cid, L2CAP_CONN_TIMEOUT);
- break;
- case L2CEVT_L2CAP_DATA: /* Peer data packet rcvd */
- case L2CEVT_L2CA_DATA_WRITE: /* Upper layer data to send */
- osi_free(p_data);
- break;
- case L2CEVT_L2CA_DISCONNECT_REQ: /* Upper wants to disconnect */
- l2cu_release_ccb(p_ccb);
- break;
- }
- }
- /*******************************************************************************
- *
- * Function l2c_csm_orig_w4_sec_comp
- *
- * Description This function handles events when the channel is in
- * CST_ORIG_W4_SEC_COMP state.
- *
- * Returns void
- *
- ******************************************************************************/
- static void l2c_csm_orig_w4_sec_comp(tL2C_CCB* p_ccb, uint16_t event,
- void* p_data) {
- tL2CA_DISCONNECT_IND_CB* disconnect_ind =
- p_ccb->p_rcb->api.pL2CA_DisconnectInd_Cb;
- tL2CA_CONNECT_CFM_CB* connect_cfm = p_ccb->p_rcb->api.pL2CA_ConnectCfm_Cb;
- uint16_t local_cid = p_ccb->local_cid;
- L2CAP_TRACE_EVENT(
- "%s: %sL2CAP - LCID: 0x%04x st: ORIG_W4_SEC_COMP evt: %s", __func__,
- ((p_ccb->p_lcb) && (p_ccb->p_lcb->transport == BT_TRANSPORT_LE)) ? "LE "
- : "",
- p_ccb->local_cid, l2c_csm_get_event_name(event));
- switch (event) {
- case L2CEVT_LP_DISCONNECT_IND: /* Link was disconnected */
- L2CAP_TRACE_API(
- "L2CAP - Calling Disconnect_Ind_Cb(), CID: 0x%04x No Conf Needed",
- p_ccb->local_cid);
- l2cu_release_ccb(p_ccb);
- (*disconnect_ind)(local_cid, false);
- break;
- case L2CEVT_SEC_RE_SEND_CMD: /* BTM has enough info to proceed */
- case L2CEVT_LP_CONNECT_CFM: /* Link came up */
- if (p_ccb->p_lcb->transport == BT_TRANSPORT_LE) {
- l2ble_sec_access_req(p_ccb->p_lcb->remote_bd_addr, p_ccb->p_rcb->psm,
- false, &l2c_link_sec_comp2, p_ccb);
- } else {
- btm_sec_l2cap_access_req(p_ccb->p_lcb->remote_bd_addr,
- p_ccb->p_rcb->psm, p_ccb->p_lcb->handle, true,
- &l2c_link_sec_comp, p_ccb);
- }
- break;
- case L2CEVT_SEC_COMP: /* Security completed success */
- /* Wait for the info resp in this state before sending connect req (if
- * needed) */
- p_ccb->chnl_state = CST_W4_L2CAP_CONNECT_RSP;
- if (p_ccb->p_lcb->transport == BT_TRANSPORT_LE) {
- alarm_set_on_mloop(p_ccb->l2c_ccb_timer, L2CAP_CHNL_CONNECT_TIMEOUT_MS,
- l2c_ccb_timer_timeout, p_ccb);
- l2cble_credit_based_conn_req(p_ccb); /* Start Connection */
- } else {
- if (!p_ccb->p_lcb->w4_info_rsp) {
- /* Need to have at least one compatible channel to continue */
- if (!l2c_fcr_chk_chan_modes(p_ccb)) {
- l2cu_release_ccb(p_ccb);
- (*connect_cfm)(local_cid, L2CAP_CONN_NO_LINK);
- } else {
- alarm_set_on_mloop(p_ccb->l2c_ccb_timer,
- L2CAP_CHNL_CONNECT_TIMEOUT_MS,
- l2c_ccb_timer_timeout, p_ccb);
- l2cu_send_peer_connect_req(p_ccb); /* Start Connection */
- }
- }
- }
- break;
- case L2CEVT_SEC_COMP_NEG:
- L2CAP_TRACE_API(
- "L2CAP - Calling ConnectCfm_Cb(), CID: 0x%04x Status: %d",
- p_ccb->local_cid, HCI_ERR_AUTH_FAILURE);
- /* If last channel immediately disconnect the ACL for better security.
- Also prevents a race condition between BTM and L2CAP */
- if ((p_ccb == p_ccb->p_lcb->ccb_queue.p_first_ccb) &&
- (p_ccb == p_ccb->p_lcb->ccb_queue.p_last_ccb)) {
- p_ccb->p_lcb->idle_timeout = 0;
- }
- l2cu_release_ccb(p_ccb);
- (*connect_cfm)(local_cid, HCI_ERR_AUTH_FAILURE);
- break;
- case L2CEVT_L2CA_DATA_WRITE: /* Upper layer data to send */
- case L2CEVT_L2CAP_DATA: /* Peer data packet rcvd */
- osi_free(p_data);
- break;
- case L2CEVT_L2CA_DISCONNECT_REQ: /* Upper wants to disconnect */
- /* Tell security manager to abort */
- btm_sec_abort_access_req(p_ccb->p_lcb->remote_bd_addr);
- l2cu_release_ccb(p_ccb);
- break;
- }
- }
- /*******************************************************************************
- *
- * Function l2c_csm_term_w4_sec_comp
- *
- * Description This function handles events when the channel is in
- * CST_TERM_W4_SEC_COMP state.
- *
- * Returns void
- *
- ******************************************************************************/
- static void l2c_csm_term_w4_sec_comp(tL2C_CCB* p_ccb, uint16_t event,
- void* p_data) {
- L2CAP_TRACE_EVENT("L2CAP - LCID: 0x%04x st: TERM_W4_SEC_COMP evt: %s",
- p_ccb->local_cid, l2c_csm_get_event_name(event));
- switch (event) {
- case L2CEVT_LP_DISCONNECT_IND: /* Link was disconnected */
- /* Tell security manager to abort */
- btm_sec_abort_access_req(p_ccb->p_lcb->remote_bd_addr);
- l2cu_release_ccb(p_ccb);
- break;
- case L2CEVT_SEC_COMP:
- p_ccb->chnl_state = CST_W4_L2CA_CONNECT_RSP;
- /* Wait for the info resp in next state before sending connect ind (if
- * needed) */
- if (!p_ccb->p_lcb->w4_info_rsp) {
- /* Don't need to get info from peer or already retrieved so continue */
- alarm_set_on_mloop(p_ccb->l2c_ccb_timer, L2CAP_CHNL_CONNECT_TIMEOUT_MS,
- l2c_ccb_timer_timeout, p_ccb);
- L2CAP_TRACE_API("L2CAP - Calling Connect_Ind_Cb(), CID: 0x%04x",
- p_ccb->local_cid);
- (*p_ccb->p_rcb->api.pL2CA_ConnectInd_Cb)(
- p_ccb->p_lcb->remote_bd_addr, p_ccb->local_cid, p_ccb->p_rcb->psm,
- p_ccb->remote_id);
- } else {
- /*
- ** L2CAP Connect Response will be sent out by 3 sec timer expiration
- ** because Bluesoleil doesn't respond to L2CAP Information Request.
- ** Bluesoleil seems to disconnect ACL link as failure case, because
- ** it takes too long (4~7secs) to get response.
- ** product version : Bluesoleil 2.1.1.0 EDR Release 060123
- ** stack version : 05.04.11.20060119
- */
- /* Waiting for the info resp, tell the peer to set a longer timer */
- l2cu_send_peer_connect_rsp(p_ccb, L2CAP_CONN_PENDING, 0);
- }
- break;
- case L2CEVT_SEC_COMP_NEG:
- if (((tL2C_CONN_INFO*)p_data)->status == BTM_DELAY_CHECK) {
- /* start a timer - encryption change not received before L2CAP connect
- * req */
- alarm_set_on_mloop(p_ccb->l2c_ccb_timer,
- L2CAP_DELAY_CHECK_SM4_TIMEOUT_MS,
- l2c_ccb_timer_timeout, p_ccb);
- } else {
- if (p_ccb->p_lcb->transport == BT_TRANSPORT_LE)
- l2cu_reject_ble_connection(
- p_ccb->p_lcb, p_ccb->remote_id,
- L2CAP_LE_RESULT_INSUFFICIENT_AUTHENTICATION);
- else
- l2cu_send_peer_connect_rsp(p_ccb, L2CAP_CONN_SECURITY_BLOCK, 0);
- l2cu_release_ccb(p_ccb);
- }
- break;
- case L2CEVT_L2CA_DATA_WRITE: /* Upper layer data to send */
- case L2CEVT_L2CAP_DATA: /* Peer data packet rcvd */
- osi_free(p_data);
- break;
- case L2CEVT_L2CA_DISCONNECT_REQ: /* Upper wants to disconnect */
- l2cu_release_ccb(p_ccb);
- break;
- case L2CEVT_L2CAP_DISCONNECT_REQ: /* Peer disconnected request */
- l2cu_send_peer_disc_rsp(p_ccb->p_lcb, p_ccb->remote_id, p_ccb->local_cid,
- p_ccb->remote_cid);
- /* Tell security manager to abort */
- btm_sec_abort_access_req(p_ccb->p_lcb->remote_bd_addr);
- l2cu_release_ccb(p_ccb);
- break;
- case L2CEVT_TIMEOUT:
- /* SM4 related. */
- btsnd_hcic_disconnect(p_ccb->p_lcb->handle, HCI_ERR_AUTH_FAILURE);
- break;
- case L2CEVT_SEC_RE_SEND_CMD: /* BTM has enough info to proceed */
- btm_sec_l2cap_access_req(p_ccb->p_lcb->remote_bd_addr, p_ccb->p_rcb->psm,
- p_ccb->p_lcb->handle, false, &l2c_link_sec_comp,
- p_ccb);
- break;
- }
- }
- /*******************************************************************************
- *
- * Function l2c_csm_w4_l2cap_connect_rsp
- *
- * Description This function handles events when the channel is in
- * CST_W4_L2CAP_CONNECT_RSP state.
- *
- * Returns void
- *
- ******************************************************************************/
- static void l2c_csm_w4_l2cap_connect_rsp(tL2C_CCB* p_ccb, uint16_t event,
- void* p_data) {
- tL2C_CONN_INFO* p_ci = (tL2C_CONN_INFO*)p_data;
- tL2CA_DISCONNECT_IND_CB* disconnect_ind =
- p_ccb->p_rcb->api.pL2CA_DisconnectInd_Cb;
- tL2CA_CONNECT_CFM_CB* connect_cfm = p_ccb->p_rcb->api.pL2CA_ConnectCfm_Cb;
- uint16_t local_cid = p_ccb->local_cid;
- L2CAP_TRACE_EVENT("L2CAP - LCID: 0x%04x st: W4_L2CAP_CON_RSP evt: %s",
- p_ccb->local_cid, l2c_csm_get_event_name(event));
- switch (event) {
- case L2CEVT_LP_DISCONNECT_IND: /* Link was disconnected */
- /* Send disc indication unless peer to peer race condition AND normal
- * disconnect */
- /* *((uint8_t *)p_data) != HCI_ERR_PEER_USER happens when peer device try
- * to disconnect for normal reason */
- p_ccb->chnl_state = CST_CLOSED;
- if ((p_ccb->flags & CCB_FLAG_NO_RETRY) || !p_data ||
- (*((uint8_t*)p_data) != HCI_ERR_PEER_USER)) {
- L2CAP_TRACE_API(
- "L2CAP - Calling Disconnect_Ind_Cb(), CID: 0x%04x No Conf Needed",
- p_ccb->local_cid);
- l2cu_release_ccb(p_ccb);
- (*disconnect_ind)(local_cid, false);
- }
- p_ccb->flags |= CCB_FLAG_NO_RETRY;
- break;
- case L2CEVT_L2CAP_CONNECT_RSP: /* Got peer connect confirm */
- p_ccb->remote_cid = p_ci->remote_cid;
- if (p_ccb->p_lcb->transport == BT_TRANSPORT_LE) {
- /* Connection is completed */
- alarm_cancel(p_ccb->l2c_ccb_timer);
- p_ccb->chnl_state = CST_OPEN;
- } else {
- p_ccb->chnl_state = CST_CONFIG;
- alarm_set_on_mloop(p_ccb->l2c_ccb_timer, L2CAP_CHNL_CFG_TIMEOUT_MS,
- l2c_ccb_timer_timeout, p_ccb);
- }
- L2CAP_TRACE_API("L2CAP - Calling Connect_Cfm_Cb(), CID: 0x%04x, Success",
- p_ccb->local_cid);
- (*p_ccb->p_rcb->api.pL2CA_ConnectCfm_Cb)(local_cid, L2CAP_CONN_OK);
- break;
- case L2CEVT_L2CAP_CONNECT_RSP_PND: /* Got peer connect pending */
- p_ccb->remote_cid = p_ci->remote_cid;
- alarm_set_on_mloop(p_ccb->l2c_ccb_timer,
- L2CAP_CHNL_CONNECT_EXT_TIMEOUT_MS,
- l2c_ccb_timer_timeout, p_ccb);
- if (p_ccb->p_rcb->api.pL2CA_ConnectPnd_Cb) {
- L2CAP_TRACE_API("L2CAP - Calling Connect_Pnd_Cb(), CID: 0x%04x",
- p_ccb->local_cid);
- (*p_ccb->p_rcb->api.pL2CA_ConnectPnd_Cb)(p_ccb->local_cid);
- }
- break;
- case L2CEVT_L2CAP_CONNECT_RSP_NEG: /* Peer rejected connection */
- LOG(WARNING) << __func__ << ": L2CAP connection rejected, lcid="
- << loghex(p_ccb->local_cid)
- << ", reason=" << loghex(p_ci->l2cap_result);
- l2cu_release_ccb(p_ccb);
- (*connect_cfm)(local_cid, p_ci->l2cap_result);
- break;
- case L2CEVT_TIMEOUT:
- LOG(WARNING) << __func__ << ": L2CAP connection timeout, lcid="
- << loghex(p_ccb->local_cid);
- l2cu_release_ccb(p_ccb);
- (*connect_cfm)(local_cid, L2CAP_CONN_TIMEOUT);
- break;
- case L2CEVT_L2CA_DISCONNECT_REQ: /* Upper wants to disconnect */
- /* If we know peer CID from connect pending, we can send disconnect */
- if (p_ccb->remote_cid != 0) {
- l2cu_send_peer_disc_req(p_ccb);
- p_ccb->chnl_state = CST_W4_L2CAP_DISCONNECT_RSP;
- alarm_set_on_mloop(p_ccb->l2c_ccb_timer,
- L2CAP_CHNL_DISCONNECT_TIMEOUT_MS,
- l2c_ccb_timer_timeout, p_ccb);
- } else {
- tL2CA_DISCONNECT_CFM_CB* disconnect_cfm =
- p_ccb->p_rcb->api.pL2CA_DisconnectCfm_Cb;
- l2cu_release_ccb(p_ccb);
- if (disconnect_cfm) {
- L2CAP_TRACE_API("%s: L2CAP - Calling DisconnectCfm_Cb(), CID: 0x%04x",
- __func__, local_cid);
- (*disconnect_cfm)(local_cid, L2CAP_CONN_NO_LINK);
- }
- }
- break;
- case L2CEVT_L2CA_DATA_WRITE: /* Upper layer data to send */
- case L2CEVT_L2CAP_DATA: /* Peer data packet rcvd */
- osi_free(p_data);
- break;
- case L2CEVT_L2CAP_INFO_RSP:
- /* Need to have at least one compatible channel to continue */
- if (!l2c_fcr_chk_chan_modes(p_ccb)) {
- l2cu_release_ccb(p_ccb);
- (*connect_cfm)(local_cid, L2CAP_CONN_NO_LINK);
- } else {
- /* We have feature info, so now send peer connect request */
- alarm_set_on_mloop(p_ccb->l2c_ccb_timer, L2CAP_CHNL_CONNECT_TIMEOUT_MS,
- l2c_ccb_timer_timeout, p_ccb);
- l2cu_send_peer_connect_req(p_ccb); /* Start Connection */
- }
- break;
- }
- }
- /*******************************************************************************
- *
- * Function l2c_csm_w4_l2ca_connect_rsp
- *
- * Description This function handles events when the channel is in
- * CST_W4_L2CA_CONNECT_RSP state.
- *
- * Returns void
- *
- ******************************************************************************/
- static void l2c_csm_w4_l2ca_connect_rsp(tL2C_CCB* p_ccb, uint16_t event,
- void* p_data) {
- tL2C_CONN_INFO* p_ci;
- tL2CA_DISCONNECT_IND_CB* disconnect_ind =
- p_ccb->p_rcb->api.pL2CA_DisconnectInd_Cb;
- uint16_t local_cid = p_ccb->local_cid;
- L2CAP_TRACE_EVENT("L2CAP - LCID: 0x%04x st: W4_L2CA_CON_RSP evt: %s",
- p_ccb->local_cid, l2c_csm_get_event_name(event));
- switch (event) {
- case L2CEVT_LP_DISCONNECT_IND: /* Link was disconnected */
- L2CAP_TRACE_API(
- "L2CAP - Calling Disconnect_Ind_Cb(), CID: 0x%04x No Conf Needed",
- p_ccb->local_cid);
- l2cu_release_ccb(p_ccb);
- (*disconnect_ind)(local_cid, false);
- break;
- case L2CEVT_L2CA_CONNECT_RSP:
- p_ci = (tL2C_CONN_INFO*)p_data;
- if (p_ccb->p_lcb->transport == BT_TRANSPORT_LE) {
- /* Result should be OK or Reject */
- if ((!p_ci) || (p_ci->l2cap_result == L2CAP_CONN_OK)) {
- l2cble_credit_based_conn_res(p_ccb, L2CAP_CONN_OK);
- p_ccb->chnl_state = CST_OPEN;
- alarm_cancel(p_ccb->l2c_ccb_timer);
- } else {
- l2cble_credit_based_conn_res(p_ccb, p_ci->l2cap_result);
- l2cu_release_ccb(p_ccb);
- }
- } else {
- /* Result should be OK or PENDING */
- if ((!p_ci) || (p_ci->l2cap_result == L2CAP_CONN_OK)) {
- l2cu_send_peer_connect_rsp(p_ccb, L2CAP_CONN_OK, 0);
- p_ccb->chnl_state = CST_CONFIG;
- alarm_set_on_mloop(p_ccb->l2c_ccb_timer, L2CAP_CHNL_CFG_TIMEOUT_MS,
- l2c_ccb_timer_timeout, p_ccb);
- } else {
- /* If pending, stay in same state and start extended timer */
- l2cu_send_peer_connect_rsp(p_ccb, p_ci->l2cap_result,
- p_ci->l2cap_status);
- alarm_set_on_mloop(p_ccb->l2c_ccb_timer,
- L2CAP_CHNL_CONNECT_EXT_TIMEOUT_MS,
- l2c_ccb_timer_timeout, p_ccb);
- }
- }
- break;
- case L2CEVT_L2CA_CONNECT_RSP_NEG:
- p_ci = (tL2C_CONN_INFO*)p_data;
- if (p_ccb->p_lcb->transport == BT_TRANSPORT_LE)
- l2cble_credit_based_conn_res(p_ccb, p_ci->l2cap_result);
- else
- l2cu_send_peer_connect_rsp(p_ccb, p_ci->l2cap_result,
- p_ci->l2cap_status);
- l2cu_release_ccb(p_ccb);
- break;
- case L2CEVT_TIMEOUT:
- l2cu_send_peer_connect_rsp(p_ccb, L2CAP_CONN_NO_PSM, 0);
- L2CAP_TRACE_API(
- "L2CAP - Calling Disconnect_Ind_Cb(), CID: 0x%04x No Conf Needed",
- p_ccb->local_cid);
- l2cu_release_ccb(p_ccb);
- (*disconnect_ind)(local_cid, false);
- break;
- case L2CEVT_L2CA_DATA_WRITE: /* Upper layer data to send */
- case L2CEVT_L2CAP_DATA: /* Peer data packet rcvd */
- osi_free(p_data);
- break;
- case L2CEVT_L2CA_DISCONNECT_REQ: /* Upper wants to disconnect */
- l2cu_send_peer_disc_req(p_ccb);
- p_ccb->chnl_state = CST_W4_L2CAP_DISCONNECT_RSP;
- alarm_set_on_mloop(p_ccb->l2c_ccb_timer, L2CAP_CHNL_DISCONNECT_TIMEOUT_MS,
- l2c_ccb_timer_timeout, p_ccb);
- break;
- case L2CEVT_L2CAP_INFO_RSP:
- /* We have feature info, so now give the upper layer connect IND */
- alarm_set_on_mloop(p_ccb->l2c_ccb_timer, L2CAP_CHNL_CONNECT_TIMEOUT_MS,
- l2c_ccb_timer_timeout, p_ccb);
- L2CAP_TRACE_API("L2CAP - Calling Connect_Ind_Cb(), CID: 0x%04x",
- p_ccb->local_cid);
- (*p_ccb->p_rcb->api.pL2CA_ConnectInd_Cb)(
- p_ccb->p_lcb->remote_bd_addr, p_ccb->local_cid, p_ccb->p_rcb->psm,
- p_ccb->remote_id);
- break;
- }
- }
- /*******************************************************************************
- *
- * Function l2c_csm_config
- *
- * Description This function handles events when the channel is in
- * CONFIG state.
- *
- * Returns void
- *
- ******************************************************************************/
- static void l2c_csm_config(tL2C_CCB* p_ccb, uint16_t event, void* p_data) {
- tL2CAP_CFG_INFO* p_cfg = (tL2CAP_CFG_INFO*)p_data;
- tL2CA_DISCONNECT_IND_CB* disconnect_ind =
- p_ccb->p_rcb->api.pL2CA_DisconnectInd_Cb;
- uint16_t local_cid = p_ccb->local_cid;
- uint8_t cfg_result;
- L2CAP_TRACE_EVENT("L2CAP - LCID: 0x%04x st: CONFIG evt: %s",
- p_ccb->local_cid, l2c_csm_get_event_name(event));
- switch (event) {
- case L2CEVT_LP_DISCONNECT_IND: /* Link was disconnected */
- L2CAP_TRACE_API(
- "L2CAP - Calling Disconnect_Ind_Cb(), CID: 0x%04x No Conf Needed",
- p_ccb->local_cid);
- l2cu_release_ccb(p_ccb);
- (*disconnect_ind)(local_cid, false);
- break;
- case L2CEVT_L2CAP_CONFIG_REQ: /* Peer config request */
- cfg_result = l2cu_process_peer_cfg_req(p_ccb, p_cfg);
- if (cfg_result == L2CAP_PEER_CFG_OK) {
- L2CAP_TRACE_EVENT(
- "L2CAP - Calling Config_Req_Cb(), CID: 0x%04x, C-bit %d",
- p_ccb->local_cid, (p_cfg->flags & L2CAP_CFG_FLAGS_MASK_CONT));
- (*p_ccb->p_rcb->api.pL2CA_ConfigInd_Cb)(p_ccb->local_cid, p_cfg);
- } else if (cfg_result == L2CAP_PEER_CFG_DISCONNECT) {
- /* Disconnect if channels are incompatible */
- L2CAP_TRACE_EVENT("L2CAP - incompatible configurations disconnect");
- l2cu_disconnect_chnl(p_ccb);
- } else /* Return error to peer so he can renegotiate if possible */
- {
- L2CAP_TRACE_EVENT(
- "L2CAP - incompatible configurations trying reconfig");
- l2cu_send_peer_config_rsp(p_ccb, p_cfg);
- }
- break;
- case L2CEVT_L2CAP_CONFIG_RSP: /* Peer config response */
- l2cu_process_peer_cfg_rsp(p_ccb, p_cfg);
- if (p_cfg->result != L2CAP_CFG_PENDING) {
- /* TBD: When config options grow beyong minimum MTU (48 bytes)
- * logic needs to be added to handle responses with
- * continuation bit set in flags field.
- * 1. Send additional config request out until C-bit is cleared in
- * response
- */
- p_ccb->config_done |= OB_CFG_DONE;
- if (p_ccb->config_done & IB_CFG_DONE) {
- /* Verify two sides are in compatible modes before continuing */
- if (p_ccb->our_cfg.fcr.mode != p_ccb->peer_cfg.fcr.mode) {
- l2cu_send_peer_disc_req(p_ccb);
- L2CAP_TRACE_WARNING(
- "L2CAP - Calling Disconnect_Ind_Cb(Incompatible CFG), CID: "
- "0x%04x No Conf Needed",
- p_ccb->local_cid);
- l2cu_release_ccb(p_ccb);
- (*disconnect_ind)(local_cid, false);
- break;
- }
- p_ccb->config_done |= RECONFIG_FLAG;
- p_ccb->chnl_state = CST_OPEN;
- l2c_link_adjust_chnl_allocation();
- alarm_cancel(p_ccb->l2c_ccb_timer);
- /* If using eRTM and waiting for an ACK, restart the ACK timer */
- if (p_ccb->fcrb.wait_ack) l2c_fcr_start_timer(p_ccb);
- /*
- ** check p_ccb->our_cfg.fcr.mon_tout and
- *p_ccb->our_cfg.fcr.rtrans_tout
- ** we may set them to zero when sending config request during
- *renegotiation
- */
- if ((p_ccb->our_cfg.fcr.mode == L2CAP_FCR_ERTM_MODE) &&
- ((p_ccb->our_cfg.fcr.mon_tout == 0) ||
- (p_ccb->our_cfg.fcr.rtrans_tout))) {
- l2c_fcr_adj_monitor_retran_timeout(p_ccb);
- }
- #if (L2CAP_ERTM_STATS == TRUE)
- p_ccb->fcrb.connect_tick_count =
- bluetooth::common::time_get_os_boottime_ms();
- #endif
- /* See if we can forward anything on the hold queue */
- if (!fixed_queue_is_empty(p_ccb->xmit_hold_q)) {
- l2c_link_check_send_pkts(p_ccb->p_lcb, NULL, NULL);
- }
- }
- }
- L2CAP_TRACE_API("L2CAP - Calling Config_Rsp_Cb(), CID: 0x%04x",
- p_ccb->local_cid);
- (*p_ccb->p_rcb->api.pL2CA_ConfigCfm_Cb)(p_ccb->local_cid, p_cfg);
- break;
- case L2CEVT_L2CAP_CONFIG_RSP_NEG: /* Peer config error rsp */
- /* Disable the Timer */
- alarm_cancel(p_ccb->l2c_ccb_timer);
- /* If failure was channel mode try to renegotiate */
- if (!l2c_fcr_renegotiate_chan(p_ccb, p_cfg)) {
- L2CAP_TRACE_API(
- "L2CAP - Calling Config_Rsp_Cb(), CID: 0x%04x, Failure: %d",
- p_ccb->local_cid, p_cfg->result);
- (*p_ccb->p_rcb->api.pL2CA_ConfigCfm_Cb)(p_ccb->local_cid, p_cfg);
- }
- break;
- case L2CEVT_L2CAP_DISCONNECT_REQ: /* Peer disconnected request */
- alarm_set_on_mloop(p_ccb->l2c_ccb_timer, L2CAP_CHNL_DISCONNECT_TIMEOUT_MS,
- l2c_ccb_timer_timeout, p_ccb);
- p_ccb->chnl_state = CST_W4_L2CA_DISCONNECT_RSP;
- L2CAP_TRACE_API(
- "L2CAP - Calling Disconnect_Ind_Cb(), CID: 0x%04x Conf Needed",
- p_ccb->local_cid);
- (*p_ccb->p_rcb->api.pL2CA_DisconnectInd_Cb)(p_ccb->local_cid, true);
- break;
- case L2CEVT_L2CA_CONFIG_REQ: /* Upper layer config req */
- l2cu_process_our_cfg_req(p_ccb, p_cfg);
- l2cu_send_peer_config_req(p_ccb, p_cfg);
- alarm_set_on_mloop(p_ccb->l2c_ccb_timer, L2CAP_CHNL_CFG_TIMEOUT_MS,
- l2c_ccb_timer_timeout, p_ccb);
- break;
- case L2CEVT_L2CA_CONFIG_RSP: /* Upper layer config rsp */
- l2cu_process_our_cfg_rsp(p_ccb, p_cfg);
- /* Not finished if continuation flag is set */
- if ((p_cfg->flags & L2CAP_CFG_FLAGS_MASK_CONT) ||
- (p_cfg->result == L2CAP_CFG_PENDING)) {
- /* Send intermediate response; remain in cfg state */
- l2cu_send_peer_config_rsp(p_ccb, p_cfg);
- break;
- }
- /* Local config done; clear cached configuration in case reconfig takes
- * place later */
- p_ccb->peer_cfg.mtu_present = false;
- p_ccb->peer_cfg.flush_to_present = false;
- p_ccb->peer_cfg.qos_present = false;
- p_ccb->config_done |= IB_CFG_DONE;
- if (p_ccb->config_done & OB_CFG_DONE) {
- /* Verify two sides are in compatible modes before continuing */
- if (p_ccb->our_cfg.fcr.mode != p_ccb->peer_cfg.fcr.mode) {
- l2cu_send_peer_disc_req(p_ccb);
- L2CAP_TRACE_WARNING(
- "L2CAP - Calling Disconnect_Ind_Cb(Incompatible CFG), CID: "
- "0x%04x No Conf Needed",
- p_ccb->local_cid);
- l2cu_release_ccb(p_ccb);
- (*disconnect_ind)(local_cid, false);
- break;
- }
- p_ccb->config_done |= RECONFIG_FLAG;
- p_ccb->chnl_state = CST_OPEN;
- l2c_link_adjust_chnl_allocation();
- alarm_cancel(p_ccb->l2c_ccb_timer);
- }
- l2cu_send_peer_config_rsp(p_ccb, p_cfg);
- /* If using eRTM and waiting for an ACK, restart the ACK timer */
- if (p_ccb->fcrb.wait_ack) l2c_fcr_start_timer(p_ccb);
- #if (L2CAP_ERTM_STATS == TRUE)
- p_ccb->fcrb.connect_tick_count =
- bluetooth::common::time_get_os_boottime_ms();
- #endif
- /* See if we can forward anything on the hold queue */
- if ((p_ccb->chnl_state == CST_OPEN) &&
- (!fixed_queue_is_empty(p_ccb->xmit_hold_q))) {
- l2c_link_check_send_pkts(p_ccb->p_lcb, NULL, NULL);
- }
- break;
- case L2CEVT_L2CA_CONFIG_RSP_NEG: /* Upper layer config reject */
- l2cu_send_peer_config_rsp(p_ccb, p_cfg);
- alarm_set_on_mloop(p_ccb->l2c_ccb_timer, L2CAP_CHNL_CFG_TIMEOUT_MS,
- l2c_ccb_timer_timeout, p_ccb);
- break;
- case L2CEVT_L2CA_DISCONNECT_REQ: /* Upper wants to disconnect */
- l2cu_send_peer_disc_req(p_ccb);
- p_ccb->chnl_state = CST_W4_L2CAP_DISCONNECT_RSP;
- alarm_set_on_mloop(p_ccb->l2c_ccb_timer, L2CAP_CHNL_DISCONNECT_TIMEOUT_MS,
- l2c_ccb_timer_timeout, p_ccb);
- break;
- case L2CEVT_L2CAP_DATA: /* Peer data packet rcvd */
- L2CAP_TRACE_API("L2CAP - Calling DataInd_Cb(), CID: 0x%04x",
- p_ccb->local_cid);
- #if (L2CAP_NUM_FIXED_CHNLS > 0)
- if (p_ccb->local_cid >= L2CAP_FIRST_FIXED_CHNL &&
- p_ccb->local_cid <= L2CAP_LAST_FIXED_CHNL) {
- if (p_ccb->local_cid < L2CAP_BASE_APPL_CID) {
- if (l2cb.fixed_reg[p_ccb->local_cid - L2CAP_FIRST_FIXED_CHNL]
- .pL2CA_FixedData_Cb)
- (*l2cb.fixed_reg[p_ccb->local_cid - L2CAP_FIRST_FIXED_CHNL]
- .pL2CA_FixedData_Cb)(p_ccb->local_cid,
- p_ccb->p_lcb->remote_bd_addr,
- (BT_HDR*)p_data);
- else
- osi_free(p_data);
- break;
- }
- }
- #endif
- (*p_ccb->p_rcb->api.pL2CA_DataInd_Cb)(p_ccb->local_cid, (BT_HDR*)p_data);
- break;
- case L2CEVT_L2CA_DATA_WRITE: /* Upper layer data to send */
- if (p_ccb->config_done & OB_CFG_DONE)
- l2c_enqueue_peer_data(p_ccb, (BT_HDR*)p_data);
- else
- osi_free(p_data);
- break;
- case L2CEVT_TIMEOUT:
- l2cu_send_peer_disc_req(p_ccb);
- L2CAP_TRACE_API(
- "L2CAP - Calling Disconnect_Ind_Cb(), CID: 0x%04x No Conf Needed",
- p_ccb->local_cid);
- l2cu_release_ccb(p_ccb);
- (*disconnect_ind)(local_cid, false);
- break;
- }
- }
- /*******************************************************************************
- *
- * Function l2c_csm_open
- *
- * Description This function handles events when the channel is in
- * OPEN state.
- *
- * Returns void
- *
- ******************************************************************************/
- static void l2c_csm_open(tL2C_CCB* p_ccb, uint16_t event, void* p_data) {
- uint16_t local_cid = p_ccb->local_cid;
- tL2CAP_CFG_INFO* p_cfg;
- tL2C_CHNL_STATE tempstate;
- uint8_t tempcfgdone;
- uint8_t cfg_result;
- uint16_t* credit;
- L2CAP_TRACE_EVENT("L2CAP - LCID: 0x%04x st: OPEN evt: %s", p_ccb->local_cid,
- l2c_csm_get_event_name(event));
- switch (event) {
- case L2CEVT_LP_DISCONNECT_IND: /* Link was disconnected */
- L2CAP_TRACE_API(
- "L2CAP - Calling Disconnect_Ind_Cb(), CID: 0x%04x No Conf Needed",
- p_ccb->local_cid);
- l2cu_release_ccb(p_ccb);
- if (p_ccb->p_rcb)
- (*p_ccb->p_rcb->api.pL2CA_DisconnectInd_Cb)(local_cid, false);
- break;
- case L2CEVT_LP_QOS_VIOLATION_IND: /* QOS violation */
- /* Tell upper layer. If service guaranteed, then clear the channel */
- if (p_ccb->p_rcb->api.pL2CA_QoSViolationInd_Cb)
- (*p_ccb->p_rcb->api.pL2CA_QoSViolationInd_Cb)(
- p_ccb->p_lcb->remote_bd_addr);
- break;
- case L2CEVT_L2CAP_CONFIG_REQ: /* Peer config request */
- p_cfg = (tL2CAP_CFG_INFO*)p_data;
- tempstate = p_ccb->chnl_state;
- tempcfgdone = p_ccb->config_done;
- p_ccb->chnl_state = CST_CONFIG;
- p_ccb->config_done &= ~IB_CFG_DONE;
- alarm_set_on_mloop(p_ccb->l2c_ccb_timer, L2CAP_CHNL_CFG_TIMEOUT_MS,
- l2c_ccb_timer_timeout, p_ccb);
- cfg_result = l2cu_process_peer_cfg_req(p_ccb, p_cfg);
- if (cfg_result == L2CAP_PEER_CFG_OK) {
- (*p_ccb->p_rcb->api.pL2CA_ConfigInd_Cb)(p_ccb->local_cid, p_cfg);
- }
- /* Error in config parameters: reset state and config flag */
- else if (cfg_result == L2CAP_PEER_CFG_UNACCEPTABLE) {
- alarm_cancel(p_ccb->l2c_ccb_timer);
- p_ccb->chnl_state = tempstate;
- p_ccb->config_done = tempcfgdone;
- l2cu_send_peer_config_rsp(p_ccb, p_cfg);
- } else /* L2CAP_PEER_CFG_DISCONNECT */
- {
- /* Disconnect if channels are incompatible
- * Note this should not occur if reconfigure
- * since this should have never passed original config.
- */
- l2cu_disconnect_chnl(p_ccb);
- }
- break;
- case L2CEVT_L2CAP_DISCONNECT_REQ: /* Peer disconnected request */
- if (p_ccb->p_lcb->transport != BT_TRANSPORT_LE) {
- /* Make sure we are not in sniff mode */
- {
- tBTM_PM_PWR_MD settings;
- memset((void*)&settings, 0, sizeof(settings));
- settings.mode = BTM_PM_MD_ACTIVE;
- BTM_SetPowerMode(BTM_PM_SET_ONLY_ID, p_ccb->p_lcb->remote_bd_addr,
- &settings);
- }
- }
- p_ccb->chnl_state = CST_W4_L2CA_DISCONNECT_RSP;
- alarm_set_on_mloop(p_ccb->l2c_ccb_timer, L2CAP_CHNL_DISCONNECT_TIMEOUT_MS,
- l2c_ccb_timer_timeout, p_ccb);
- L2CAP_TRACE_API(
- "L2CAP - Calling Disconnect_Ind_Cb(), CID: 0x%04x Conf Needed",
- p_ccb->local_cid);
- (*p_ccb->p_rcb->api.pL2CA_DisconnectInd_Cb)(p_ccb->local_cid, true);
- break;
- case L2CEVT_L2CAP_DATA: /* Peer data packet rcvd */
- if ((p_ccb->p_rcb) && (p_ccb->p_rcb->api.pL2CA_DataInd_Cb))
- (*p_ccb->p_rcb->api.pL2CA_DataInd_Cb)(p_ccb->local_cid,
- (BT_HDR*)p_data);
- break;
- case L2CEVT_L2CA_DISCONNECT_REQ: /* Upper wants to disconnect */
- if (p_ccb->p_lcb->transport != BT_TRANSPORT_LE) {
- /* Make sure we are not in sniff mode */
- {
- tBTM_PM_PWR_MD settings;
- memset((void*)&settings, 0, sizeof(settings));
- settings.mode = BTM_PM_MD_ACTIVE;
- BTM_SetPowerMode(BTM_PM_SET_ONLY_ID, p_ccb->p_lcb->remote_bd_addr,
- &settings);
- }
- }
- if (p_ccb->p_lcb->transport == BT_TRANSPORT_LE)
- l2cble_send_peer_disc_req(p_ccb);
- else
- l2cu_send_peer_disc_req(p_ccb);
- p_ccb->chnl_state = CST_W4_L2CAP_DISCONNECT_RSP;
- alarm_set_on_mloop(p_ccb->l2c_ccb_timer, L2CAP_CHNL_DISCONNECT_TIMEOUT_MS,
- l2c_ccb_timer_timeout, p_ccb);
- break;
- case L2CEVT_L2CA_DATA_WRITE: /* Upper layer data to send */
- l2c_enqueue_peer_data(p_ccb, (BT_HDR*)p_data);
- l2c_link_check_send_pkts(p_ccb->p_lcb, NULL, NULL);
- break;
- case L2CEVT_L2CA_CONFIG_REQ: /* Upper layer config req */
- p_ccb->chnl_state = CST_CONFIG;
- p_ccb->config_done &= ~CFG_DONE_MASK;
- l2cu_process_our_cfg_req(p_ccb, (tL2CAP_CFG_INFO*)p_data);
- l2cu_send_peer_config_req(p_ccb, (tL2CAP_CFG_INFO*)p_data);
- alarm_set_on_mloop(p_ccb->l2c_ccb_timer, L2CAP_CHNL_CFG_TIMEOUT_MS,
- l2c_ccb_timer_timeout, p_ccb);
- break;
- case L2CEVT_TIMEOUT:
- /* Process the monitor/retransmission time-outs in flow control/retrans
- * mode */
- if (p_ccb->peer_cfg.fcr.mode == L2CAP_FCR_ERTM_MODE)
- l2c_fcr_proc_tout(p_ccb);
- break;
- case L2CEVT_ACK_TIMEOUT:
- l2c_fcr_proc_ack_tout(p_ccb);
- break;
- case L2CEVT_L2CA_SEND_FLOW_CONTROL_CREDIT:
- L2CAP_TRACE_DEBUG("%s Sending credit", __func__);
- credit = (uint16_t*)p_data;
- l2cble_send_flow_control_credit(p_ccb, *credit);
- break;
- case L2CEVT_L2CAP_RECV_FLOW_CONTROL_CREDIT:
- credit = (uint16_t*)p_data;
- L2CAP_TRACE_DEBUG("%s Credits received %d", __func__, *credit);
- if ((p_ccb->peer_conn_cfg.credits + *credit) > L2CAP_LE_CREDIT_MAX) {
- /* we have received credits more than max coc credits,
- * so disconnecting the Le Coc Channel
- */
- l2cble_send_peer_disc_req(p_ccb);
- } else {
- p_ccb->peer_conn_cfg.credits += *credit;
- tL2CA_CREDITS_RECEIVED_CB* cr_cb =
- p_ccb->p_rcb->api.pL2CA_CreditsReceived_Cb;
- if (p_ccb->p_lcb->transport == BT_TRANSPORT_LE && (cr_cb)) {
- (*cr_cb)(p_ccb->local_cid, *credit, p_ccb->peer_conn_cfg.credits);
- }
- l2c_link_check_send_pkts(p_ccb->p_lcb, NULL, NULL);
- }
- break;
- }
- }
- /*******************************************************************************
- *
- * Function l2c_csm_w4_l2cap_disconnect_rsp
- *
- * Description This function handles events when the channel is in
- * CST_W4_L2CAP_DISCONNECT_RSP state.
- *
- * Returns void
- *
- ******************************************************************************/
- static void l2c_csm_w4_l2cap_disconnect_rsp(tL2C_CCB* p_ccb, uint16_t event,
- void* p_data) {
- tL2CA_DISCONNECT_CFM_CB* disconnect_cfm =
- p_ccb->p_rcb->api.pL2CA_DisconnectCfm_Cb;
- uint16_t local_cid = p_ccb->local_cid;
- L2CAP_TRACE_EVENT("L2CAP - LCID: 0x%04x st: W4_L2CAP_DISC_RSP evt: %s",
- p_ccb->local_cid, l2c_csm_get_event_name(event));
- switch (event) {
- case L2CEVT_L2CAP_DISCONNECT_RSP: /* Peer disconnect response */
- l2cu_release_ccb(p_ccb);
- if (disconnect_cfm) {
- L2CAP_TRACE_API("L2CAP - Calling DisconnectCfm_Cb(), CID: 0x%04x",
- local_cid);
- (*disconnect_cfm)(local_cid, L2CAP_DISC_OK);
- }
- break;
- case L2CEVT_L2CAP_DISCONNECT_REQ: /* Peer disconnect request */
- l2cu_send_peer_disc_rsp(p_ccb->p_lcb, p_ccb->remote_id, p_ccb->local_cid,
- p_ccb->remote_cid);
- l2cu_release_ccb(p_ccb);
- if (disconnect_cfm) {
- L2CAP_TRACE_API("L2CAP - Calling DisconnectCfm_Cb(), CID: 0x%04x",
- local_cid);
- (*disconnect_cfm)(local_cid, L2CAP_DISC_OK);
- }
- break;
- case L2CEVT_LP_DISCONNECT_IND: /* Link was disconnected */
- case L2CEVT_TIMEOUT: /* Timeout */
- l2cu_release_ccb(p_ccb);
- if (disconnect_cfm) {
- L2CAP_TRACE_API("L2CAP - Calling DisconnectCfm_Cb(), CID: 0x%04x",
- local_cid);
- (*disconnect_cfm)(local_cid, L2CAP_DISC_TIMEOUT);
- }
- break;
- case L2CEVT_L2CAP_DATA: /* Peer data packet rcvd */
- case L2CEVT_L2CA_DATA_WRITE: /* Upper layer data to send */
- osi_free(p_data);
- break;
- }
- }
- /*******************************************************************************
- *
- * Function l2c_csm_w4_l2ca_disconnect_rsp
- *
- * Description This function handles events when the channel is in
- * CST_W4_L2CA_DISCONNECT_RSP state.
- *
- * Returns void
- *
- ******************************************************************************/
- static void l2c_csm_w4_l2ca_disconnect_rsp(tL2C_CCB* p_ccb, uint16_t event,
- void* p_data) {
- tL2CA_DISCONNECT_IND_CB* disconnect_ind =
- p_ccb->p_rcb->api.pL2CA_DisconnectInd_Cb;
- uint16_t local_cid = p_ccb->local_cid;
- L2CAP_TRACE_EVENT("L2CAP - LCID: 0x%04x st: W4_L2CA_DISC_RSP evt: %s",
- p_ccb->local_cid, l2c_csm_get_event_name(event));
- switch (event) {
- case L2CEVT_LP_DISCONNECT_IND: /* Link was disconnected */
- L2CAP_TRACE_API(
- "L2CAP - Calling Disconnect_Ind_Cb(), CID: 0x%04x No Conf Needed",
- p_ccb->local_cid);
- l2cu_release_ccb(p_ccb);
- (*disconnect_ind)(local_cid, false);
- break;
- case L2CEVT_TIMEOUT:
- l2cu_send_peer_disc_rsp(p_ccb->p_lcb, p_ccb->remote_id, p_ccb->local_cid,
- p_ccb->remote_cid);
- L2CAP_TRACE_API(
- "L2CAP - Calling Disconnect_Ind_Cb(), CID: 0x%04x No Conf Needed",
- p_ccb->local_cid);
- l2cu_release_ccb(p_ccb);
- (*disconnect_ind)(local_cid, false);
- break;
- case L2CEVT_L2CA_DISCONNECT_REQ: /* Upper disconnect request */
- case L2CEVT_L2CA_DISCONNECT_RSP: /* Upper disconnect response */
- l2cu_send_peer_disc_rsp(p_ccb->p_lcb, p_ccb->remote_id, p_ccb->local_cid,
- p_ccb->remote_cid);
- l2cu_release_ccb(p_ccb);
- break;
- case L2CEVT_L2CAP_DATA: /* Peer data packet rcvd */
- case L2CEVT_L2CA_DATA_WRITE: /* Upper layer data to send */
- osi_free(p_data);
- break;
- }
- }
- /*******************************************************************************
- *
- * Function l2c_csm_get_event_name
- *
- * Description This function returns the event name.
- *
- * NOTE conditionally compiled to save memory.
- *
- * Returns pointer to the name
- *
- ******************************************************************************/
- static const char* l2c_csm_get_event_name(uint16_t event) {
- switch (event) {
- case L2CEVT_LP_CONNECT_CFM: /* Lower layer connect confirm */
- return ("LOWER_LAYER_CONNECT_CFM");
- case L2CEVT_LP_CONNECT_CFM_NEG: /* Lower layer connect confirm (failed) */
- return ("LOWER_LAYER_CONNECT_CFM_NEG");
- case L2CEVT_LP_CONNECT_IND: /* Lower layer connect indication */
- return ("LOWER_LAYER_CONNECT_IND");
- case L2CEVT_LP_DISCONNECT_IND: /* Lower layer disconnect indication */
- return ("LOWER_LAYER_DISCONNECT_IND");
- case L2CEVT_LP_QOS_CFM: /* Lower layer QOS confirmation */
- return ("LOWER_LAYER_QOS_CFM");
- case L2CEVT_LP_QOS_CFM_NEG: /* Lower layer QOS confirmation (failed)*/
- return ("LOWER_LAYER_QOS_CFM_NEG");
- case L2CEVT_LP_QOS_VIOLATION_IND: /* Lower layer QOS violation indication */
- return ("LOWER_LAYER_QOS_VIOLATION_IND");
- case L2CEVT_SEC_COMP: /* Security cleared successfully */
- return ("SECURITY_COMPLETE");
- case L2CEVT_SEC_COMP_NEG: /* Security procedure failed */
- return ("SECURITY_COMPLETE_NEG");
- case L2CEVT_L2CAP_CONNECT_REQ: /* Peer connection request */
- return ("PEER_CONNECT_REQ");
- case L2CEVT_L2CAP_CONNECT_RSP: /* Peer connection response */
- return ("PEER_CONNECT_RSP");
- case L2CEVT_L2CAP_CONNECT_RSP_PND: /* Peer connection response pending */
- return ("PEER_CONNECT_RSP_PND");
- case L2CEVT_L2CAP_CONNECT_RSP_NEG: /* Peer connection response (failed) */
- return ("PEER_CONNECT_RSP_NEG");
- case L2CEVT_L2CAP_CONFIG_REQ: /* Peer configuration request */
- return ("PEER_CONFIG_REQ");
- case L2CEVT_L2CAP_CONFIG_RSP: /* Peer configuration response */
- return ("PEER_CONFIG_RSP");
- case L2CEVT_L2CAP_CONFIG_RSP_NEG: /* Peer configuration response (failed) */
- return ("PEER_CONFIG_RSP_NEG");
- case L2CEVT_L2CAP_DISCONNECT_REQ: /* Peer disconnect request */
- return ("PEER_DISCONNECT_REQ");
- case L2CEVT_L2CAP_DISCONNECT_RSP: /* Peer disconnect response */
- return ("PEER_DISCONNECT_RSP");
- case L2CEVT_L2CAP_DATA: /* Peer data */
- return ("PEER_DATA");
- case L2CEVT_L2CA_CONNECT_REQ: /* Upper layer connect request */
- return ("UPPER_LAYER_CONNECT_REQ");
- case L2CEVT_L2CA_CONNECT_RSP: /* Upper layer connect response */
- return ("UPPER_LAYER_CONNECT_RSP");
- case L2CEVT_L2CA_CONNECT_RSP_NEG: /* Upper layer connect response (failed)*/
- return ("UPPER_LAYER_CONNECT_RSP_NEG");
- case L2CEVT_L2CA_CONFIG_REQ: /* Upper layer config request */
- return ("UPPER_LAYER_CONFIG_REQ");
- case L2CEVT_L2CA_CONFIG_RSP: /* Upper layer config response */
- return ("UPPER_LAYER_CONFIG_RSP");
- case L2CEVT_L2CA_CONFIG_RSP_NEG: /* Upper layer config response (failed) */
- return ("UPPER_LAYER_CONFIG_RSP_NEG");
- case L2CEVT_L2CA_DISCONNECT_REQ: /* Upper layer disconnect request */
- return ("UPPER_LAYER_DISCONNECT_REQ");
- case L2CEVT_L2CA_DISCONNECT_RSP: /* Upper layer disconnect response */
- return ("UPPER_LAYER_DISCONNECT_RSP");
- case L2CEVT_L2CA_DATA_READ: /* Upper layer data read */
- return ("UPPER_LAYER_DATA_READ");
- case L2CEVT_L2CA_DATA_WRITE: /* Upper layer data write */
- return ("UPPER_LAYER_DATA_WRITE");
- case L2CEVT_TIMEOUT: /* Timeout */
- return ("TIMEOUT");
- case L2CEVT_SEC_RE_SEND_CMD:
- return ("SEC_RE_SEND_CMD");
- case L2CEVT_L2CAP_INFO_RSP: /* Peer information response */
- return ("L2CEVT_L2CAP_INFO_RSP");
- case L2CEVT_ACK_TIMEOUT:
- return ("L2CEVT_ACK_TIMEOUT");
- case L2CEVT_L2CA_SEND_FLOW_CONTROL_CREDIT: /* Upper layer send credit packet
- */
- return ("SEND_FLOW_CONTROL_CREDIT");
- case L2CEVT_L2CAP_RECV_FLOW_CONTROL_CREDIT: /* Peer send credit packet */
- return ("RECV_FLOW_CONTROL_CREDIT");
- default:
- return ("???? UNKNOWN EVENT");
- }
- }
- /*******************************************************************************
- *
- * Function l2c_enqueue_peer_data
- *
- * Description Enqueues data destined for the peer in the ccb. Handles
- * FCR segmentation and checks for congestion.
- *
- * Returns void
- *
- ******************************************************************************/
- void l2c_enqueue_peer_data(tL2C_CCB* p_ccb, BT_HDR* p_buf) {
- uint8_t* p;
- if (p_ccb->peer_cfg.fcr.mode != L2CAP_FCR_BASIC_MODE) {
- p_buf->event = 0;
- } else {
- /* Save the channel ID for faster counting */
- p_buf->event = p_ccb->local_cid;
- /* Step back to add the L2CAP header */
- p_buf->offset -= L2CAP_PKT_OVERHEAD;
- p_buf->len += L2CAP_PKT_OVERHEAD;
- /* Set the pointer to the beginning of the data */
- p = (uint8_t*)(p_buf + 1) + p_buf->offset;
- /* Now the L2CAP header */
- UINT16_TO_STREAM(p, p_buf->len - L2CAP_PKT_OVERHEAD);
- UINT16_TO_STREAM(p, p_ccb->remote_cid);
- }
- if (p_ccb->xmit_hold_q == NULL) {
- L2CAP_TRACE_ERROR(
- "%s: empty queue: p_ccb = %p p_ccb->in_use = %d p_ccb->chnl_state = %d "
- "p_ccb->local_cid = %u p_ccb->remote_cid = %u",
- __func__, p_ccb, p_ccb->in_use, p_ccb->chnl_state, p_ccb->local_cid,
- p_ccb->remote_cid);
- }
- fixed_queue_enqueue(p_ccb->xmit_hold_q, p_buf);
- l2cu_check_channel_congestion(p_ccb);
- #if (L2CAP_ROUND_ROBIN_CHANNEL_SERVICE == TRUE)
- /* if new packet is higher priority than serving ccb and it is not overrun */
- if ((p_ccb->p_lcb->rr_pri > p_ccb->ccb_priority) &&
- (p_ccb->p_lcb->rr_serv[p_ccb->ccb_priority].quota > 0)) {
- /* send out higher priority packet */
- p_ccb->p_lcb->rr_pri = p_ccb->ccb_priority;
- }
- #endif
- /* if we are doing a round robin scheduling, set the flag */
- if (p_ccb->p_lcb->link_xmit_quota == 0) l2cb.check_round_robin = true;
- }
|