| /****************************************************************************** |
| * |
| * Copyright (C) 2008-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 main ATT functions |
| * |
| ******************************************************************************/ |
| |
| #include "bt_target.h" |
| |
| #include "bt_common.h" |
| #include "bt_utils.h" |
| #include "btm_ble_int.h" |
| #include "btm_int.h" |
| #include "gatt_int.h" |
| #include "l2c_api.h" |
| #include "osi/include/osi.h" |
| |
| /* Configuration flags. */ |
| #define GATT_L2C_CFG_IND_DONE (1 << 0) |
| #define GATT_L2C_CFG_CFM_DONE (1 << 1) |
| |
| /* minimum GATT MTU size over BR/EDR link |
| */ |
| #define GATT_MIN_BR_MTU_SIZE 48 |
| |
| /******************************************************************************/ |
| /* 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 gatt_le_connect_cback(uint16_t chan, BD_ADDR bd_addr, |
| bool connected, uint16_t reason, |
| tBT_TRANSPORT transport); |
| static void gatt_le_data_ind(uint16_t chan, BD_ADDR bd_addr, BT_HDR* p_buf); |
| static void gatt_le_cong_cback(BD_ADDR remote_bda, bool congest); |
| |
| static void gatt_l2cif_connect_ind_cback(BD_ADDR bd_addr, uint16_t l2cap_cid, |
| uint16_t psm, uint8_t l2cap_id); |
| static void gatt_l2cif_connect_cfm_cback(uint16_t l2cap_cid, uint16_t result); |
| static void gatt_l2cif_config_ind_cback(uint16_t l2cap_cid, |
| tL2CAP_CFG_INFO* p_cfg); |
| static void gatt_l2cif_config_cfm_cback(uint16_t l2cap_cid, |
| tL2CAP_CFG_INFO* p_cfg); |
| static void gatt_l2cif_disconnect_ind_cback(uint16_t l2cap_cid, |
| bool ack_needed); |
| static void gatt_l2cif_disconnect_cfm_cback(uint16_t l2cap_cid, |
| uint16_t result); |
| static void gatt_l2cif_data_ind_cback(uint16_t l2cap_cid, BT_HDR* p_msg); |
| static void gatt_send_conn_cback(tGATT_TCB* p_tcb); |
| static void gatt_l2cif_congest_cback(uint16_t cid, bool congested); |
| |
| static const tL2CAP_APPL_INFO dyn_info = {gatt_l2cif_connect_ind_cback, |
| gatt_l2cif_connect_cfm_cback, |
| NULL, |
| gatt_l2cif_config_ind_cback, |
| gatt_l2cif_config_cfm_cback, |
| gatt_l2cif_disconnect_ind_cback, |
| gatt_l2cif_disconnect_cfm_cback, |
| NULL, |
| gatt_l2cif_data_ind_cback, |
| gatt_l2cif_congest_cback, |
| NULL}; |
| |
| tGATT_CB gatt_cb; |
| |
| /******************************************************************************* |
| * |
| * Function gatt_init |
| * |
| * Description This function is enable the GATT profile on the device. |
| * It clears out the control blocks, and registers with L2CAP. |
| * |
| * Returns void |
| * |
| ******************************************************************************/ |
| void gatt_init(void) { |
| tL2CAP_FIXED_CHNL_REG fixed_reg; |
| |
| GATT_TRACE_DEBUG("gatt_init()"); |
| |
| memset(&gatt_cb, 0, sizeof(tGATT_CB)); |
| memset(&fixed_reg, 0, sizeof(tL2CAP_FIXED_CHNL_REG)); |
| |
| #if defined(GATT_INITIAL_TRACE_LEVEL) |
| gatt_cb.trace_level = GATT_INITIAL_TRACE_LEVEL; |
| #else |
| gatt_cb.trace_level = BT_TRACE_LEVEL_NONE; /* No traces */ |
| #endif |
| gatt_cb.def_mtu_size = GATT_DEF_BLE_MTU_SIZE; |
| gatt_cb.sign_op_queue = fixed_queue_new(SIZE_MAX); |
| gatt_cb.srv_chg_clt_q = fixed_queue_new(SIZE_MAX); |
| /* First, register fixed L2CAP channel for ATT over BLE */ |
| fixed_reg.fixed_chnl_opts.mode = L2CAP_FCR_BASIC_MODE; |
| fixed_reg.fixed_chnl_opts.max_transmit = 0xFF; |
| fixed_reg.fixed_chnl_opts.rtrans_tout = 2000; |
| fixed_reg.fixed_chnl_opts.mon_tout = 12000; |
| fixed_reg.fixed_chnl_opts.mps = 670; |
| fixed_reg.fixed_chnl_opts.tx_win_sz = 1; |
| |
| fixed_reg.pL2CA_FixedConn_Cb = gatt_le_connect_cback; |
| fixed_reg.pL2CA_FixedData_Cb = gatt_le_data_ind; |
| fixed_reg.pL2CA_FixedCong_Cb = gatt_le_cong_cback; /* congestion callback */ |
| fixed_reg.default_idle_tout = 0xffff; /* 0xffff default idle timeout */ |
| |
| L2CA_RegisterFixedChannel(L2CAP_ATT_CID, &fixed_reg); |
| |
| /* Now, register with L2CAP for ATT PSM over BR/EDR */ |
| if (!L2CA_Register(BT_PSM_ATT, (tL2CAP_APPL_INFO*)&dyn_info)) { |
| GATT_TRACE_ERROR("ATT Dynamic Registration failed"); |
| } |
| |
| BTM_SetSecurityLevel(true, "", BTM_SEC_SERVICE_ATT, BTM_SEC_NONE, BT_PSM_ATT, |
| 0, 0); |
| BTM_SetSecurityLevel(false, "", BTM_SEC_SERVICE_ATT, BTM_SEC_NONE, BT_PSM_ATT, |
| 0, 0); |
| |
| gatt_cb.hdl_cfg.gatt_start_hdl = GATT_GATT_START_HANDLE; |
| gatt_cb.hdl_cfg.gap_start_hdl = GATT_GAP_START_HANDLE; |
| gatt_cb.hdl_cfg.app_start_hdl = GATT_APP_START_HANDLE; |
| gatt_profile_db_init(); |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_free |
| * |
| * Description This function frees resources used by the GATT profile. |
| * |
| * Returns void |
| * |
| ******************************************************************************/ |
| void gatt_free(void) { |
| int i; |
| GATT_TRACE_DEBUG("gatt_free()"); |
| |
| fixed_queue_free(gatt_cb.sign_op_queue, NULL); |
| gatt_cb.sign_op_queue = NULL; |
| fixed_queue_free(gatt_cb.srv_chg_clt_q, NULL); |
| gatt_cb.srv_chg_clt_q = NULL; |
| for (i = 0; i < GATT_MAX_PHY_CHANNEL; i++) { |
| fixed_queue_free(gatt_cb.tcb[i].pending_enc_clcb, NULL); |
| gatt_cb.tcb[i].pending_enc_clcb = NULL; |
| |
| fixed_queue_free(gatt_cb.tcb[i].pending_ind_q, NULL); |
| gatt_cb.tcb[i].pending_ind_q = NULL; |
| |
| alarm_free(gatt_cb.tcb[i].conf_timer); |
| gatt_cb.tcb[i].conf_timer = NULL; |
| |
| alarm_free(gatt_cb.tcb[i].ind_ack_timer); |
| gatt_cb.tcb[i].ind_ack_timer = NULL; |
| |
| fixed_queue_free(gatt_cb.tcb[i].sr_cmd.multi_rsp_q, NULL); |
| gatt_cb.tcb[i].sr_cmd.multi_rsp_q = NULL; |
| } |
| for (i = 0; i < GATT_MAX_SR_PROFILES; i++) { |
| gatt_free_hdl_buffer(&gatt_cb.hdl_list[i]); |
| } |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_connect |
| * |
| * Description This function is called to initiate a connection to a peer |
| * device. |
| * |
| * Parameter rem_bda: remote device address to connect to. |
| * |
| * Returns true if connection is started, otherwise return false. |
| * |
| ******************************************************************************/ |
| bool gatt_connect(BD_ADDR rem_bda, tGATT_TCB* p_tcb, tBT_TRANSPORT transport) { |
| bool gatt_ret = false; |
| |
| if (gatt_get_ch_state(p_tcb) != GATT_CH_OPEN) |
| gatt_set_ch_state(p_tcb, GATT_CH_CONN); |
| |
| if (transport == BT_TRANSPORT_LE) { |
| p_tcb->att_lcid = L2CAP_ATT_CID; |
| gatt_ret = L2CA_ConnectFixedChnl(L2CAP_ATT_CID, rem_bda); |
| } else { |
| p_tcb->att_lcid = L2CA_ConnectReq(BT_PSM_ATT, rem_bda); |
| if (p_tcb->att_lcid != 0) gatt_ret = true; |
| } |
| |
| return gatt_ret; |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_disconnect |
| * |
| * Description This function is called to disconnect to an ATT device. |
| * |
| * Parameter p_tcb: pointer to the TCB to disconnect. |
| * |
| * Returns true: if connection found and to be disconnected; otherwise |
| * return false. |
| * |
| ******************************************************************************/ |
| bool gatt_disconnect(tGATT_TCB* p_tcb) { |
| bool ret = false; |
| tGATT_CH_STATE ch_state; |
| |
| GATT_TRACE_EVENT("%s", __func__); |
| |
| if (p_tcb != NULL) { |
| ret = true; |
| ch_state = gatt_get_ch_state(p_tcb); |
| if (ch_state != GATT_CH_CLOSING) { |
| if (p_tcb->att_lcid == L2CAP_ATT_CID) { |
| if (ch_state == GATT_CH_OPEN) { |
| /* only LCB exist between remote device and local */ |
| ret = L2CA_RemoveFixedChnl(L2CAP_ATT_CID, p_tcb->peer_bda); |
| } else { |
| ret = L2CA_CancelBleConnectReq(p_tcb->peer_bda); |
| if (!ret) gatt_set_ch_state(p_tcb, GATT_CH_CLOSE); |
| } |
| gatt_set_ch_state(p_tcb, GATT_CH_CLOSING); |
| } else { |
| if ((ch_state == GATT_CH_OPEN) || (ch_state == GATT_CH_CFG)) |
| ret = L2CA_DisconnectReq(p_tcb->att_lcid); |
| else |
| GATT_TRACE_DEBUG("%s gatt_disconnect channel not opened", __func__); |
| } |
| } else { |
| GATT_TRACE_DEBUG("%s already in closing state", __func__); |
| } |
| } |
| |
| return ret; |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_update_app_hold_link_status |
| * |
| * Description Update the application use link status |
| * |
| * Returns true if any modifications are made or |
| * when it already exists, false otherwise. |
| * |
| ******************************************************************************/ |
| bool gatt_update_app_hold_link_status(tGATT_IF gatt_if, tGATT_TCB* p_tcb, |
| bool is_add) { |
| for (int i = 0; i < GATT_MAX_APPS; i++) { |
| if (p_tcb->app_hold_link[i] == gatt_if && is_add) { |
| GATT_TRACE_DEBUG("%s: gatt_if %d already exists at idx %d", __func__, gatt_if, i); |
| return true; |
| } |
| } |
| |
| for (int i = 0; i < GATT_MAX_APPS; i++) { |
| if (p_tcb->app_hold_link[i] == 0 && is_add) { |
| p_tcb->app_hold_link[i] = gatt_if; |
| GATT_TRACE_DEBUG("%s: added gatt_if=%d idx=%d ", __func__, gatt_if, i); |
| return true; |
| } else if (p_tcb->app_hold_link[i] == gatt_if && !is_add) { |
| p_tcb->app_hold_link[i] = 0; |
| GATT_TRACE_DEBUG("%s: removed gatt_if=%d idx=%d", __func__, gatt_if, i); |
| return true; |
| } |
| } |
| |
| GATT_TRACE_DEBUG("%s: gatt_if=%d not found; is_add=%d", __func__, gatt_if, |
| is_add); |
| return false; |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_update_app_use_link_flag |
| * |
| * Description Update the application use link flag and optional to check |
| * the acl link if the link is up then set the idle time out |
| * accordingly |
| * |
| * Returns void. |
| * |
| ******************************************************************************/ |
| void gatt_update_app_use_link_flag(tGATT_IF gatt_if, tGATT_TCB* p_tcb, |
| bool is_add, bool check_acl_link) { |
| GATT_TRACE_DEBUG("%s: is_add=%d chk_link=%d", __func__, is_add, |
| check_acl_link); |
| |
| if (!p_tcb) return; |
| |
| // If we make no modification, i.e. kill app that was never connected to a |
| // device, skip updating the device state. |
| if (!gatt_update_app_hold_link_status(gatt_if, p_tcb, is_add)) return; |
| |
| if (!check_acl_link || |
| p_tcb->att_lcid != |
| L2CAP_ATT_CID || /* only update link idle timer for fixed channel */ |
| (BTM_GetHCIConnHandle(p_tcb->peer_bda, p_tcb->transport) == |
| GATT_INVALID_ACL_HANDLE)) { |
| return; |
| } |
| |
| if (is_add) { |
| GATT_TRACE_DEBUG("%s: disable link idle timer", __func__); |
| /* acl link is connected disable the idle timeout */ |
| GATT_SetIdleTimeout(p_tcb->peer_bda, GATT_LINK_NO_IDLE_TIMEOUT, |
| p_tcb->transport); |
| } else { |
| if (!gatt_num_apps_hold_link(p_tcb)) { |
| /* acl link is connected but no application needs to use the link |
| so set the timeout value to GATT_LINK_IDLE_TIMEOUT_WHEN_NO_APP seconds |
| */ |
| GATT_TRACE_DEBUG("%s: start link idle timer =%d sec", __func__, |
| GATT_LINK_IDLE_TIMEOUT_WHEN_NO_APP); |
| GATT_SetIdleTimeout(p_tcb->peer_bda, GATT_LINK_IDLE_TIMEOUT_WHEN_NO_APP, |
| p_tcb->transport); |
| } |
| } |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_act_connect |
| * |
| * Description GATT connection initiation. |
| * |
| * Returns void. |
| * |
| ******************************************************************************/ |
| bool gatt_act_connect(tGATT_REG* p_reg, BD_ADDR bd_addr, |
| tBT_TRANSPORT transport, bool opportunistic) { |
| bool ret = false; |
| tGATT_TCB* p_tcb; |
| uint8_t st; |
| |
| p_tcb = gatt_find_tcb_by_addr(bd_addr, transport); |
| if (p_tcb != NULL) { |
| ret = true; |
| st = gatt_get_ch_state(p_tcb); |
| |
| /* before link down, another app try to open a GATT connection */ |
| if (st == GATT_CH_OPEN && gatt_num_apps_hold_link(p_tcb) == 0 && |
| transport == BT_TRANSPORT_LE) { |
| if (!gatt_connect(bd_addr, p_tcb, transport)) ret = false; |
| } else if (st == GATT_CH_CLOSING) { |
| /* need to complete the closing first */ |
| ret = false; |
| } |
| } else { |
| p_tcb = gatt_allocate_tcb_by_bdaddr(bd_addr, transport); |
| if (p_tcb != NULL) { |
| if (!gatt_connect(bd_addr, p_tcb, transport)) { |
| GATT_TRACE_ERROR("gatt_connect failed"); |
| fixed_queue_free(p_tcb->pending_enc_clcb, NULL); |
| fixed_queue_free(p_tcb->pending_ind_q, NULL); |
| memset(p_tcb, 0, sizeof(tGATT_TCB)); |
| } else |
| ret = true; |
| } else { |
| ret = 0; |
| GATT_TRACE_ERROR("Max TCB for gatt_if [%d] reached.", p_reg->gatt_if); |
| } |
| } |
| |
| if (ret) { |
| if (!opportunistic) |
| gatt_update_app_use_link_flag(p_reg->gatt_if, p_tcb, true, false); |
| else |
| GATT_TRACE_DEBUG( |
| "%s: connection is opportunistic, not updating app usage", __func__); |
| } |
| |
| return ret; |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_le_connect_cback |
| * |
| * Description This callback function is called by L2CAP to indicate that |
| * the ATT fixed channel for LE is |
| * connected (conn = true)/disconnected (conn = false). |
| * |
| ******************************************************************************/ |
| static void gatt_le_connect_cback(uint16_t chan, BD_ADDR bd_addr, |
| bool connected, uint16_t reason, |
| tBT_TRANSPORT transport) { |
| tGATT_TCB* p_tcb = gatt_find_tcb_by_addr(bd_addr, transport); |
| bool check_srv_chg = false; |
| tGATTS_SRV_CHG* p_srv_chg_clt = NULL; |
| |
| /* ignore all fixed channel connect/disconnect on BR/EDR link for GATT */ |
| if (transport == BT_TRANSPORT_BR_EDR) return; |
| |
| GATT_TRACE_DEBUG( |
| "GATT ATT protocol channel with BDA: %08x%04x is %s", |
| (bd_addr[0] << 24) + (bd_addr[1] << 16) + (bd_addr[2] << 8) + bd_addr[3], |
| (bd_addr[4] << 8) + bd_addr[5], |
| (connected) ? "connected" : "disconnected"); |
| |
| p_srv_chg_clt = gatt_is_bda_in_the_srv_chg_clt_list(bd_addr); |
| if (p_srv_chg_clt != NULL) { |
| check_srv_chg = true; |
| } else { |
| if (btm_sec_is_a_bonded_dev(bd_addr)) |
| gatt_add_a_bonded_dev_for_srv_chg(bd_addr); |
| } |
| |
| if (connected) { |
| /* do we have a channel initiating a connection? */ |
| if (p_tcb) { |
| /* we are initiating connection */ |
| if (gatt_get_ch_state(p_tcb) == GATT_CH_CONN) { |
| /* send callback */ |
| gatt_set_ch_state(p_tcb, GATT_CH_OPEN); |
| p_tcb->payload_size = GATT_DEF_BLE_MTU_SIZE; |
| |
| gatt_send_conn_cback(p_tcb); |
| } |
| if (check_srv_chg) gatt_chk_srv_chg(p_srv_chg_clt); |
| } |
| /* this is incoming connection or background connection callback */ |
| |
| else { |
| p_tcb = gatt_allocate_tcb_by_bdaddr(bd_addr, BT_TRANSPORT_LE); |
| if (p_tcb != NULL) { |
| p_tcb->att_lcid = L2CAP_ATT_CID; |
| |
| gatt_set_ch_state(p_tcb, GATT_CH_OPEN); |
| |
| p_tcb->payload_size = GATT_DEF_BLE_MTU_SIZE; |
| |
| gatt_send_conn_cback(p_tcb); |
| if (check_srv_chg) { |
| gatt_chk_srv_chg(p_srv_chg_clt); |
| } |
| } else { |
| GATT_TRACE_ERROR("CCB max out, no rsources"); |
| } |
| } |
| } else { |
| gatt_cleanup_upon_disc(bd_addr, reason, transport); |
| GATT_TRACE_DEBUG("ATT disconnected"); |
| } |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_channel_congestion |
| * |
| * Description This function is called to process the congestion callback |
| * from lcb |
| * |
| * Returns void |
| * |
| ******************************************************************************/ |
| static void gatt_channel_congestion(tGATT_TCB* p_tcb, bool congested) { |
| uint8_t i = 0; |
| tGATT_REG* p_reg = NULL; |
| uint16_t conn_id; |
| |
| /* if uncongested, check to see if there is any more pending data */ |
| if (p_tcb != NULL && congested == false) { |
| gatt_cl_send_next_cmd_inq(p_tcb); |
| } |
| /* notifying all applications for the connection up event */ |
| for (i = 0, p_reg = gatt_cb.cl_rcb; i < GATT_MAX_APPS; i++, p_reg++) { |
| if (p_reg->in_use) { |
| if (p_reg->app_cb.p_congestion_cb) { |
| conn_id = GATT_CREATE_CONN_ID(p_tcb->tcb_idx, p_reg->gatt_if); |
| (*p_reg->app_cb.p_congestion_cb)(conn_id, congested); |
| } |
| } |
| } |
| } |
| |
| void gatt_notify_phy_updated(tGATT_TCB* p_tcb, uint8_t tx_phy, uint8_t rx_phy, |
| uint8_t status) { |
| for (int i = 0; i < GATT_MAX_APPS; i++) { |
| tGATT_REG* p_reg = &gatt_cb.cl_rcb[i]; |
| if (p_reg->in_use && p_reg->app_cb.p_phy_update_cb) { |
| uint16_t conn_id = GATT_CREATE_CONN_ID(p_tcb->tcb_idx, p_reg->gatt_if); |
| (*p_reg->app_cb.p_phy_update_cb)(p_reg->gatt_if, conn_id, tx_phy, rx_phy, |
| status); |
| } |
| } |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_le_cong_cback |
| * |
| * Description This function is called when GATT fixed channel is congested |
| * or uncongested. |
| * |
| * Returns void |
| * |
| ******************************************************************************/ |
| static void gatt_le_cong_cback(BD_ADDR remote_bda, bool congested) { |
| tGATT_TCB* p_tcb = gatt_find_tcb_by_addr(remote_bda, BT_TRANSPORT_LE); |
| |
| /* if uncongested, check to see if there is any more pending data */ |
| if (p_tcb != NULL) { |
| gatt_channel_congestion(p_tcb, congested); |
| } |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_le_data_ind |
| * |
| * Description This function is called when data is received from L2CAP. |
| * if we are the originator of the connection, we are the ATT |
| * client, and the received message is queued up for the |
| * client. |
| * |
| * If we are the destination of the connection, we are the ATT |
| * server, so the message is passed to the server processing |
| * function. |
| * |
| * Returns void |
| * |
| ******************************************************************************/ |
| static void gatt_le_data_ind(uint16_t chan, BD_ADDR bd_addr, BT_HDR* p_buf) { |
| tGATT_TCB* p_tcb; |
| |
| /* Find CCB based on bd addr */ |
| if ((p_tcb = gatt_find_tcb_by_addr(bd_addr, BT_TRANSPORT_LE)) != NULL && |
| gatt_get_ch_state(p_tcb) >= GATT_CH_OPEN) { |
| gatt_data_process(p_tcb, p_buf); |
| } else { |
| osi_free(p_buf); |
| |
| if (p_tcb != NULL) { |
| GATT_TRACE_WARNING("ATT - Ignored L2CAP data while in state: %d", |
| gatt_get_ch_state(p_tcb)); |
| } |
| } |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_l2cif_connect_ind |
| * |
| * Description This function handles an inbound connection indication |
| * from L2CAP. This is the case where we are acting as a |
| * server. |
| * |
| * Returns void |
| * |
| ******************************************************************************/ |
| static void gatt_l2cif_connect_ind_cback(BD_ADDR bd_addr, uint16_t lcid, |
| UNUSED_ATTR uint16_t psm, uint8_t id) { |
| /* do we already have a control channel for this peer? */ |
| uint8_t result = L2CAP_CONN_OK; |
| tL2CAP_CFG_INFO cfg; |
| tGATT_TCB* p_tcb = gatt_find_tcb_by_addr(bd_addr, BT_TRANSPORT_BR_EDR); |
| |
| GATT_TRACE_ERROR("Connection indication cid = %d", lcid); |
| /* new connection ? */ |
| if (p_tcb == NULL) { |
| /* allocate tcb */ |
| p_tcb = gatt_allocate_tcb_by_bdaddr(bd_addr, BT_TRANSPORT_BR_EDR); |
| if (p_tcb == NULL) { |
| /* no tcb available, reject L2CAP connection */ |
| result = L2CAP_CONN_NO_RESOURCES; |
| } else |
| p_tcb->att_lcid = lcid; |
| |
| } else /* existing connection , reject it */ |
| { |
| result = L2CAP_CONN_NO_RESOURCES; |
| } |
| |
| /* Send L2CAP connect rsp */ |
| L2CA_ConnectRsp(bd_addr, id, lcid, result, 0); |
| |
| /* if result ok, proceed with connection */ |
| if (result == L2CAP_CONN_OK) { |
| /* transition to configuration state */ |
| gatt_set_ch_state(p_tcb, GATT_CH_CFG); |
| |
| /* Send L2CAP config req */ |
| memset(&cfg, 0, sizeof(tL2CAP_CFG_INFO)); |
| cfg.mtu_present = true; |
| cfg.mtu = GATT_MAX_MTU_SIZE; |
| |
| L2CA_ConfigReq(lcid, &cfg); |
| } |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_l2c_connect_cfm_cback |
| * |
| * Description This is the L2CAP connect confirm callback function. |
| * |
| * |
| * Returns void |
| * |
| ******************************************************************************/ |
| static void gatt_l2cif_connect_cfm_cback(uint16_t lcid, uint16_t result) { |
| tGATT_TCB* p_tcb; |
| tL2CAP_CFG_INFO cfg; |
| |
| /* look up clcb for this channel */ |
| p_tcb = gatt_find_tcb_by_cid(lcid); |
| if (p_tcb != NULL) { |
| GATT_TRACE_DEBUG( |
| "gatt_l2c_connect_cfm_cback result: %d ch_state: %d, lcid:0x%x", result, |
| gatt_get_ch_state(p_tcb), p_tcb->att_lcid); |
| |
| /* if in correct state */ |
| if (gatt_get_ch_state(p_tcb) == GATT_CH_CONN) { |
| /* if result successful */ |
| if (result == L2CAP_CONN_OK) { |
| /* set channel state */ |
| gatt_set_ch_state(p_tcb, GATT_CH_CFG); |
| |
| /* Send L2CAP config req */ |
| memset(&cfg, 0, sizeof(tL2CAP_CFG_INFO)); |
| cfg.mtu_present = true; |
| cfg.mtu = GATT_MAX_MTU_SIZE; |
| L2CA_ConfigReq(lcid, &cfg); |
| } |
| /* else initiating connection failure */ |
| else { |
| gatt_cleanup_upon_disc(p_tcb->peer_bda, result, GATT_TRANSPORT_BR_EDR); |
| } |
| } else /* wrong state, disconnect it */ |
| { |
| if (result == L2CAP_CONN_OK) { |
| /* just in case the peer also accepts our connection - Send L2CAP |
| * disconnect req */ |
| L2CA_DisconnectReq(lcid); |
| } |
| } |
| } |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_l2cif_config_cfm_cback |
| * |
| * Description This is the L2CAP config confirm callback function. |
| * |
| * |
| * Returns void |
| * |
| ******************************************************************************/ |
| void gatt_l2cif_config_cfm_cback(uint16_t lcid, tL2CAP_CFG_INFO* p_cfg) { |
| tGATT_TCB* p_tcb; |
| tGATTS_SRV_CHG* p_srv_chg_clt = NULL; |
| |
| /* look up clcb for this channel */ |
| p_tcb = gatt_find_tcb_by_cid(lcid); |
| if (p_tcb != NULL) { |
| /* if in correct state */ |
| if (gatt_get_ch_state(p_tcb) == GATT_CH_CFG) { |
| /* if result successful */ |
| if (p_cfg->result == L2CAP_CFG_OK) { |
| /* update flags */ |
| p_tcb->ch_flags |= GATT_L2C_CFG_CFM_DONE; |
| |
| /* if configuration complete */ |
| if (p_tcb->ch_flags & GATT_L2C_CFG_IND_DONE) { |
| gatt_set_ch_state(p_tcb, GATT_CH_OPEN); |
| |
| p_srv_chg_clt = gatt_is_bda_in_the_srv_chg_clt_list(p_tcb->peer_bda); |
| if (p_srv_chg_clt != NULL) { |
| gatt_chk_srv_chg(p_srv_chg_clt); |
| } else { |
| if (btm_sec_is_a_bonded_dev(p_tcb->peer_bda)) |
| gatt_add_a_bonded_dev_for_srv_chg(p_tcb->peer_bda); |
| } |
| |
| /* send callback */ |
| gatt_send_conn_cback(p_tcb); |
| } |
| } |
| /* else failure */ |
| else { |
| /* Send L2CAP disconnect req */ |
| L2CA_DisconnectReq(lcid); |
| } |
| } |
| } |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_l2cif_config_ind_cback |
| * |
| * Description This is the L2CAP config indication callback function. |
| * |
| * |
| * Returns void |
| * |
| ******************************************************************************/ |
| void gatt_l2cif_config_ind_cback(uint16_t lcid, tL2CAP_CFG_INFO* p_cfg) { |
| tGATT_TCB* p_tcb; |
| tGATTS_SRV_CHG* p_srv_chg_clt = NULL; |
| /* look up clcb for this channel */ |
| p_tcb = gatt_find_tcb_by_cid(lcid); |
| if (p_tcb != NULL) { |
| /* GATT uses the smaller of our MTU and peer's MTU */ |
| if (p_cfg->mtu_present && |
| (p_cfg->mtu >= GATT_MIN_BR_MTU_SIZE && p_cfg->mtu < L2CAP_DEFAULT_MTU)) |
| p_tcb->payload_size = p_cfg->mtu; |
| else |
| p_tcb->payload_size = L2CAP_DEFAULT_MTU; |
| |
| /* send L2CAP configure response */ |
| memset(p_cfg, 0, sizeof(tL2CAP_CFG_INFO)); |
| p_cfg->result = L2CAP_CFG_OK; |
| L2CA_ConfigRsp(lcid, p_cfg); |
| |
| /* if first config ind */ |
| if ((p_tcb->ch_flags & GATT_L2C_CFG_IND_DONE) == 0) { |
| /* update flags */ |
| p_tcb->ch_flags |= GATT_L2C_CFG_IND_DONE; |
| |
| /* if configuration complete */ |
| if (p_tcb->ch_flags & GATT_L2C_CFG_CFM_DONE) { |
| gatt_set_ch_state(p_tcb, GATT_CH_OPEN); |
| p_srv_chg_clt = gatt_is_bda_in_the_srv_chg_clt_list(p_tcb->peer_bda); |
| if (p_srv_chg_clt != NULL) { |
| gatt_chk_srv_chg(p_srv_chg_clt); |
| } else { |
| if (btm_sec_is_a_bonded_dev(p_tcb->peer_bda)) |
| gatt_add_a_bonded_dev_for_srv_chg(p_tcb->peer_bda); |
| } |
| |
| /* send callback */ |
| gatt_send_conn_cback(p_tcb); |
| } |
| } |
| } |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_l2cif_disconnect_ind_cback |
| * |
| * Description This is the L2CAP disconnect indication callback function. |
| * |
| * |
| * Returns void |
| * |
| ******************************************************************************/ |
| void gatt_l2cif_disconnect_ind_cback(uint16_t lcid, bool ack_needed) { |
| tGATT_TCB* p_tcb; |
| uint16_t reason; |
| |
| /* look up clcb for this channel */ |
| p_tcb = gatt_find_tcb_by_cid(lcid); |
| if (p_tcb != NULL) { |
| if (ack_needed) { |
| /* send L2CAP disconnect response */ |
| L2CA_DisconnectRsp(lcid); |
| } |
| if (gatt_is_bda_in_the_srv_chg_clt_list(p_tcb->peer_bda) == NULL) { |
| if (btm_sec_is_a_bonded_dev(p_tcb->peer_bda)) |
| gatt_add_a_bonded_dev_for_srv_chg(p_tcb->peer_bda); |
| } |
| /* if ACL link is still up, no reason is logged, l2cap is disconnect from |
| * peer */ |
| reason = L2CA_GetDisconnectReason(p_tcb->peer_bda, p_tcb->transport); |
| if (reason == 0) reason = GATT_CONN_TERMINATE_PEER_USER; |
| |
| /* send disconnect callback */ |
| gatt_cleanup_upon_disc(p_tcb->peer_bda, reason, GATT_TRANSPORT_BR_EDR); |
| } |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_l2cif_disconnect_cfm_cback |
| * |
| * Description This is the L2CAP disconnect confirm callback function. |
| * |
| * |
| * Returns void |
| * |
| ******************************************************************************/ |
| static void gatt_l2cif_disconnect_cfm_cback(uint16_t lcid, |
| UNUSED_ATTR uint16_t result) { |
| tGATT_TCB* p_tcb; |
| uint16_t reason; |
| |
| /* look up clcb for this channel */ |
| p_tcb = gatt_find_tcb_by_cid(lcid); |
| if (p_tcb != NULL) { |
| /* If the device is not in the service changed client list, add it... */ |
| if (gatt_is_bda_in_the_srv_chg_clt_list(p_tcb->peer_bda) == NULL) { |
| if (btm_sec_is_a_bonded_dev(p_tcb->peer_bda)) |
| gatt_add_a_bonded_dev_for_srv_chg(p_tcb->peer_bda); |
| } |
| |
| /* send disconnect callback */ |
| /* if ACL link is still up, no reason is logged, l2cap is disconnect from |
| * peer */ |
| reason = L2CA_GetDisconnectReason(p_tcb->peer_bda, p_tcb->transport); |
| if (reason == 0) reason = GATT_CONN_TERMINATE_LOCAL_HOST; |
| |
| gatt_cleanup_upon_disc(p_tcb->peer_bda, reason, GATT_TRANSPORT_BR_EDR); |
| } |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_l2cif_data_ind_cback |
| * |
| * Description This is the L2CAP data indication callback function. |
| * |
| * |
| * Returns void |
| * |
| ******************************************************************************/ |
| static void gatt_l2cif_data_ind_cback(uint16_t lcid, BT_HDR* p_buf) { |
| tGATT_TCB* p_tcb; |
| |
| /* look up clcb for this channel */ |
| if ((p_tcb = gatt_find_tcb_by_cid(lcid)) != NULL && |
| gatt_get_ch_state(p_tcb) == GATT_CH_OPEN) { |
| /* process the data */ |
| gatt_data_process(p_tcb, p_buf); |
| } else /* prevent buffer leak */ |
| osi_free(p_buf); |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_l2cif_congest_cback |
| * |
| * Description L2CAP congestion callback |
| * |
| * Returns void |
| * |
| ******************************************************************************/ |
| static void gatt_l2cif_congest_cback(uint16_t lcid, bool congested) { |
| tGATT_TCB* p_tcb = gatt_find_tcb_by_cid(lcid); |
| |
| if (p_tcb != NULL) { |
| gatt_channel_congestion(p_tcb, congested); |
| } |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_send_conn_cback |
| * |
| * Description Callback used to notify layer above about a connection. |
| * |
| * |
| * Returns void |
| * |
| ******************************************************************************/ |
| static void gatt_send_conn_cback(tGATT_TCB* p_tcb) { |
| uint8_t i; |
| tGATT_REG* p_reg; |
| tGATT_BG_CONN_DEV* p_bg_dev = NULL; |
| uint16_t conn_id; |
| |
| p_bg_dev = gatt_find_bg_dev(p_tcb->peer_bda); |
| |
| /* notifying all applications for the connection up event */ |
| for (i = 0, p_reg = gatt_cb.cl_rcb; i < GATT_MAX_APPS; i++, p_reg++) { |
| if (p_reg->in_use) { |
| if (p_bg_dev && gatt_is_bg_dev_for_app(p_bg_dev, p_reg->gatt_if)) |
| gatt_update_app_use_link_flag(p_reg->gatt_if, p_tcb, true, true); |
| |
| if (p_reg->app_cb.p_conn_cb) { |
| conn_id = GATT_CREATE_CONN_ID(p_tcb->tcb_idx, p_reg->gatt_if); |
| (*p_reg->app_cb.p_conn_cb)(p_reg->gatt_if, p_tcb->peer_bda, conn_id, |
| true, 0, p_tcb->transport); |
| } |
| } |
| } |
| |
| if (gatt_num_apps_hold_link(p_tcb) && p_tcb->att_lcid == L2CAP_ATT_CID) { |
| /* disable idle timeout if one or more clients are holding the link disable |
| * the idle timer */ |
| GATT_SetIdleTimeout(p_tcb->peer_bda, GATT_LINK_NO_IDLE_TIMEOUT, |
| p_tcb->transport); |
| } |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_le_data_ind |
| * |
| * Description This function is called when data is received from L2CAP. |
| * if we are the originator of the connection, we are the ATT |
| * client, and the received message is queued up for the |
| * client. |
| * |
| * If we are the destination of the connection, we are the ATT |
| * server, so the message is passed to the server processing |
| * function. |
| * |
| * Returns void |
| * |
| ******************************************************************************/ |
| void gatt_data_process(tGATT_TCB* p_tcb, BT_HDR* p_buf) { |
| uint8_t* p = (uint8_t*)(p_buf + 1) + p_buf->offset; |
| uint8_t op_code, pseudo_op_code; |
| uint16_t msg_len; |
| |
| if (p_buf->len > 0) { |
| msg_len = p_buf->len - 1; |
| STREAM_TO_UINT8(op_code, p); |
| |
| /* remove the two MSBs associated with sign write and write cmd */ |
| pseudo_op_code = op_code & (~GATT_WRITE_CMD_MASK); |
| |
| if (pseudo_op_code < GATT_OP_CODE_MAX) { |
| if (op_code == GATT_SIGN_CMD_WRITE) { |
| gatt_verify_signature(p_tcb, p_buf); |
| } else { |
| /* message from client */ |
| if ((op_code % 2) == 0) |
| gatt_server_handle_client_req(p_tcb, op_code, msg_len, p); |
| else |
| gatt_client_handle_server_rsp(p_tcb, op_code, msg_len, p); |
| } |
| } else { |
| GATT_TRACE_ERROR("ATT - Rcvd L2CAP data, unknown cmd: 0x%x", op_code); |
| } |
| } else { |
| GATT_TRACE_ERROR("invalid data length, ignore"); |
| } |
| |
| osi_free(p_buf); |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_add_a_bonded_dev_for_srv_chg |
| * |
| * Description Add a bonded dev to the service changed client list |
| * |
| * Returns void |
| * |
| ******************************************************************************/ |
| void gatt_add_a_bonded_dev_for_srv_chg(BD_ADDR bda) { |
| tGATTS_SRV_CHG_REQ req; |
| tGATTS_SRV_CHG srv_chg_clt; |
| |
| memcpy(srv_chg_clt.bda, bda, BD_ADDR_LEN); |
| srv_chg_clt.srv_changed = false; |
| if (gatt_add_srv_chg_clt(&srv_chg_clt) != NULL) { |
| memcpy(req.srv_chg.bda, bda, BD_ADDR_LEN); |
| req.srv_chg.srv_changed = false; |
| if (gatt_cb.cb_info.p_srv_chg_callback) |
| (*gatt_cb.cb_info.p_srv_chg_callback)(GATTS_SRV_CHG_CMD_ADD_CLIENT, &req, |
| NULL); |
| } |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_send_srv_chg_ind |
| * |
| * Description This function is called to send a service chnaged indication |
| * to the specified bd address |
| * |
| * Returns void |
| * |
| ******************************************************************************/ |
| void gatt_send_srv_chg_ind(BD_ADDR peer_bda) { |
| uint8_t handle_range[GATT_SIZE_OF_SRV_CHG_HNDL_RANGE]; |
| uint8_t* p = handle_range; |
| uint16_t conn_id; |
| |
| GATT_TRACE_DEBUG("gatt_send_srv_chg_ind"); |
| |
| if (gatt_cb.handle_of_h_r) { |
| conn_id = gatt_profile_find_conn_id_by_bd_addr(peer_bda); |
| if (conn_id != GATT_INVALID_CONN_ID) { |
| UINT16_TO_STREAM(p, 1); |
| UINT16_TO_STREAM(p, 0xFFFF); |
| GATTS_HandleValueIndication(conn_id, gatt_cb.handle_of_h_r, |
| GATT_SIZE_OF_SRV_CHG_HNDL_RANGE, |
| handle_range); |
| } else { |
| GATT_TRACE_ERROR("Unable to find conn_id for %08x%04x ", |
| (peer_bda[0] << 24) + (peer_bda[1] << 16) + |
| (peer_bda[2] << 8) + peer_bda[3], |
| (peer_bda[4] << 8) + peer_bda[5]); |
| } |
| } |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_chk_srv_chg |
| * |
| * Description Check sending service chnaged Indication is required or not |
| * if required then send the Indication |
| * |
| * Returns void |
| * |
| ******************************************************************************/ |
| void gatt_chk_srv_chg(tGATTS_SRV_CHG* p_srv_chg_clt) { |
| GATT_TRACE_DEBUG("gatt_chk_srv_chg srv_changed=%d", |
| p_srv_chg_clt->srv_changed); |
| |
| if (p_srv_chg_clt->srv_changed) { |
| gatt_send_srv_chg_ind(p_srv_chg_clt->bda); |
| } |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_init_srv_chg |
| * |
| * Description This function is used to initialize the service changed |
| * attribute value |
| * |
| * Returns void |
| * |
| ******************************************************************************/ |
| void gatt_init_srv_chg(void) { |
| tGATTS_SRV_CHG_REQ req; |
| tGATTS_SRV_CHG_RSP rsp; |
| bool status; |
| uint8_t num_clients, i; |
| tGATTS_SRV_CHG srv_chg_clt; |
| |
| GATT_TRACE_DEBUG("gatt_init_srv_chg"); |
| if (gatt_cb.cb_info.p_srv_chg_callback) { |
| status = (*gatt_cb.cb_info.p_srv_chg_callback)( |
| GATTS_SRV_CHG_CMD_READ_NUM_CLENTS, NULL, &rsp); |
| |
| if (status && rsp.num_clients) { |
| GATT_TRACE_DEBUG("gatt_init_srv_chg num_srv_chg_clt_clients=%d", |
| rsp.num_clients); |
| num_clients = rsp.num_clients; |
| i = 1; /* use one based index */ |
| while ((i <= num_clients) && status) { |
| req.client_read_index = i; |
| status = (*gatt_cb.cb_info.p_srv_chg_callback)( |
| GATTS_SRV_CHG_CMD_READ_CLENT, &req, &rsp); |
| if (status == true) { |
| memcpy(&srv_chg_clt, &rsp.srv_chg, sizeof(tGATTS_SRV_CHG)); |
| if (gatt_add_srv_chg_clt(&srv_chg_clt) == NULL) { |
| GATT_TRACE_ERROR("Unable to add a service change client"); |
| status = false; |
| } |
| } |
| i++; |
| } |
| } |
| } else { |
| GATT_TRACE_DEBUG("gatt_init_srv_chg callback not registered yet"); |
| } |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_proc_srv_chg |
| * |
| * Description This function is process the service changed request |
| * |
| * Returns void |
| * |
| ******************************************************************************/ |
| void gatt_proc_srv_chg(void) { |
| uint8_t start_idx, found_idx; |
| BD_ADDR bda; |
| bool srv_chg_ind_pending = false; |
| tGATT_TCB* p_tcb; |
| tBT_TRANSPORT transport; |
| |
| GATT_TRACE_DEBUG("gatt_proc_srv_chg"); |
| |
| if (gatt_cb.cb_info.p_srv_chg_callback && gatt_cb.handle_of_h_r) { |
| gatt_set_srv_chg(); |
| start_idx = 0; |
| while ( |
| gatt_find_the_connected_bda(start_idx, bda, &found_idx, &transport)) { |
| p_tcb = &gatt_cb.tcb[found_idx]; |
| ; |
| srv_chg_ind_pending = gatt_is_srv_chg_ind_pending(p_tcb); |
| |
| if (!srv_chg_ind_pending) { |
| gatt_send_srv_chg_ind(bda); |
| } else { |
| GATT_TRACE_DEBUG("discard srv chg - already has one in the queue"); |
| } |
| start_idx = ++found_idx; |
| } |
| } |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_set_ch_state |
| * |
| * Description This function set the ch_state in tcb |
| * |
| * Returns none |
| * |
| ******************************************************************************/ |
| void gatt_set_ch_state(tGATT_TCB* p_tcb, tGATT_CH_STATE ch_state) { |
| if (p_tcb) { |
| GATT_TRACE_DEBUG("gatt_set_ch_state: old=%d new=%d", p_tcb->ch_state, |
| ch_state); |
| p_tcb->ch_state = ch_state; |
| } |
| } |
| |
| /******************************************************************************* |
| * |
| * Function gatt_get_ch_state |
| * |
| * Description This function get the ch_state in tcb |
| * |
| * Returns none |
| * |
| ******************************************************************************/ |
| tGATT_CH_STATE gatt_get_ch_state(tGATT_TCB* p_tcb) { |
| tGATT_CH_STATE ch_state = GATT_CH_CLOSE; |
| if (p_tcb) { |
| GATT_TRACE_DEBUG("gatt_get_ch_state: ch_state=%d", p_tcb->ch_state); |
| ch_state = p_tcb->ch_state; |
| } |
| return ch_state; |
| } |