/* * Copyright 2020 HIMSA II K/S - www.himsa.com. Represented by EHIMA - * www.ehima.com * * 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. */ #include #include #include "acl_api.h" #include "base/bind_helpers.h" #include "bt_types.h" #include "device/include/controller.h" #include "eatt.h" #include "l2c_api.h" #include "osi/include/alarm.h" #include "stack/btm/btm_sec.h" #include "stack/gatt/gatt_int.h" #include "stack/l2cap/l2c_int.h" namespace bluetooth { namespace eatt { #define BLE_GATT_SVR_SUP_FEAT_EATT_BITMASK 0x01 class eatt_device { public: RawAddress bda_; uint16_t rx_mtu_; uint16_t rx_mps_; tGATT_TCB* eatt_tcb_; std::map> eatt_channels; eatt_device(const RawAddress& bd_addr, uint16_t mtu, uint16_t mps) : rx_mtu_(mtu), rx_mps_(mps), eatt_tcb_(nullptr) { bda_ = bd_addr; } }; struct eatt_impl { std::vector devices_; uint16_t psm_; uint16_t default_mtu_; uint16_t max_mps_; tL2CAP_APPL_INFO reg_info_; eatt_impl() { default_mtu_ = EATT_DEFAULT_MTU; max_mps_ = EATT_MIN_MTU_MPS; psm_ = BT_PSM_EATT; }; ~eatt_impl() = default; eatt_device* find_device_by_cid(uint16_t lcid) { /* This works only because Android CIDs are unique across the ACL * connections */ auto iter = find_if(devices_.begin(), devices_.end(), [&lcid](const eatt_device& ed) { auto it = ed.eatt_channels.find(lcid); return it != ed.eatt_channels.end(); }); return (iter == devices_.end()) ? nullptr : &(*iter); } EattChannel* find_channel_by_cid(uint16_t lcid) { eatt_device* eatt_dev = find_device_by_cid(lcid); if (!eatt_dev) return nullptr; auto it = eatt_dev->eatt_channels.find(lcid); return (it == eatt_dev->eatt_channels.end()) ? nullptr : it->second.get(); } EattChannel* find_channel_by_cid(const RawAddress& bdaddr, uint16_t lcid) { eatt_device* eatt_dev = find_device_by_address(bdaddr); if (!eatt_dev) return nullptr; auto it = eatt_dev->eatt_channels.find(lcid); return (it == eatt_dev->eatt_channels.end()) ? nullptr : it->second.get(); } void remove_channel_by_cid(eatt_device* eatt_dev, uint16_t lcid) { eatt_dev->eatt_channels.erase(lcid); if (eatt_dev->eatt_channels.size() == 0) eatt_dev->eatt_tcb_ = NULL; } void remove_channel_by_cid(uint16_t lcid) { eatt_device* eatt_dev = find_device_by_cid(lcid); if (!eatt_dev) return; remove_channel_by_cid(eatt_dev, lcid); } void eatt_l2cap_connect_ind(const RawAddress& bda, std::vector& lcids, uint16_t psm, uint16_t peer_mtu, uint8_t identifier) { /* The assumption is that L2CAP layer already check parameters etc. * Get our capabilities and accept all the channels. */ eatt_device* eatt_dev = this->find_device_by_address(bda); if (!eatt_dev) { LOG(ERROR) << __func__ << " unknown device: " << bda; L2CA_ConnectCreditBasedRsp(bda, identifier, lcids, L2CAP_CONN_NO_RESOURCES, NULL); return; } uint16_t max_mps = controller_get_interface()->get_acl_data_size_ble(); tL2CAP_LE_CFG_INFO local_coc_cfg = { .mtu = eatt_dev->rx_mtu_, .mps = eatt_dev->rx_mps_ < max_mps ? eatt_dev->rx_mps_ : max_mps, .credits = L2CAP_LE_CREDIT_DEFAULT}; if (!L2CA_ConnectCreditBasedRsp(bda, identifier, lcids, L2CAP_CONN_OK, &local_coc_cfg)) return; if (!eatt_dev->eatt_tcb_) { eatt_dev->eatt_tcb_ = gatt_find_tcb_by_addr(eatt_dev->bda_, BT_TRANSPORT_LE); CHECK(eatt_dev->eatt_tcb_); } for (uint16_t cid : lcids) { EattChannel* channel = find_eatt_channel_by_cid(bda, cid); CHECK(!channel); auto chan = std::make_shared(eatt_dev->bda_, cid, peer_mtu, eatt_dev->rx_mtu_); eatt_dev->eatt_channels.insert({cid, chan}); chan->EattChannelSetState(EattChannelState::EATT_CHANNEL_OPENED); eatt_dev->eatt_tcb_->eatt++; LOG(INFO) << __func__ << " Channel connected CID " << loghex(cid); } } void eatt_l2cap_connect_cfm(const RawAddress& bda, uint16_t lcid, uint16_t peer_mtu, uint16_t result) { LOG(INFO) << __func__ << " bda: " << bda << " cid: " << +lcid << "peer mtu: " << +peer_mtu << " result " << +result; eatt_device* eatt_dev = find_device_by_address(bda); if (!eatt_dev) { LOG(ERROR) << __func__ << " unknown device"; return; } EattChannel* channel = this->find_channel_by_cid(bda, lcid); if (!channel) { LOG(ERROR) << __func__ << " unknown cid: " << loghex(lcid); return; } if (result != L2CAP_CONN_OK) { LOG(ERROR) << __func__ << " Could not connect CoC result: " << loghex(result); remove_channel_by_cid(eatt_dev, lcid); return; } channel->EattChannelSetState(EattChannelState::EATT_CHANNEL_OPENED); channel->EattChannelSetTxMTU(peer_mtu); CHECK(eatt_dev->eatt_tcb_); CHECK(eatt_dev->bda_ == channel->bda_); eatt_dev->eatt_tcb_->eatt++; LOG(INFO) << __func__ << " Channel connected CID " << loghex(lcid); } void eatt_l2cap_reconfig_completed(const RawAddress& bda, uint16_t lcid, bool is_local_cfg, tL2CAP_LE_CFG_INFO* p_cfg) { LOG(INFO) << __func__ << "lcid: " << loghex(lcid) << " local cfg?: " << is_local_cfg; if (p_cfg->result != L2CAP_CFG_OK) { LOG(INFO) << __func__ << " reconfig failed lcid: " << loghex(lcid) << " result: " << loghex(p_cfg->result); return; } EattChannel* channel = find_channel_by_cid(bda, lcid); if (!channel) return; /* On this layer we don't care about mps as this is handled in L2CAP layer */ if (is_local_cfg) channel->rx_mtu_ = p_cfg->mtu; else channel->EattChannelSetTxMTU(p_cfg->mtu); /* Go back to open state */ channel->EattChannelSetState(EattChannelState::EATT_CHANNEL_OPENED); } void eatt_l2cap_error_cb(uint16_t lcid, uint16_t reason) { LOG(INFO) << __func__ << " cid: " << loghex(lcid) << " reason " << loghex(reason); /*TODO: provide address in the L2CAP callback */ EattChannel* channel = find_channel_by_cid(lcid); if (!channel) { LOG(ERROR) << __func__ << "Unknown lcid"; return; } eatt_device* eatt_dev = find_device_by_address(channel->bda_); switch (channel->state_) { case EattChannelState::EATT_CHANNEL_PENDING: LOG(ERROR) << "Connecting failed"; remove_channel_by_cid(eatt_dev, lcid); break; case EattChannelState::EATT_CHANNEL_RECONFIGURING: /* Just go back to open state */ LOG(ERROR) << "Reconfig failed"; channel->EattChannelSetState(EattChannelState::EATT_CHANNEL_OPENED); break; default: LOG(ERROR) << __func__ << "Invalid state: " << static_cast(channel->state_); break; } } void eatt_l2cap_disconnect_ind(uint16_t lcid, bool please_confirm) { LOG(INFO) << __func__ << " cid: " << loghex(lcid); eatt_device* eatt_dev = find_device_by_cid(lcid); if (!eatt_dev) { LOG(ERROR) << __func__ << " unknown cid: " << loghex(lcid); return; } eatt_dev->eatt_tcb_->eatt--; remove_channel_by_cid(eatt_dev, lcid); } void eatt_l2cap_data_ind(uint16_t lcid, BT_HDR* data_p) { LOG(INFO) << __func__ << " cid: " << loghex(lcid); eatt_device* eatt_dev = find_device_by_cid(lcid); if (!eatt_dev) { LOG(ERROR) << __func__ << " unknown cid: " << loghex(lcid); return; } EattChannel* channel = find_channel_by_cid(eatt_dev->bda_, lcid); if (!channel) { LOG(ERROR) << __func__ << "Received data on closed channel " << loghex(lcid); return; } gatt_data_process(*eatt_dev->eatt_tcb_, channel->cid_, data_p); osi_free(data_p); } bool is_eatt_supported_by_peer(const RawAddress& bd_addr) { return gatt_profile_get_eatt_support(bd_addr); } eatt_device* find_device_by_address(const RawAddress& bd_addr) { auto iter = find_if( devices_.begin(), devices_.end(), [&bd_addr](const eatt_device& ed) { return ed.bda_ == bd_addr; }); return iter == devices_.end() ? nullptr : &(*iter); } eatt_device* add_eatt_device(const RawAddress& bd_addr) { devices_.push_back(eatt_device(bd_addr, default_mtu_, max_mps_)); eatt_device* eatt_dev = &devices_.back(); return eatt_dev; } void connect_eatt(eatt_device* eatt_dev) { /* Let us use maximum possible mps */ if (eatt_dev->rx_mps_ == EATT_MIN_MTU_MPS) eatt_dev->rx_mps_ = controller_get_interface()->get_acl_data_size_ble(); tL2CAP_LE_CFG_INFO local_coc_cfg = { .mtu = eatt_dev->rx_mtu_, .mps = eatt_dev->rx_mps_, .credits = L2CAP_LE_CREDIT_DEFAULT, }; /* Warning! CIDs in Android are unique across the ACL connections */ std::vector connecting_cids = L2CA_ConnectCreditBasedReq(psm_, eatt_dev->bda_, &local_coc_cfg); if (connecting_cids.size() == 0) { LOG(ERROR) << "Unable to get cid"; return; } LOG(INFO) << __func__ << "Successfully sent CoC request, number of channel: " << +connecting_cids.size(); for (uint16_t cid : connecting_cids) { LOG(INFO) << " \t cid: " << loghex(cid); auto chan = std::make_shared(eatt_dev->bda_, cid, 0, eatt_dev->rx_mtu_); eatt_dev->eatt_channels.insert({cid, chan}); } if (eatt_dev->eatt_tcb_) { LOG(INFO) << __func__ << " has tcb ? " << eatt_dev->eatt_tcb_; return; } eatt_dev->eatt_tcb_ = gatt_find_tcb_by_addr(eatt_dev->bda_, BT_TRANSPORT_LE); CHECK(eatt_dev->eatt_tcb_); } EattChannel* find_eatt_channel_by_cid(const RawAddress& bd_addr, uint16_t cid) { eatt_device* eatt_dev = find_device_by_address(bd_addr); LOG(INFO) << __func__ << bd_addr << " " << +cid; if (!eatt_dev) return nullptr; auto iter = find_if( eatt_dev->eatt_channels.begin(), eatt_dev->eatt_channels.end(), [&cid](const std::pair>& el) { return el.first == cid; }); return iter == eatt_dev->eatt_channels.end() ? nullptr : iter->second.get(); } EattChannel* find_eatt_channel_by_transid(const RawAddress& bd_addr, uint32_t trans_id) { eatt_device* eatt_dev = find_device_by_address(bd_addr); if (!eatt_dev) return nullptr; auto iter = find_if( eatt_dev->eatt_channels.begin(), eatt_dev->eatt_channels.end(), [&trans_id]( const std::pair>& el) { return el.second->server_outstanding_cmd_.trans_id == trans_id; }); return iter == eatt_dev->eatt_channels.end() ? nullptr : iter->second.get(); } bool is_indication_pending(const RawAddress& bd_addr, uint16_t indication_handle) { eatt_device* eatt_dev = find_device_by_address(bd_addr); if (!eatt_dev) return false; auto iter = find_if( eatt_dev->eatt_channels.begin(), eatt_dev->eatt_channels.end(), [&indication_handle]( const std::pair>& el) { return el.second->indicate_handle_ == indication_handle; }); return (iter != eatt_dev->eatt_channels.end()); }; EattChannel* get_channel_available_for_indication(const RawAddress& bd_addr) { eatt_device* eatt_dev = find_device_by_address(bd_addr); auto iter = find_if( eatt_dev->eatt_channels.begin(), eatt_dev->eatt_channels.end(), [](const std::pair>& el) { return !GATT_HANDLE_IS_VALID(el.second->indicate_handle_); }); return (iter == eatt_dev->eatt_channels.end()) ? nullptr : iter->second.get(); }; EattChannel* get_channel_available_for_client_request( const RawAddress& bd_addr) { eatt_device* eatt_dev = find_device_by_address(bd_addr); if (!eatt_dev) return nullptr; auto iter = find_if( eatt_dev->eatt_channels.begin(), eatt_dev->eatt_channels.end(), [](const std::pair>& el) { return el.second->cl_cmd_q_.empty(); }); return (iter == eatt_dev->eatt_channels.end()) ? nullptr : iter->second.get(); } void free_gatt_resources(const RawAddress& bd_addr) { eatt_device* eatt_dev = find_device_by_address(bd_addr); if (!eatt_dev) return; auto iter = eatt_dev->eatt_channels.begin(); while (iter != eatt_dev->eatt_channels.end()) { EattChannel* channel = iter->second.get(); fixed_queue_free(channel->server_outstanding_cmd_.multi_rsp_q, NULL); channel->server_outstanding_cmd_.multi_rsp_q = NULL; } } bool is_outstanding_msg_in_send_queue(const RawAddress& bd_addr) { eatt_device* eatt_dev = find_device_by_address(bd_addr); if (!eatt_dev) return false; auto iter = find_if( eatt_dev->eatt_channels.begin(), eatt_dev->eatt_channels.end(), [](const std::pair>& el) { return !el.second->cl_cmd_q_.empty(); }); return (iter != eatt_dev->eatt_channels.end()); } EattChannel* get_channel_with_queued_data(const RawAddress& bd_addr) { eatt_device* eatt_dev = find_device_by_address(bd_addr); if (!eatt_dev) return nullptr; auto iter = find_if( eatt_dev->eatt_channels.begin(), eatt_dev->eatt_channels.end(), [](const std::pair>& el) { return !el.second->cl_cmd_q_.empty(); }); return (iter == eatt_dev->eatt_channels.end()) ? nullptr : iter->second.get(); } static void eatt_ind_ack_timeout(void* data) { EattChannel* channel = (EattChannel*)data; tGATT_TCB* p_tcb = gatt_find_tcb_by_addr(channel->bda_, BT_TRANSPORT_LE); LOG(WARNING) << __func__ << ": send ack now"; attp_send_cl_confirmation_msg(*p_tcb, channel->cid_); } static void eatt_ind_confirmation_timeout(void* data) { EattChannel* channel = (EattChannel*)data; tGATT_TCB* p_tcb = gatt_find_tcb_by_addr(channel->bda_, BT_TRANSPORT_LE); LOG(WARNING) << __func__ << " disconnecting..."; gatt_disconnect(p_tcb); } void start_indication_confirm_timer(const RawAddress& bd_addr, uint16_t cid) { EattChannel* channel = find_eatt_channel_by_cid(bd_addr, cid); if (!channel) { LOG(ERROR) << __func__ << "Unknown cid: " << loghex(cid) << " or device " << bd_addr; return; } alarm_set_on_mloop(channel->ind_confirmation_timer_, GATT_WAIT_FOR_RSP_TIMEOUT_MS, eatt_ind_confirmation_timeout, channel); } void stop_indication_confirm_timer(const RawAddress& bd_addr, uint16_t cid) { EattChannel* channel = find_eatt_channel_by_cid(bd_addr, cid); if (!channel) { LOG(ERROR) << __func__ << "Unknown cid: " << loghex(cid) << " or device " << bd_addr; return; } alarm_cancel(channel->ind_confirmation_timer_); } void start_app_indication_timer(const RawAddress& bd_addr, uint16_t cid) { EattChannel* channel = find_eatt_channel_by_cid(bd_addr, cid); if (!channel) { LOG(ERROR) << __func__ << "Unknown cid: " << loghex(cid) << " or device " << bd_addr; return; } alarm_set_on_mloop(channel->ind_ack_timer_, GATT_WAIT_FOR_RSP_TIMEOUT_MS, eatt_ind_ack_timeout, channel); } void stop_app_indication_timer(const RawAddress& bd_addr, uint16_t cid) { EattChannel* channel = find_eatt_channel_by_cid(bd_addr, cid); if (!channel) { LOG(ERROR) << __func__ << "Unknown cid: " << loghex(cid) << " or device " << bd_addr; return; } alarm_cancel(channel->ind_ack_timer_); } void reconfigure(const RawAddress& bd_addr, uint16_t cid, uint16_t new_mtu) { eatt_device* eatt_dev = find_device_by_address(bd_addr); if (!eatt_dev) { LOG(ERROR) << __func__ << "Unknown device " << bd_addr; return; } EattChannel* channel = find_eatt_channel_by_cid(bd_addr, cid); if (!channel) { LOG(ERROR) << __func__ << "Unknown cid: " << loghex(cid) << " or device " << bd_addr; return; } if (new_mtu <= channel->rx_mtu_) { LOG(ERROR) << __func__ << "Invalid mtu: " << loghex(new_mtu); return; } std::vector cids = {cid}; tL2CAP_LE_CFG_INFO cfg = {.mps = eatt_dev->rx_mps_, .mtu = new_mtu}; if (!L2CA_ReconfigCreditBasedConnsReq(eatt_dev->bda_, cids, &cfg)) LOG(ERROR) << __func__ << "Could not start reconfig cid: " << loghex(cid) << " or device " << bd_addr; } void reconfigure_all(const RawAddress& bd_addr, uint16_t new_mtu) { eatt_device* eatt_dev = find_device_by_address(bd_addr); if (!eatt_dev) { LOG(ERROR) << __func__ << "Unknown device " << bd_addr; return; } uint8_t num_of_channels = eatt_dev->eatt_channels.size(); if (num_of_channels == 0) { LOG(ERROR) << __func__ << "No channels for device " << bd_addr; return; } std::vector cids; auto iter = eatt_dev->eatt_channels.begin(); while (iter != eatt_dev->eatt_channels.end()) { uint16_t cid = iter->first; cids.push_back(cid); iter++; } if (new_mtu <= EATT_MIN_MTU_MPS) { LOG(ERROR) << __func__ << "Invalid mtu: " << loghex(new_mtu); return; } tL2CAP_LE_CFG_INFO cfg = {.mps = eatt_dev->rx_mps_, .mtu = new_mtu}; if (!L2CA_ReconfigCreditBasedConnsReq(eatt_dev->bda_, cids, &cfg)) LOG(ERROR) << __func__ << "Could not start reconfig for device " << bd_addr; } void supported_features_cb(uint8_t role, const RawAddress& bd_addr, uint8_t features) { bool is_eatt_supported = features & BLE_GATT_SVR_SUP_FEAT_EATT_BITMASK; LOG(INFO) << __func__ << " " << bd_addr << " is_eatt_supported = " << int(is_eatt_supported); if (!is_eatt_supported) return; eatt_device* eatt_dev = add_eatt_device(bd_addr); if (role != HCI_ROLE_CENTRAL) { /* TODO For now do nothing, we could run a timer here and start EATT if * not started by central */ LOG(INFO) << " EATT Should be connected by the central. Let's wait for it."; return; } connect_eatt(eatt_dev); } void disconnect_channel(uint16_t cid) { L2CA_DisconnectReq(cid); } void disconnect(const RawAddress& bd_addr) { LOG(INFO) << __func__ << " " << bd_addr; eatt_device* eatt_dev = find_device_by_address(bd_addr); if (!eatt_dev) { LOG(WARNING) << __func__ << " no eatt device found"; return; } if (!eatt_dev->eatt_tcb_) { LOG_ASSERT(eatt_dev->eatt_channels.size() == 0); LOG(WARNING) << __func__ << " no eatt channels found"; return; } auto iter = eatt_dev->eatt_channels.begin(); while (iter != eatt_dev->eatt_channels.end()) { uint16_t cid = iter->first; disconnect_channel(cid); /* When initiating disconnection, stack will not notify us that it is * done. We need to assume success */ iter = eatt_dev->eatt_channels.erase(iter); } eatt_dev->eatt_tcb_->eatt = 0; eatt_dev->eatt_tcb_ = nullptr; } void connect(const RawAddress& bd_addr) { eatt_device* eatt_dev = find_device_by_address(bd_addr); uint8_t role = L2CA_GetBleConnRole(bd_addr); if (role == HCI_ROLE_UNKNOWN) { LOG(ERROR) << __func__ << "Could not get device role" << bd_addr; return; } LOG(INFO) << __func__ << " device " << bd_addr << " role" << (role == HCI_ROLE_CENTRAL ? "central" : "peripheral"); if (eatt_dev) { /* We are reconnecting device we know that support EATT. * Just connect CoC */ LOG(INFO) << __func__ << " Known device, connect eCoC"; if (role != HCI_ROLE_CENTRAL) { LOG(INFO) << " EATT Should be connected by the central. Let's wait for it."; return; } connect_eatt(eatt_dev); return; } /* For new device, first read GATT server supported features. */ if (gatt_cl_read_sr_supp_feat_req( bd_addr, base::BindOnce(&eatt_impl::supported_features_cb, base::Unretained(this), role)) == false) { LOG(INFO) << __func__ << "Eatt is not supported. Checked for device " << bd_addr; } } void add_from_storage(const RawAddress& bd_addr) { eatt_device* eatt_dev = find_device_by_address(bd_addr); LOG(INFO) << __func__ << ", restoring: " << bd_addr; if (!eatt_dev) add_eatt_device(bd_addr); } }; } // namespace eatt } // namespace bluetooth