Gitiles
Code Review Sign In
LeafOS / LeafOS-Project / android_packages_modules_Bluetooth / d8b48c6221887ac8d651df642aaedfff7be482e4 / . / system / stack / l2cap / l2c_utils.cc
blob: 85ef00358d1b652875b492522ca794977973bf0f [file] [log] [blame]
/******************************************************************************
*
* 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 L2CAP utility functions
*
******************************************************************************/
#define LOG_TAG "l2c_utils"
#include <base/logging.h>
#include <bluetooth/log.h>
#include <stdio.h>
#include <string.h>
#include "device/include/controller.h"
#include "hal/snoop_logger.h"
#include "hci/controller_interface.h"
#include "internal_include/bt_target.h"
#include "main/shim/entry.h"
#include "os/log.h"
#include "osi/include/allocator.h"
#include "stack/btm/btm_sec.h"
#include "stack/include/acl_api.h"
#include "stack/include/bt_hdr.h"
#include "stack/include/bt_types.h"
#include "stack/include/btm_api.h"
#include "stack/include/hci_error_code.h"
#include "stack/include/hcidefs.h"
#include "stack/include/l2c_api.h"
#include "stack/include/l2cap_acl_interface.h"
#include "stack/include/l2cap_hci_link_interface.h"
#include "stack/include/l2cdefs.h"
#include "stack/l2cap/l2c_int.h"
#include "types/raw_address.h"
using namespace bluetooth;
tL2C_CCB* l2cu_get_next_channel_in_rr(tL2C_LCB* p_lcb); // TODO Move
/*******************************************************************************
*
* Function l2cu_allocate_lcb
*
* Description Look for an unused LCB
*
* Returns LCB address or NULL if none found
*
******************************************************************************/
tL2C_LCB* l2cu_allocate_lcb(const RawAddress& p_bd_addr, bool is_bonding,
tBT_TRANSPORT transport) {
int xx;
tL2C_LCB* p_lcb = &l2cb.lcb_pool[0];
for (xx = 0; xx < MAX_L2CAP_LINKS; xx++, p_lcb++) {
if (!p_lcb->in_use) {
alarm_free(p_lcb->l2c_lcb_timer);
alarm_free(p_lcb->info_resp_timer);
memset(p_lcb, 0, sizeof(tL2C_LCB));
p_lcb->remote_bd_addr = p_bd_addr;
p_lcb->in_use = true;
p_lcb->with_active_local_clients = false;
p_lcb->link_state = LST_DISCONNECTED;
p_lcb->InvalidateHandle();
p_lcb->l2c_lcb_timer = alarm_new("l2c_lcb.l2c_lcb_timer");
p_lcb->info_resp_timer = alarm_new("l2c_lcb.info_resp_timer");
p_lcb->idle_timeout = l2cb.idle_timeout;
p_lcb->signal_id = 1; /* spec does not allow '0' */
if (is_bonding) {
p_lcb->SetBonding();
} else {
p_lcb->ResetBonding();
}
p_lcb->transport = transport;
p_lcb->tx_data_len =
controller_get_interface()->get_ble_default_data_packet_length();
p_lcb->le_sec_pending_q = fixed_queue_new(SIZE_MAX);
if (transport == BT_TRANSPORT_LE) {
l2cb.num_ble_links_active++;
l2c_ble_link_adjust_allocation();
} else {
l2cb.num_used_lcbs++;
l2c_link_adjust_allocation();
}
p_lcb->link_xmit_data_q = list_new(NULL);
return (p_lcb);
}
}
/* If here, no free LCB found */
return (NULL);
}
void l2cu_set_lcb_handle(struct t_l2c_linkcb& p_lcb, uint16_t handle) {
if (p_lcb.Handle() != HCI_INVALID_HANDLE) {
log::warn("Should not replace active handle:{} with new handle:{}",
p_lcb.Handle(), handle);
}
p_lcb.SetHandle(handle);
}
/*******************************************************************************
*
* Function l2cu_update_lcb_4_bonding
*
* Description Mark the lcb for bonding. Used when bonding takes place on
* an existing ACL connection. (Pre-Lisbon devices)
*
* Returns Nothing
*
******************************************************************************/
void l2cu_update_lcb_4_bonding(const RawAddress& p_bd_addr, bool is_bonding) {
tL2C_LCB* p_lcb = l2cu_find_lcb_by_bd_addr(p_bd_addr, BT_TRANSPORT_BR_EDR);
if (p_lcb) {
log::verbose("BDA: {} is_bonding: {}", ADDRESS_TO_LOGGABLE_STR(p_bd_addr),
is_bonding);
if (is_bonding) {
p_lcb->SetBonding();
} else {
p_lcb->ResetBonding();
}
}
}
/*******************************************************************************
*
* Function l2cu_release_lcb
*
* Description Release an LCB. All timers will be stopped and freed,
* channels dropped, buffers returned etc.
*
* Returns void
*
******************************************************************************/
void l2cu_release_lcb(tL2C_LCB* p_lcb) {
tL2C_CCB* p_ccb;
p_lcb->in_use = false;
p_lcb->ResetBonding();
/* Stop and free timers */
alarm_free(p_lcb->l2c_lcb_timer);
p_lcb->l2c_lcb_timer = NULL;
alarm_free(p_lcb->info_resp_timer);
p_lcb->info_resp_timer = NULL;
if (p_lcb->transport == BT_TRANSPORT_BR_EDR) /* Release all SCO links */
BTM_RemoveSco(p_lcb->remote_bd_addr);
if (p_lcb->sent_not_acked > 0) {
if (p_lcb->transport == BT_TRANSPORT_LE) {
l2cb.controller_le_xmit_window += p_lcb->sent_not_acked;
if (l2cb.controller_le_xmit_window > l2cb.num_lm_ble_bufs) {
l2cb.controller_le_xmit_window = l2cb.num_lm_ble_bufs;
}
} else {
l2cb.controller_xmit_window += p_lcb->sent_not_acked;
if (l2cb.controller_xmit_window > l2cb.num_lm_acl_bufs) {
l2cb.controller_xmit_window = l2cb.num_lm_acl_bufs;
}
}
}
l2cu_process_fixed_disc_cback(p_lcb);
/* Ensure no CCBs left on this LCB */
for (p_ccb = p_lcb->ccb_queue.p_first_ccb; p_ccb;
p_ccb = p_lcb->ccb_queue.p_first_ccb) {
l2cu_release_ccb(p_ccb);
}
/* Tell BTM Acl management the link was removed */
if ((p_lcb->link_state == LST_CONNECTED) ||
(p_lcb->link_state == LST_DISCONNECTING))
btm_acl_removed(p_lcb->Handle());
/* Release any held buffers */
if (p_lcb->link_xmit_data_q) {
while (!list_is_empty(p_lcb->link_xmit_data_q)) {
BT_HDR* p_buf = static_cast<BT_HDR*>(list_front(p_lcb->link_xmit_data_q));
list_remove(p_lcb->link_xmit_data_q, p_buf);
osi_free(p_buf);
}
list_free(p_lcb->link_xmit_data_q);
p_lcb->link_xmit_data_q = NULL;
}
/* Re-adjust flow control windows make sure it does not go negative */
if (p_lcb->transport == BT_TRANSPORT_LE) {
if (l2cb.num_ble_links_active >= 1) l2cb.num_ble_links_active--;
l2c_ble_link_adjust_allocation();
} else {
if (l2cb.num_used_lcbs >= 1) l2cb.num_used_lcbs--;
l2c_link_adjust_allocation();
}
/* Check and release all the LE COC connections waiting for security */
if (p_lcb->le_sec_pending_q) {
while (!fixed_queue_is_empty(p_lcb->le_sec_pending_q)) {
tL2CAP_SEC_DATA* p_buf =
(tL2CAP_SEC_DATA*)fixed_queue_try_dequeue(p_lcb->le_sec_pending_q);
if (p_buf->p_callback)
p_buf->p_callback(&p_lcb->remote_bd_addr, p_lcb->transport,
p_buf->p_ref_data, BTM_DEV_RESET);
osi_free(p_buf);
}
fixed_queue_free(p_lcb->le_sec_pending_q, NULL);
p_lcb->le_sec_pending_q = NULL;
}
}
/*******************************************************************************
*
* Function l2cu_find_lcb_by_bd_addr
*
* Description Look through all active LCBs for a match based on the
* remote BD address.
*
* Returns pointer to matched LCB, or NULL if no match
*
******************************************************************************/
tL2C_LCB* l2cu_find_lcb_by_bd_addr(const RawAddress& p_bd_addr,
tBT_TRANSPORT transport) {
int xx;
tL2C_LCB* p_lcb = &l2cb.lcb_pool[0];
for (xx = 0; xx < MAX_L2CAP_LINKS; xx++, p_lcb++) {
if ((p_lcb->in_use) && p_lcb->transport == transport &&
(p_lcb->remote_bd_addr == p_bd_addr)) {
return (p_lcb);
}
}
/* If here, no match found */
return (NULL);
}
/*******************************************************************************
*
* Function l2c_is_cmd_rejected
*
* Description Checks if cmd_code is command or response
* If a command it will be rejected per spec.
* This function is used when a illegal packet length is
* detected.
*
* Returns bool - true if cmd_code is a command and it is rejected,
* false if response code. (command not rejected)
*
******************************************************************************/
bool l2c_is_cmd_rejected(uint8_t cmd_code, uint8_t signal_id, tL2C_LCB* p_lcb) {
switch (cmd_code) {
case L2CAP_CMD_CONN_REQ:
case L2CAP_CMD_CONFIG_REQ:
case L2CAP_CMD_DISC_REQ:
case L2CAP_CMD_ECHO_REQ:
case L2CAP_CMD_INFO_REQ:
case L2CAP_CMD_AMP_CONN_REQ:
case L2CAP_CMD_AMP_MOVE_REQ:
case L2CAP_CMD_BLE_UPDATE_REQ:
l2cu_send_peer_cmd_reject(p_lcb, L2CAP_CMD_REJ_MTU_EXCEEDED, signal_id,
L2CAP_DEFAULT_MTU, 0);
log::warn("Dumping first Command ({})", cmd_code);
return true;
default: /* Otherwise a response */
return false;
}
}
/*******************************************************************************
*
* Function l2cu_build_header
*
* Description Builds the L2CAP command packet header
*
* Returns Pointer to allocated packet or NULL if no resources
*
******************************************************************************/
BT_HDR* l2cu_build_header(tL2C_LCB* p_lcb, uint16_t len, uint8_t cmd,
uint8_t signal_id) {
BT_HDR* p_buf = (BT_HDR*)osi_malloc(L2CAP_CMD_BUF_SIZE);
uint8_t* p;
p_buf->offset = L2CAP_SEND_CMD_OFFSET;
p_buf->len =
len + HCI_DATA_PREAMBLE_SIZE + L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD;
p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET;
/* Put in HCI header - handle + pkt boundary */
if (p_lcb->transport == BT_TRANSPORT_LE) {
UINT16_TO_STREAM(p, (p_lcb->Handle() | (L2CAP_PKT_START_NON_FLUSHABLE
<< L2CAP_PKT_TYPE_SHIFT)));
} else {
UINT16_TO_STREAM(p, p_lcb->Handle() | l2cb.non_flushable_pbf);
}
UINT16_TO_STREAM(p, len + L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD);
UINT16_TO_STREAM(p, len + L2CAP_CMD_OVERHEAD);
if (p_lcb->transport == BT_TRANSPORT_LE) {
UINT16_TO_STREAM(p, L2CAP_BLE_SIGNALLING_CID);
} else {
UINT16_TO_STREAM(p, L2CAP_SIGNALLING_CID);
}
/* Put in L2CAP command header */
UINT8_TO_STREAM(p, cmd);
UINT8_TO_STREAM(p, signal_id);
UINT16_TO_STREAM(p, len);
return (p_buf);
}
/*******************************************************************************
*
* Function l2cu_adj_id
*
* Description Checks for valid ID based on specified mask
* and adjusts the id if invalid.
*
* Returns void
*
******************************************************************************/
void l2cu_adj_id(tL2C_LCB* p_lcb) {
if (p_lcb->signal_id == 0) {
p_lcb->signal_id++;
}
}
/*******************************************************************************
*
* Function l2cu_send_peer_cmd_reject
*
* Description Build and send an L2CAP "command reject" message
* to the peer.
*
* Returns void
*
******************************************************************************/
void l2cu_send_peer_cmd_reject(tL2C_LCB* p_lcb, uint16_t reason, uint8_t rem_id,
uint16_t p1, uint16_t p2) {
uint16_t param_len;
BT_HDR* p_buf;
uint8_t* p;
/* Put in L2CAP packet header */
if (reason == L2CAP_CMD_REJ_MTU_EXCEEDED)
param_len = 2;
else if (reason == L2CAP_CMD_REJ_INVALID_CID)
param_len = 4;
else
param_len = 0;
p_buf = l2cu_build_header(p_lcb, (uint16_t)(L2CAP_CMD_REJECT_LEN + param_len),
L2CAP_CMD_REJECT, rem_id);
if (p_buf == NULL) {
log::warn("L2CAP - no buffer cmd_rej");
return;
}
p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET + HCI_DATA_PREAMBLE_SIZE +
L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD;
UINT16_TO_STREAM(p, reason);
if (param_len >= 2) UINT16_TO_STREAM(p, p1);
if (param_len >= 4) UINT16_TO_STREAM(p, p2);
l2c_link_check_send_pkts(p_lcb, 0, p_buf);
}
/*******************************************************************************
*
* Function l2cu_send_peer_connect_req
*
* Description Build and send an L2CAP "connection request" message
* to the peer.
*
* Returns void
*
******************************************************************************/
void l2cu_send_peer_connect_req(tL2C_CCB* p_ccb) {
BT_HDR* p_buf;
uint8_t* p;
/* Create an identifier for this packet */
p_ccb->p_lcb->signal_id++;
l2cu_adj_id(p_ccb->p_lcb);
p_ccb->local_id = p_ccb->p_lcb->signal_id;
p_buf = l2cu_build_header(p_ccb->p_lcb, L2CAP_CONN_REQ_LEN,
L2CAP_CMD_CONN_REQ, p_ccb->local_id);
if (p_buf == NULL) {
log::warn("L2CAP - no buffer for conn_req");
return;
}
p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET + HCI_DATA_PREAMBLE_SIZE +
L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD;
UINT16_TO_STREAM(p, p_ccb->p_rcb->real_psm);
UINT16_TO_STREAM(p, p_ccb->local_cid);
l2c_link_check_send_pkts(p_ccb->p_lcb, 0, p_buf);
}
/*******************************************************************************
*
* Function l2cu_send_peer_connect_rsp
*
* Description Build and send an L2CAP "connection response" message
* to the peer.
*
* Returns void
*
******************************************************************************/
void l2cu_send_peer_connect_rsp(tL2C_CCB* p_ccb, uint16_t result,
uint16_t status) {
if (result == L2CAP_CONN_PENDING) {
/* if we already sent pending response */
if (p_ccb->flags & CCB_FLAG_SENT_PENDING) {
log::debug("Already sent connection pending, not sending again");
return;
} else {
p_ccb->flags |= CCB_FLAG_SENT_PENDING;
}
}
BT_HDR* p_buf = l2cu_build_header(p_ccb->p_lcb, L2CAP_CONN_RSP_LEN,
L2CAP_CMD_CONN_RSP, p_ccb->remote_id);
if (p_buf == nullptr) {
log::warn("no buffer for conn_rsp");
return;
}
uint8_t* p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET +
HCI_DATA_PREAMBLE_SIZE + L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD;
UINT16_TO_STREAM(p, p_ccb->local_cid);
UINT16_TO_STREAM(p, p_ccb->remote_cid);
UINT16_TO_STREAM(p, result);
UINT16_TO_STREAM(p, status);
l2c_link_check_send_pkts(p_ccb->p_lcb, 0, p_buf);
}
/*******************************************************************************
*
* Function l2cu_reject_connection
*
* Description Build and send an L2CAP "connection response neg" message
* to the peer. This function is called when there is no peer
* CCB (non-existant PSM or no resources).
*
* Returns void
*
******************************************************************************/
void l2cu_reject_connection(tL2C_LCB* p_lcb, uint16_t remote_cid,
uint8_t rem_id, uint16_t result) {
BT_HDR* p_buf;
uint8_t* p;
p_buf =
l2cu_build_header(p_lcb, L2CAP_CONN_RSP_LEN, L2CAP_CMD_CONN_RSP, rem_id);
if (p_buf == NULL) {
log::warn("L2CAP - no buffer for conn_req");
return;
}
p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET + HCI_DATA_PREAMBLE_SIZE +
L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD;
UINT16_TO_STREAM(p, 0); /* Local CID of 0 */
UINT16_TO_STREAM(p, remote_cid);
UINT16_TO_STREAM(p, result);
UINT16_TO_STREAM(p, 0); /* Status of 0 */
l2c_link_check_send_pkts(p_lcb, 0, p_buf);
}
/*******************************************************************************
*
* Function l2cu_send_credit_based_reconfig_req
*
* Description Build and send an L2CAP "recoonfiguration request" message
* to the peer.
*
* Returns void
*
******************************************************************************/
void l2cu_send_credit_based_reconfig_req(tL2C_CCB* p_ccb,
tL2CAP_LE_CFG_INFO* p_cfg) {
BT_HDR* p_buf;
uint16_t cmd_len;
uint8_t* p;
tL2C_LCB* p_lcb = p_ccb->p_lcb;
tL2C_CCB* p_ccb_temp;
cmd_len = L2CAP_CMD_CREDIT_BASED_RECONFIG_REQ_MIN_LEN +
sizeof(uint16_t) * p_lcb->pending_ecoc_reconfig_cnt;
/* Create an identifier for this packet */
p_lcb->signal_id++;
l2cu_adj_id(p_lcb);
p_ccb->local_id = p_lcb->signal_id;
p_buf = l2cu_build_header(p_lcb, cmd_len, L2CAP_CMD_CREDIT_BASED_RECONFIG_REQ,
p_lcb->signal_id);
if (p_buf == NULL) {
log::warn("l2cu_send_reconfig_req - no buffer");
return;
}
p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET + HCI_DATA_PREAMBLE_SIZE +
L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD;
log::verbose("l2cu_send_reconfig_req number of cids: {} mtu:{} mps:{}",
p_lcb->pending_ecoc_reconfig_cnt, p_cfg->mtu, p_cfg->mps);
UINT16_TO_STREAM(p, p_cfg->mtu);
UINT16_TO_STREAM(p, p_cfg->mps);
for (p_ccb_temp = p_lcb->ccb_queue.p_first_ccb; p_ccb_temp;
p_ccb_temp = p_ccb_temp->p_next_ccb) {
if ((p_ccb_temp->in_use) && (p_ccb_temp->ecoc) &&
(p_ccb_temp->reconfig_started))
UINT16_TO_STREAM(p, p_ccb_temp->local_cid);
}
l2c_link_check_send_pkts(p_lcb, 0, p_buf);
}
/*******************************************************************************
*
* Function l2cu_send_peer_config_req
*
* Description Build and send an L2CAP "configuration request" message
* to the peer.
*
* Returns void
*
******************************************************************************/
void l2cu_send_peer_config_req(tL2C_CCB* p_ccb, tL2CAP_CFG_INFO* p_cfg) {
BT_HDR* p_buf;
uint16_t cfg_len = 0;
uint8_t* p;
/* Create an identifier for this packet */
p_ccb->p_lcb->signal_id++;
l2cu_adj_id(p_ccb->p_lcb);
p_ccb->local_id = p_ccb->p_lcb->signal_id;
if (p_cfg->mtu_present)
cfg_len += L2CAP_CFG_MTU_OPTION_LEN + L2CAP_CFG_OPTION_OVERHEAD;
if (p_cfg->flush_to_present)
cfg_len += L2CAP_CFG_FLUSH_OPTION_LEN + L2CAP_CFG_OPTION_OVERHEAD;
if (p_cfg->qos_present)
cfg_len += L2CAP_CFG_QOS_OPTION_LEN + L2CAP_CFG_OPTION_OVERHEAD;
if (p_cfg->fcr_present)
cfg_len += L2CAP_CFG_FCR_OPTION_LEN + L2CAP_CFG_OPTION_OVERHEAD;
if (p_cfg->fcs_present)
cfg_len += L2CAP_CFG_FCS_OPTION_LEN + L2CAP_CFG_OPTION_OVERHEAD;
if (p_cfg->ext_flow_spec_present)
cfg_len += L2CAP_CFG_EXT_FLOW_OPTION_LEN + L2CAP_CFG_OPTION_OVERHEAD;
p_buf = l2cu_build_header(p_ccb->p_lcb,
(uint16_t)(L2CAP_CONFIG_REQ_LEN + cfg_len),
L2CAP_CMD_CONFIG_REQ, p_ccb->local_id);
if (p_buf == NULL) {
log::warn("L2CAP - no buffer for conn_req");
return;
}
p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET + HCI_DATA_PREAMBLE_SIZE +
L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD;
UINT16_TO_STREAM(p, p_ccb->remote_cid);
UINT16_TO_STREAM(p, p_cfg->flags); /* Flags (continuation) */
/* Now, put the options */
if (p_cfg->mtu_present) {
UINT8_TO_STREAM(p, L2CAP_CFG_TYPE_MTU);
UINT8_TO_STREAM(p, L2CAP_CFG_MTU_OPTION_LEN);
UINT16_TO_STREAM(p, p_cfg->mtu);
}
if (p_cfg->flush_to_present) {
UINT8_TO_STREAM(p, L2CAP_CFG_TYPE_FLUSH_TOUT);
UINT8_TO_STREAM(p, L2CAP_CFG_FLUSH_OPTION_LEN);
UINT16_TO_STREAM(p, p_cfg->flush_to);
}
if (p_cfg->qos_present) {
UINT8_TO_STREAM(p, L2CAP_CFG_TYPE_QOS);
UINT8_TO_STREAM(p, L2CAP_CFG_QOS_OPTION_LEN);
UINT8_TO_STREAM(p, p_cfg->qos.qos_flags);
UINT8_TO_STREAM(p, p_cfg->qos.service_type);
UINT32_TO_STREAM(p, p_cfg->qos.token_rate);
UINT32_TO_STREAM(p, p_cfg->qos.token_bucket_size);
UINT32_TO_STREAM(p, p_cfg->qos.peak_bandwidth);
UINT32_TO_STREAM(p, p_cfg->qos.latency);
UINT32_TO_STREAM(p, p_cfg->qos.delay_variation);
}
if (p_cfg->fcr_present) {
UINT8_TO_STREAM(p, L2CAP_CFG_TYPE_FCR);
UINT8_TO_STREAM(p, L2CAP_CFG_FCR_OPTION_LEN);
UINT8_TO_STREAM(p, p_cfg->fcr.mode);
UINT8_TO_STREAM(p, p_cfg->fcr.tx_win_sz);
UINT8_TO_STREAM(p, p_cfg->fcr.max_transmit);
UINT16_TO_STREAM(p, p_cfg->fcr.rtrans_tout);
UINT16_TO_STREAM(p, p_cfg->fcr.mon_tout);
UINT16_TO_STREAM(p, p_cfg->fcr.mps);
}
if (p_cfg->fcs_present) {
UINT8_TO_STREAM(p, L2CAP_CFG_TYPE_FCS);
UINT8_TO_STREAM(p, L2CAP_CFG_FCS_OPTION_LEN);
UINT8_TO_STREAM(p, p_cfg->fcs);
}
if (p_cfg->ext_flow_spec_present) {
UINT8_TO_STREAM(p, L2CAP_CFG_TYPE_EXT_FLOW);
UINT8_TO_STREAM(p, L2CAP_CFG_EXT_FLOW_OPTION_LEN);
UINT8_TO_STREAM(p, p_cfg->ext_flow_spec.id);
UINT8_TO_STREAM(p, p_cfg->ext_flow_spec.stype);
UINT16_TO_STREAM(p, p_cfg->ext_flow_spec.max_sdu_size);
UINT32_TO_STREAM(p, p_cfg->ext_flow_spec.sdu_inter_time);
UINT32_TO_STREAM(p, p_cfg->ext_flow_spec.access_latency);
UINT32_TO_STREAM(p, p_cfg->ext_flow_spec.flush_timeout);
}
l2c_link_check_send_pkts(p_ccb->p_lcb, 0, p_buf);
}
/*******************************************************************************
*
* Function l2cu_send_peer_config_rsp
*
* Description Build and send an L2CAP "configuration response" message
* to the peer.
*
* Returns void
*
******************************************************************************/
void l2cu_send_peer_config_rsp(tL2C_CCB* p_ccb, tL2CAP_CFG_INFO* p_cfg) {
BT_HDR* p_buf;
uint16_t cfg_len = 0;
uint8_t* p;
/* Create an identifier for this packet */
if (p_cfg->mtu_present)
cfg_len += L2CAP_CFG_MTU_OPTION_LEN + L2CAP_CFG_OPTION_OVERHEAD;
if (p_cfg->flush_to_present)
cfg_len += L2CAP_CFG_FLUSH_OPTION_LEN + L2CAP_CFG_OPTION_OVERHEAD;
if (p_cfg->qos_present)
cfg_len += L2CAP_CFG_QOS_OPTION_LEN + L2CAP_CFG_OPTION_OVERHEAD;
if (p_cfg->fcr_present)
cfg_len += L2CAP_CFG_FCR_OPTION_LEN + L2CAP_CFG_OPTION_OVERHEAD;
if (p_cfg->ext_flow_spec_present)
cfg_len += L2CAP_CFG_EXT_FLOW_OPTION_LEN + L2CAP_CFG_OPTION_OVERHEAD;
p_buf = l2cu_build_header(p_ccb->p_lcb,
(uint16_t)(L2CAP_CONFIG_RSP_LEN + cfg_len),
L2CAP_CMD_CONFIG_RSP, p_ccb->remote_id);
if (p_buf == NULL) {
log::warn("L2CAP - no buffer for conn_req");
return;
}
p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET + HCI_DATA_PREAMBLE_SIZE +
L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD;
UINT16_TO_STREAM(p, p_ccb->remote_cid);
UINT16_TO_STREAM(p,
p_cfg->flags); /* Flags (continuation) Must match request */
UINT16_TO_STREAM(p, p_cfg->result);
/* Now, put the options */
if (p_cfg->mtu_present) {
UINT8_TO_STREAM(p, L2CAP_CFG_TYPE_MTU);
UINT8_TO_STREAM(p, L2CAP_CFG_MTU_OPTION_LEN);
UINT16_TO_STREAM(p, p_cfg->mtu);
}
if (p_cfg->flush_to_present) {
UINT8_TO_STREAM(p, L2CAP_CFG_TYPE_FLUSH_TOUT);
UINT8_TO_STREAM(p, L2CAP_CFG_FLUSH_OPTION_LEN);
UINT16_TO_STREAM(p, p_cfg->flush_to);
}
if (p_cfg->qos_present) {
UINT8_TO_STREAM(p, L2CAP_CFG_TYPE_QOS);
UINT8_TO_STREAM(p, L2CAP_CFG_QOS_OPTION_LEN);
UINT8_TO_STREAM(p, p_cfg->qos.qos_flags);
UINT8_TO_STREAM(p, p_cfg->qos.service_type);
UINT32_TO_STREAM(p, p_cfg->qos.token_rate);
UINT32_TO_STREAM(p, p_cfg->qos.token_bucket_size);
UINT32_TO_STREAM(p, p_cfg->qos.peak_bandwidth);
UINT32_TO_STREAM(p, p_cfg->qos.latency);
UINT32_TO_STREAM(p, p_cfg->qos.delay_variation);
}
if (p_cfg->fcr_present) {
UINT8_TO_STREAM(p, L2CAP_CFG_TYPE_FCR);
UINT8_TO_STREAM(p, L2CAP_CFG_FCR_OPTION_LEN);
UINT8_TO_STREAM(p, p_cfg->fcr.mode);
UINT8_TO_STREAM(p, p_cfg->fcr.tx_win_sz);
UINT8_TO_STREAM(p, p_cfg->fcr.max_transmit);
UINT16_TO_STREAM(p, p_ccb->our_cfg.fcr.rtrans_tout);
UINT16_TO_STREAM(p, p_ccb->our_cfg.fcr.mon_tout);
UINT16_TO_STREAM(p, p_cfg->fcr.mps);
}
if (p_cfg->ext_flow_spec_present) {
UINT8_TO_STREAM(p, L2CAP_CFG_TYPE_EXT_FLOW);
UINT8_TO_STREAM(p, L2CAP_CFG_EXT_FLOW_OPTION_LEN);
UINT8_TO_STREAM(p, p_cfg->ext_flow_spec.id);
UINT8_TO_STREAM(p, p_cfg->ext_flow_spec.stype);
UINT16_TO_STREAM(p, p_cfg->ext_flow_spec.max_sdu_size);
UINT32_TO_STREAM(p, p_cfg->ext_flow_spec.sdu_inter_time);
UINT32_TO_STREAM(p, p_cfg->ext_flow_spec.access_latency);
UINT32_TO_STREAM(p, p_cfg->ext_flow_spec.flush_timeout);
}
l2c_link_check_send_pkts(p_ccb->p_lcb, 0, p_buf);
}
/*******************************************************************************
*
* Function l2cu_send_peer_config_rej
*
* Description Build and send an L2CAP "configuration reject" message
* to the peer.
*
* Returns void
*
******************************************************************************/
void l2cu_send_peer_config_rej(tL2C_CCB* p_ccb, uint8_t* p_data,
uint16_t data_len, uint16_t rej_len) {
uint16_t len, cfg_len, buf_space, len1;
uint8_t *p, *p_hci_len, *p_data_end;
uint8_t cfg_code;
log::verbose("l2cu_send_peer_config_rej: data_len={}, rej_len={}", data_len,
rej_len);
len = BT_HDR_SIZE + HCI_DATA_PREAMBLE_SIZE + L2CAP_PKT_OVERHEAD +
L2CAP_CMD_OVERHEAD + L2CAP_CONFIG_RSP_LEN;
len1 = 0xFFFF - len;
if (rej_len > len1) {
log::error("L2CAP - cfg_rej pkt size exceeds buffer design max limit.");
return;
}
BT_HDR* p_buf = (BT_HDR*)osi_malloc(len + rej_len);
p_buf->offset = L2CAP_SEND_CMD_OFFSET;
p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET;
/* Put in HCI header - handle + pkt boundary */
if (bluetooth::shim::GetController()->SupportsNonFlushablePb()) {
UINT16_TO_STREAM(p, (p_ccb->p_lcb->Handle() | (L2CAP_PKT_START_NON_FLUSHABLE
<< L2CAP_PKT_TYPE_SHIFT)));
} else {
UINT16_TO_STREAM(p, (p_ccb->p_lcb->Handle() |
(L2CAP_PKT_START << L2CAP_PKT_TYPE_SHIFT)));
}
/* Remember the HCI header length position, and save space for it */
p_hci_len = p;
p += 2;
/* Put in L2CAP packet header */
UINT16_TO_STREAM(p, L2CAP_CMD_OVERHEAD + L2CAP_CONFIG_RSP_LEN + rej_len);
UINT16_TO_STREAM(p, L2CAP_SIGNALLING_CID);
/* Put in L2CAP command header */
UINT8_TO_STREAM(p, L2CAP_CMD_CONFIG_RSP);
UINT8_TO_STREAM(p, p_ccb->remote_id);
UINT16_TO_STREAM(p, L2CAP_CONFIG_RSP_LEN + rej_len);
UINT16_TO_STREAM(p, p_ccb->remote_cid);
UINT16_TO_STREAM(p, 0); /* Flags = 0 (no continuation) */
UINT16_TO_STREAM(p, L2CAP_CFG_UNKNOWN_OPTIONS);
buf_space = rej_len;
/* Now, put the rejected options */
p_data_end = p_data + data_len;
while (p_data < p_data_end) {
cfg_code = *p_data;
cfg_len = *(p_data + 1);
switch (cfg_code & 0x7F) {
/* skip known options */
case L2CAP_CFG_TYPE_MTU:
case L2CAP_CFG_TYPE_FLUSH_TOUT:
case L2CAP_CFG_TYPE_QOS:
case L2CAP_CFG_TYPE_FCR:
case L2CAP_CFG_TYPE_FCS:
case L2CAP_CFG_TYPE_EXT_FLOW:
p_data += cfg_len + L2CAP_CFG_OPTION_OVERHEAD;
break;
/* unknown options; copy into rsp if not hints */
default:
/* sanity check option length */
if ((cfg_len + L2CAP_CFG_OPTION_OVERHEAD) <= data_len) {
if ((cfg_code & 0x80) == 0) {
if (buf_space >= (cfg_len + L2CAP_CFG_OPTION_OVERHEAD)) {
memcpy(p, p_data, cfg_len + L2CAP_CFG_OPTION_OVERHEAD);
p += cfg_len + L2CAP_CFG_OPTION_OVERHEAD;
buf_space -= (cfg_len + L2CAP_CFG_OPTION_OVERHEAD);
} else {
log::warn("L2CAP - cfg_rej exceeds allocated buffer");
p_data = p_data_end; /* force loop exit */
break;
}
}
p_data += cfg_len + L2CAP_CFG_OPTION_OVERHEAD;
}
/* bad length; force loop exit */
else {
p_data = p_data_end;
}
break;
}
}
len = (uint16_t)(p - p_hci_len - 2);
UINT16_TO_STREAM(p_hci_len, len);
p_buf->len = len + 4;
log::verbose("L2CAP - cfg_rej pkt hci_len={}, l2cap_len={}", len,
(L2CAP_CMD_OVERHEAD + L2CAP_CONFIG_RSP_LEN + rej_len));
l2c_link_check_send_pkts(p_ccb->p_lcb, 0, p_buf);
}
/*******************************************************************************
*
* Function l2cu_send_peer_disc_req
*
* Description Build and send an L2CAP "disconnect request" message
* to the peer.
*
* Returns void
*
******************************************************************************/
void l2cu_send_peer_disc_req(tL2C_CCB* p_ccb) {
BT_HDR *p_buf, *p_buf2;
uint8_t* p;
if ((!p_ccb) || (p_ccb->p_lcb == NULL)) {
log::error("L2CAP - ccb or lcb invalid");
return;
}
/* Create an identifier for this packet */
p_ccb->p_lcb->signal_id++;
l2cu_adj_id(p_ccb->p_lcb);
p_ccb->local_id = p_ccb->p_lcb->signal_id;
p_buf = l2cu_build_header(p_ccb->p_lcb, L2CAP_DISC_REQ_LEN,
L2CAP_CMD_DISC_REQ, p_ccb->local_id);
if (p_buf == NULL) {
log::warn("L2CAP - no buffer for disc_req");
return;
}
p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET + HCI_DATA_PREAMBLE_SIZE +
L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD;
UINT16_TO_STREAM(p, p_ccb->remote_cid);
UINT16_TO_STREAM(p, p_ccb->local_cid);
/* Move all queued data packets to the LCB. In FCR mode, assume the higher
layer checks that all buffers are sent before disconnecting.
*/
if (p_ccb->peer_cfg.fcr.mode == L2CAP_FCR_BASIC_MODE) {
while ((p_buf2 = (BT_HDR*)fixed_queue_try_dequeue(p_ccb->xmit_hold_q)) !=
NULL) {
l2cu_set_acl_hci_header(p_buf2, p_ccb);
l2c_link_check_send_pkts(p_ccb->p_lcb, p_ccb->local_cid, p_buf2);
}
}
l2c_link_check_send_pkts(p_ccb->p_lcb, 0, p_buf);
}
/*******************************************************************************
*
* Function l2cu_send_peer_disc_rsp
*
* Description Build and send an L2CAP "disconnect response" message
* to the peer.
*
* This function is passed the parameters for the disconnect
* response instead of the CCB address, as it may be called
* to send a disconnect response when there is no CCB.
*
* Returns void
*
******************************************************************************/
void l2cu_send_peer_disc_rsp(tL2C_LCB* p_lcb, uint8_t remote_id,
uint16_t local_cid, uint16_t remote_cid) {
BT_HDR* p_buf;
uint8_t* p;
p_buf = l2cu_build_header(p_lcb, L2CAP_DISC_RSP_LEN, L2CAP_CMD_DISC_RSP,
remote_id);
if (p_buf == NULL) {
log::warn("L2CAP - no buffer for disc_rsp");
return;
}
p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET + HCI_DATA_PREAMBLE_SIZE +
L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD;
UINT16_TO_STREAM(p, local_cid);
UINT16_TO_STREAM(p, remote_cid);
l2c_link_check_send_pkts(p_lcb, 0, p_buf);
}
/*******************************************************************************
*
* Function l2cu_send_peer_echo_rsp
*
* Description Build and send an L2CAP "echo response" message
* to the peer.
*
* Returns void
*
******************************************************************************/
void l2cu_send_peer_echo_rsp(tL2C_LCB* p_lcb, uint8_t signal_id,
uint8_t* p_data, uint16_t data_len) {
BT_HDR* p_buf;
uint8_t* p;
uint16_t maxlen;
/* Filter out duplicate IDs or if available buffers are low (intruder
* checking) */
if (!signal_id || signal_id == p_lcb->cur_echo_id) {
/* Dump this request since it is illegal */
log::warn("L2CAP ignoring duplicate echo request ({})", signal_id);
return;
} else
p_lcb->cur_echo_id = signal_id;
uint16_t acl_data_size =
controller_get_interface()->get_acl_data_size_classic();
uint16_t acl_packet_size =
controller_get_interface()->get_acl_packet_size_classic();
/* Don't return data if it does not fit in ACL and L2CAP MTU */
maxlen = (L2CAP_CMD_BUF_SIZE > acl_packet_size)
? acl_data_size
: (uint16_t)L2CAP_CMD_BUF_SIZE;
maxlen -=
(uint16_t)(BT_HDR_SIZE + HCI_DATA_PREAMBLE_SIZE + L2CAP_PKT_OVERHEAD +
L2CAP_CMD_OVERHEAD + L2CAP_ECHO_RSP_LEN);
if (data_len > maxlen) data_len = 0;
p_buf = l2cu_build_header(p_lcb, (uint16_t)(L2CAP_ECHO_RSP_LEN + data_len),
L2CAP_CMD_ECHO_RSP, signal_id);
if (p_buf == NULL) {
log::warn("L2CAP - no buffer for echo_rsp");
return;
}
p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET + HCI_DATA_PREAMBLE_SIZE +
L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD;
if (data_len) {
ARRAY_TO_STREAM(p, p_data, data_len);
}
l2c_link_check_send_pkts(p_lcb, 0, p_buf);
}
/*******************************************************************************
*
* Function l2cu_send_peer_info_req
*
* Description Build and send an L2CAP "info request" message
* to the peer.
* Returns void
*
******************************************************************************/
void l2cu_send_peer_info_req(tL2C_LCB* p_lcb, uint16_t info_type) {
BT_HDR* p_buf;
uint8_t* p;
/* Create an identifier for this packet */
p_lcb->signal_id++;
l2cu_adj_id(p_lcb);
p_buf = l2cu_build_header(p_lcb, 2, L2CAP_CMD_INFO_REQ, p_lcb->signal_id);
if (p_buf == NULL) {
log::warn("L2CAP - no buffer for info_req");
return;
}
log::verbose("l2cu_send_peer_info_req: type 0x{:04x}", info_type);
p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET + HCI_DATA_PREAMBLE_SIZE +
L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD;
UINT16_TO_STREAM(p, info_type);
p_lcb->w4_info_rsp = true;
alarm_set_on_mloop(p_lcb->info_resp_timer, L2CAP_WAIT_INFO_RSP_TIMEOUT_MS,
l2c_info_resp_timer_timeout, p_lcb);
l2c_link_check_send_pkts(p_lcb, 0, p_buf);
}
/*******************************************************************************
*
* Function l2cu_send_peer_info_rsp
*
* Description Build and send an L2CAP "info response" message
* to the peer.
*
* Returns void
*
******************************************************************************/
void l2cu_send_peer_info_rsp(tL2C_LCB* p_lcb, uint8_t remote_id,
uint16_t info_type) {
BT_HDR* p_buf;
uint8_t* p;
uint16_t len = L2CAP_INFO_RSP_LEN;
#if (L2CAP_CONFORMANCE_TESTING == TRUE)
if ((info_type == L2CAP_EXTENDED_FEATURES_INFO_TYPE) &&
(l2cb.test_info_resp &
(L2CAP_EXTFEA_ENH_RETRANS | L2CAP_EXTFEA_STREAM_MODE |
L2CAP_EXTFEA_NO_CRC | L2CAP_EXTFEA_EXT_FLOW_SPEC |
L2CAP_EXTFEA_FIXED_CHNLS | L2CAP_EXTFEA_EXT_WINDOW |
L2CAP_EXTFEA_UCD_RECEPTION)))
#else
if ((info_type == L2CAP_EXTENDED_FEATURES_INFO_TYPE) &&
(L2CAP_EXTFEA_SUPPORTED_MASK &
(L2CAP_EXTFEA_ENH_RETRANS | L2CAP_EXTFEA_STREAM_MODE |
L2CAP_EXTFEA_NO_CRC | L2CAP_EXTFEA_FIXED_CHNLS |
L2CAP_EXTFEA_UCD_RECEPTION)) != 0)
#endif
{
len += L2CAP_EXTENDED_FEATURES_ARRAY_SIZE;
} else if (info_type == L2CAP_FIXED_CHANNELS_INFO_TYPE) {
len += L2CAP_FIXED_CHNL_ARRAY_SIZE;
} else if (info_type == L2CAP_CONNLESS_MTU_INFO_TYPE) {
len += L2CAP_CONNLESS_MTU_INFO_SIZE;
}
p_buf = l2cu_build_header(p_lcb, len, L2CAP_CMD_INFO_RSP, remote_id);
if (p_buf == NULL) {
log::warn("L2CAP - no buffer for info_rsp");
return;
}
p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET + HCI_DATA_PREAMBLE_SIZE +
L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD;
UINT16_TO_STREAM(p, info_type);
#if (L2CAP_CONFORMANCE_TESTING == TRUE)
if ((info_type == L2CAP_EXTENDED_FEATURES_INFO_TYPE) &&
(l2cb.test_info_resp &
(L2CAP_EXTFEA_ENH_RETRANS | L2CAP_EXTFEA_STREAM_MODE |
L2CAP_EXTFEA_UCD_RECEPTION)))
#else
if ((info_type == L2CAP_EXTENDED_FEATURES_INFO_TYPE) &&
(L2CAP_EXTFEA_SUPPORTED_MASK &
(L2CAP_EXTFEA_ENH_RETRANS | L2CAP_EXTFEA_STREAM_MODE |
L2CAP_EXTFEA_UCD_RECEPTION)) != 0)
#endif
{
UINT16_TO_STREAM(p, L2CAP_INFO_RESP_RESULT_SUCCESS);
if (p_lcb->transport == BT_TRANSPORT_LE) {
/* optional data are not added for now */
UINT32_TO_STREAM(p, L2CAP_BLE_EXTFEA_MASK);
} else {
#if (L2CAP_CONFORMANCE_TESTING == TRUE)
UINT32_TO_STREAM(p, l2cb.test_info_resp);
#else
UINT32_TO_STREAM(p,
L2CAP_EXTFEA_SUPPORTED_MASK | L2CAP_EXTFEA_FIXED_CHNLS);
#endif
}
} else if (info_type == L2CAP_FIXED_CHANNELS_INFO_TYPE) {
UINT16_TO_STREAM(p, L2CAP_INFO_RESP_RESULT_SUCCESS);
memset(p, 0, L2CAP_FIXED_CHNL_ARRAY_SIZE);
p[0] = L2CAP_FIXED_CHNL_SIG_BIT;
if (L2CAP_EXTFEA_SUPPORTED_MASK & L2CAP_EXTFEA_UCD_RECEPTION)
p[0] |= L2CAP_FIXED_CHNL_CNCTLESS_BIT;
{
int xx;
for (xx = 0; xx < L2CAP_NUM_FIXED_CHNLS; xx++) {
/* Skip fixed channels not used on BR/EDR-ACL link */
if ((xx >= L2CAP_ATT_CID - L2CAP_FIRST_FIXED_CHNL) &&
(xx <= L2CAP_SMP_CID - L2CAP_FIRST_FIXED_CHNL))
continue;
if (l2cb.fixed_reg[xx].pL2CA_FixedConn_Cb != NULL)
p[(xx + L2CAP_FIRST_FIXED_CHNL) / 8] |=
1 << ((xx + L2CAP_FIRST_FIXED_CHNL) % 8);
}
}
} else if (info_type == L2CAP_CONNLESS_MTU_INFO_TYPE) {
UINT16_TO_STREAM(p, L2CAP_INFO_RESP_RESULT_SUCCESS);
UINT16_TO_STREAM(p, L2CAP_MTU_SIZE);
} else {
UINT16_TO_STREAM(
p, L2CAP_INFO_RESP_RESULT_NOT_SUPPORTED); /* 'not supported' */
}
l2c_link_check_send_pkts(p_lcb, 0, p_buf);
}
/******************************************************************************
*
* Function l2cu_enqueue_ccb
*
* Description queue CCB by priority. The first CCB is highest priority and
* is served at first. The CCB is queued to an LLCB or an LCB.
*
* Returns None
*
******************************************************************************/
void l2cu_enqueue_ccb(tL2C_CCB* p_ccb) {
tL2C_CCB* p_ccb1;
tL2C_CCB_Q* p_q = NULL;
/* Find out which queue the channel is on
*/
if (p_ccb->p_lcb != NULL) p_q = &p_ccb->p_lcb->ccb_queue;
if ((!p_ccb->in_use) || (p_q == NULL)) {
log::error("CID: 0x{:04x} ERROR in_use: {} p_lcb: {}", p_ccb->local_cid,
p_ccb->in_use, fmt::ptr(p_ccb->p_lcb));
return;
}
log::verbose("l2cu_enqueue_ccb CID: 0x{:04x} priority: {}", p_ccb->local_cid,
p_ccb->ccb_priority);
/* If the queue is empty, we go at the front */
if (!p_q->p_first_ccb) {
p_q->p_first_ccb = p_q->p_last_ccb = p_ccb;
p_ccb->p_next_ccb = p_ccb->p_prev_ccb = NULL;
} else {
p_ccb1 = p_q->p_first_ccb;
while (p_ccb1 != NULL) {
/* Insert new ccb at the end of the same priority. Lower number, higher
* priority */
if (p_ccb->ccb_priority < p_ccb1->ccb_priority) {
/* Are we at the head of the queue ? */
if (p_ccb1 == p_q->p_first_ccb)
p_q->p_first_ccb = p_ccb;
else
p_ccb1->p_prev_ccb->p_next_ccb = p_ccb;
p_ccb->p_next_ccb = p_ccb1;
p_ccb->p_prev_ccb = p_ccb1->p_prev_ccb;
p_ccb1->p_prev_ccb = p_ccb;
break;
}
p_ccb1 = p_ccb1->p_next_ccb;
}
/* If we are lower then anyone in the list, we go at the end */
if (!p_ccb1) {
/* add new ccb at the end of the list */
p_q->p_last_ccb->p_next_ccb = p_ccb;
p_ccb->p_next_ccb = NULL;
p_ccb->p_prev_ccb = p_q->p_last_ccb;
p_q->p_last_ccb = p_ccb;
}
}
/* Adding CCB into round robin service table of its LCB */
if (p_ccb->p_lcb != NULL) {
/* if this is the first channel in this priority group */
if (p_ccb->p_lcb->rr_serv[p_ccb->ccb_priority].num_ccb == 0) {
/* Set the first channel to this CCB */
p_ccb->p_lcb->rr_serv[p_ccb->ccb_priority].p_first_ccb = p_ccb;
/* Set the next serving channel in this group to this CCB */
p_ccb->p_lcb->rr_serv[p_ccb->ccb_priority].p_serve_ccb = p_ccb;
/* Initialize quota of this priority group based on its priority */
p_ccb->p_lcb->rr_serv[p_ccb->ccb_priority].quota =
L2CAP_GET_PRIORITY_QUOTA(p_ccb->ccb_priority);
}
/* increase number of channels in this group */
p_ccb->p_lcb->rr_serv[p_ccb->ccb_priority].num_ccb++;
}
}
/******************************************************************************
*
* Function l2cu_dequeue_ccb
*
* Description dequeue CCB from a queue
*
* Returns -
*
******************************************************************************/
void l2cu_dequeue_ccb(tL2C_CCB* p_ccb) {
tL2C_CCB_Q* p_q = NULL;
log::verbose("l2cu_dequeue_ccb CID: 0x{:04x}", p_ccb->local_cid);
/* Find out which queue the channel is on
*/
if (p_ccb->p_lcb != NULL) p_q = &p_ccb->p_lcb->ccb_queue;
if ((!p_ccb->in_use) || (p_q == NULL) || (p_q->p_first_ccb == NULL)) {
log::error(
"l2cu_dequeue_ccb CID: 0x{:04x} ERROR in_use: {} p_lcb: 0x{} p_q: "
"0x{} p_q->p_first_ccb: 0x{}",
p_ccb->local_cid, p_ccb->in_use, fmt::ptr(p_ccb->p_lcb), fmt::ptr(p_q),
fmt::ptr(p_q ? p_q->p_first_ccb : 0));
return;
}
/* Removing CCB from round robin service table of its LCB */
if (p_ccb->p_lcb != NULL) {
/* decrease number of channels in this priority group */
p_ccb->p_lcb->rr_serv[p_ccb->ccb_priority].num_ccb--;
/* if it was the last channel in the priority group */
if (p_ccb->p_lcb->rr_serv[p_ccb->ccb_priority].num_ccb == 0) {
p_ccb->p_lcb->rr_serv[p_ccb->ccb_priority].p_first_ccb = NULL;
p_ccb->p_lcb->rr_serv[p_ccb->ccb_priority].p_serve_ccb = NULL;
} else {
/* if it is the first channel of this group */
if (p_ccb->p_lcb->rr_serv[p_ccb->ccb_priority].p_first_ccb == p_ccb) {
p_ccb->p_lcb->rr_serv[p_ccb->ccb_priority].p_first_ccb =
p_ccb->p_next_ccb;
}
/* if it is the next serving channel of this group */
if (p_ccb->p_lcb->rr_serv[p_ccb->ccb_priority].p_serve_ccb == p_ccb) {
/* simply, start serving from the first channel */
p_ccb->p_lcb->rr_serv[p_ccb->ccb_priority].p_serve_ccb =
p_ccb->p_lcb->rr_serv[p_ccb->ccb_priority].p_first_ccb;
}
}
}
if (p_ccb == p_q->p_first_ccb) {
/* We are removing the first in a queue */
p_q->p_first_ccb = p_ccb->p_next_ccb;
if (p_q->p_first_ccb)
p_q->p_first_ccb->p_prev_ccb = NULL;
else
p_q->p_last_ccb = NULL;
} else if (p_ccb == p_q->p_last_ccb) {
/* We are removing the last in a queue */
p_q->p_last_ccb = p_ccb->p_prev_ccb;
p_q->p_last_ccb->p_next_ccb = NULL;
} else {
/* In the middle of a chain. */
p_ccb->p_prev_ccb->p_next_ccb = p_ccb->p_next_ccb;
p_ccb->p_next_ccb->p_prev_ccb = p_ccb->p_prev_ccb;
}
p_ccb->p_next_ccb = p_ccb->p_prev_ccb = NULL;
}
/******************************************************************************
*
* Function l2cu_change_pri_ccb
*
* Description
*
* Returns -
*
******************************************************************************/
void l2cu_change_pri_ccb(tL2C_CCB* p_ccb, tL2CAP_CHNL_PRIORITY priority) {
if (p_ccb->ccb_priority != priority) {
/* If CCB is not the only guy on the queue */
if ((p_ccb->p_next_ccb != NULL) || (p_ccb->p_prev_ccb != NULL)) {
log::verbose("Update CCB list in logical link");
/* Remove CCB from queue and re-queue it at new priority */
l2cu_dequeue_ccb(p_ccb);
p_ccb->ccb_priority = priority;
l2cu_enqueue_ccb(p_ccb);
}
else {
/* If CCB is the only guy on the queue, no need to re-enqueue */
/* update only round robin service data */
p_ccb->p_lcb->rr_serv[p_ccb->ccb_priority].num_ccb = 0;
p_ccb->p_lcb->rr_serv[p_ccb->ccb_priority].p_first_ccb = NULL;
p_ccb->p_lcb->rr_serv[p_ccb->ccb_priority].p_serve_ccb = NULL;
p_ccb->ccb_priority = priority;
p_ccb->p_lcb->rr_serv[p_ccb->ccb_priority].p_first_ccb = p_ccb;
p_ccb->p_lcb->rr_serv[p_ccb->ccb_priority].p_serve_ccb = p_ccb;
p_ccb->p_lcb->rr_serv[p_ccb->ccb_priority].quota =
L2CAP_GET_PRIORITY_QUOTA(p_ccb->ccb_priority);
p_ccb->p_lcb->rr_serv[p_ccb->ccb_priority].num_ccb = 1;
}
}
}
/*******************************************************************************
*
* Function l2cu_allocate_ccb
*
* Description This function allocates a Channel Control Block and
* attaches it to a link control block. The local CID
* is also assigned.
*
* Returns pointer to CCB, or NULL if none
*
******************************************************************************/
tL2C_CCB* l2cu_allocate_ccb(tL2C_LCB* p_lcb, uint16_t cid, bool is_eatt) {
log::debug("is_dynamic = {}, cid 0x{:04x}", p_lcb != nullptr, cid);
if (!l2cb.p_free_ccb_first) {
log::error("First free ccb is null for cid 0x{:04x}", cid);
return nullptr;
}
tL2C_CCB* p_ccb;
/* If a CID was passed in, use that, else take the first free one */
if (cid == 0) {
p_ccb = l2cb.p_free_ccb_first;
l2cb.p_free_ccb_first = p_ccb->p_next_ccb;
} else {
tL2C_CCB* p_prev = nullptr;
p_ccb = &l2cb.ccb_pool[cid - L2CAP_BASE_APPL_CID];
if (p_ccb == l2cb.p_free_ccb_first) {
l2cb.p_free_ccb_first = p_ccb->p_next_ccb;
} else {
for (p_prev = l2cb.p_free_ccb_first; p_prev != nullptr;
p_prev = p_prev->p_next_ccb) {
if (p_prev->p_next_ccb == p_ccb) {
p_prev->p_next_ccb = p_ccb->p_next_ccb;
if (p_ccb == l2cb.p_free_ccb_last) {
l2cb.p_free_ccb_last = p_prev;
}
break;
}
}
if (p_prev == nullptr) {
log::error("Could not find CCB for CID 0x{:04x} in the free list", cid);
return nullptr;
}
}
}
p_ccb->p_next_ccb = p_ccb->p_prev_ccb = nullptr;
p_ccb->in_use = true;
/* Get a CID for the connection */
p_ccb->local_cid = L2CAP_BASE_APPL_CID + (uint16_t)(p_ccb - l2cb.ccb_pool);
p_ccb->p_lcb = p_lcb;
p_ccb->p_rcb = nullptr;
/* Set priority then insert ccb into LCB queue (if we have an LCB) */
p_ccb->ccb_priority = L2CAP_CHNL_PRIORITY_LOW;
if (p_lcb) l2cu_enqueue_ccb(p_ccb);
/* Put in default values for configuration */
memset(&p_ccb->our_cfg, 0, sizeof(tL2CAP_CFG_INFO));
memset(&p_ccb->peer_cfg, 0, sizeof(tL2CAP_CFG_INFO));
/* Put in default values for local/peer configurations */
p_ccb->our_cfg.flush_to = p_ccb->peer_cfg.flush_to = L2CAP_NO_AUTOMATIC_FLUSH;
p_ccb->our_cfg.mtu = p_ccb->peer_cfg.mtu = L2CAP_DEFAULT_MTU;
p_ccb->our_cfg.qos.service_type = p_ccb->peer_cfg.qos.service_type =
L2CAP_DEFAULT_SERV_TYPE;
p_ccb->our_cfg.qos.token_rate = p_ccb->peer_cfg.qos.token_rate =
L2CAP_DEFAULT_TOKEN_RATE;
p_ccb->our_cfg.qos.token_bucket_size = p_ccb->peer_cfg.qos.token_bucket_size =
L2CAP_DEFAULT_BUCKET_SIZE;
p_ccb->our_cfg.qos.peak_bandwidth = p_ccb->peer_cfg.qos.peak_bandwidth =
L2CAP_DEFAULT_PEAK_BANDWIDTH;
p_ccb->our_cfg.qos.latency = p_ccb->peer_cfg.qos.latency =
L2CAP_DEFAULT_LATENCY;
p_ccb->our_cfg.qos.delay_variation = p_ccb->peer_cfg.qos.delay_variation =
L2CAP_DEFAULT_DELAY;
p_ccb->peer_cfg_already_rejected = false;
p_ccb->fcr_cfg_tries = L2CAP_MAX_FCR_CFG_TRIES;
alarm_free(p_ccb->fcrb.ack_timer);
p_ccb->fcrb.ack_timer = alarm_new("l2c_fcrb.ack_timer");
/* CSP408639 Fix: When L2CAP send amp move channel request or receive
* L2CEVT_AMP_MOVE_REQ do following sequence. Send channel move
* request -> Stop retrans/monitor timer -> Change channel state to
* CST_AMP_MOVING. */
alarm_free(p_ccb->fcrb.mon_retrans_timer);
p_ccb->fcrb.mon_retrans_timer = alarm_new("l2c_fcrb.mon_retrans_timer");
p_ccb->max_rx_mtu = BT_DEFAULT_BUFFER_SIZE -
(L2CAP_MIN_OFFSET + L2CAP_SDU_LEN_OFFSET + L2CAP_FCS_LEN);
p_ccb->tx_mps = BT_DEFAULT_BUFFER_SIZE - 32;
p_ccb->xmit_hold_q = fixed_queue_new(SIZE_MAX);
p_ccb->fcrb.srej_rcv_hold_q = fixed_queue_new(SIZE_MAX);
p_ccb->fcrb.retrans_q = fixed_queue_new(SIZE_MAX);
p_ccb->fcrb.waiting_for_ack_q = fixed_queue_new(SIZE_MAX);
p_ccb->cong_sent = false;
p_ccb->buff_quota = 2; /* This gets set after config */
/* If CCB was reserved Config_Done can already have some value */
if (cid == 0) {
p_ccb->config_done = 0;
} else {
log::debug("cid 0x{:04x} config_done:0x{:x}", cid, p_ccb->config_done);
}
p_ccb->chnl_state = CST_CLOSED;
p_ccb->flags = 0;
p_ccb->tx_data_rate = L2CAP_CHNL_DATA_RATE_LOW;
p_ccb->rx_data_rate = L2CAP_CHNL_DATA_RATE_LOW;
p_ccb->is_flushable = false;
p_ccb->ecoc = false;
alarm_free(p_ccb->l2c_ccb_timer);
p_ccb->l2c_ccb_timer = alarm_new("l2c.l2c_ccb_timer");
l2c_link_adjust_chnl_allocation();
if (p_lcb != NULL) {
// once a dynamic channel is opened, timeouts become active
// the exception for this is EATT, since that is managed by GATT clients,
// not by the L2CAP layer (GATT will keep the idle timeout at infinity while
// clients are active)
if (!is_eatt) {
p_lcb->with_active_local_clients = true;
}
}
return p_ccb;
}
/*******************************************************************************
*
* Function l2cu_start_post_bond_timer
*
* Description This function starts the ACL Link inactivity timer after
* dedicated bonding
* This timer can be longer than the normal link inactivity
* timer for some platforms.
*
* Returns bool - true if idle timer started or disconnect initiated
* false if there's one or more pending CCB's exist
*
******************************************************************************/
bool l2cu_start_post_bond_timer(uint16_t handle) {
tL2C_LCB* p_lcb = l2cu_find_lcb_by_handle(handle);
if (p_lcb == nullptr) {
log::warn("Unable to find link control block for handle:0x{:04x}", handle);
return true;
}
p_lcb->ResetBonding();
/* Only start timer if no control blocks allocated */
if (p_lcb->ccb_queue.p_first_ccb != nullptr) {
log::debug(
"Unable to start post bond timer with existing dynamic channels");
return false;
}
switch (p_lcb->link_state) {
case LST_CONNECTED:
case LST_CONNECTING:
case LST_DISCONNECTING: {
/* If no channels on the connection, start idle timeout */
uint64_t timeout_ms = L2CAP_BONDING_TIMEOUT * 1000;
if (p_lcb->idle_timeout == 0) {
acl_disconnect_from_handle(
p_lcb->Handle(), HCI_ERR_PEER_USER,
"stack::l2cap::l2c_utils::l2cu_start_post_bond_timer Idle timeout");
p_lcb->link_state = LST_DISCONNECTING;
timeout_ms = L2CAP_LINK_DISCONNECT_TIMEOUT_MS;
}
alarm_set_on_mloop(p_lcb->l2c_lcb_timer, timeout_ms,
l2c_lcb_timer_timeout, p_lcb);
log::debug("Started link IDLE timeout_ms:{}", (unsigned long)timeout_ms);
return true;
} break;
default:
log::debug("Will not start post bond timer with link state:{}",
link_state_text(p_lcb->link_state));
break;
}
return false;
}
/*******************************************************************************
*
* Function l2cu_release_ccb
*
* Description This function releases a Channel Control Block. The timer
* is stopped, any attached buffers freed, and the CCB is
* removed from the link control block.
*
* Returns void
*
******************************************************************************/
void l2cu_release_ccb(tL2C_CCB* p_ccb) {
tL2C_LCB* p_lcb = p_ccb->p_lcb;
tL2C_RCB* p_rcb = p_ccb->p_rcb;
log::verbose("l2cu_release_ccb: cid 0x{:04x} in_use: {}", p_ccb->local_cid,
p_ccb->in_use);
/* If already released, could be race condition */
if (!p_ccb->in_use) return;
if (p_rcb && p_lcb && p_ccb->chnl_state >= CST_OPEN) {
bluetooth::shim::GetSnoopLogger()->SetL2capChannelClose(
p_ccb->p_lcb->Handle(), p_ccb->local_cid, p_ccb->remote_cid);
}
if (p_lcb) {
bluetooth::shim::GetSnoopLogger()->ClearL2capAcceptlist(
p_lcb->Handle(), p_ccb->local_cid, p_ccb->remote_cid);
}
if (p_rcb && (p_rcb->psm != p_rcb->real_psm)) {
BTM_SecClrServiceByPsm(p_rcb->psm);
}
/* Free the timer */
alarm_free(p_ccb->l2c_ccb_timer);
p_ccb->l2c_ccb_timer = NULL;
fixed_queue_free(p_ccb->xmit_hold_q, osi_free);
p_ccb->xmit_hold_q = NULL;
l2c_fcr_cleanup(p_ccb);
/* Channel may not be assigned to any LCB if it was just pre-reserved */
if ((p_lcb) && ((p_ccb->local_cid >= L2CAP_BASE_APPL_CID))) {
l2cu_dequeue_ccb(p_ccb);
/* Delink the CCB from the LCB */
p_ccb->p_lcb = NULL;
}
/* Put the CCB back on the free pool */
if (!l2cb.p_free_ccb_first) {
l2cb.p_free_ccb_first = p_ccb;
l2cb.p_free_ccb_last = p_ccb;
p_ccb->p_next_ccb = NULL;
p_ccb->p_prev_ccb = NULL;
} else {
p_ccb->p_next_ccb = NULL;
p_ccb->p_prev_ccb = l2cb.p_free_ccb_last;
l2cb.p_free_ccb_last->p_next_ccb = p_ccb;
l2cb.p_free_ccb_last = p_ccb;
}
/* Flag as not in use */
p_ccb->in_use = false;
// Clear Remote CID and Local Id
p_ccb->remote_cid = 0;
p_ccb->local_id = 0;
/* If no channels on the connection, start idle timeout */
if ((p_lcb) && p_lcb->in_use) {
if (p_lcb->link_state == LST_CONNECTED) {
if (!p_lcb->ccb_queue.p_first_ccb) {
// Closing a security channel on LE device should not start connection
// timeout
if (p_lcb->transport == BT_TRANSPORT_LE &&
p_ccb->local_cid == L2CAP_SMP_CID)
return;
l2cu_no_dynamic_ccbs(p_lcb);
} else {
/* Link is still active, adjust channel quotas. */
l2c_link_adjust_chnl_allocation();
}
} else if (p_lcb->link_state == LST_CONNECTING) {
if (!p_lcb->ccb_queue.p_first_ccb) {
if (p_lcb->transport == BT_TRANSPORT_LE &&
p_ccb->local_cid == L2CAP_ATT_CID) {
log::warn("disconnecting the LE link");
l2cu_no_dynamic_ccbs(p_lcb);
}
}
}
}
}
/*******************************************************************************
*
* Function l2cu_find_ccb_by_remote_cid
*
* Description Look through all active CCBs on a link for a match based
* on the remote CID.
*
* Returns pointer to matched CCB, or NULL if no match
*
******************************************************************************/
tL2C_CCB* l2cu_find_ccb_by_remote_cid(tL2C_LCB* p_lcb, uint16_t remote_cid) {
tL2C_CCB* p_ccb;
/* If LCB is NULL, look through all active links */
if (!p_lcb) {
return NULL;
} else {
for (p_ccb = p_lcb->ccb_queue.p_first_ccb; p_ccb; p_ccb = p_ccb->p_next_ccb)
if ((p_ccb->in_use) && (p_ccb->remote_cid == remote_cid)) return (p_ccb);
}
/* If here, no match found */
return (NULL);
}
/*******************************************************************************
*
* Function l2cu_allocate_rcb
*
* Description Look through the Registration Control Blocks for a free
* one.
*
* Returns Pointer to the RCB or NULL if not found
*
******************************************************************************/
tL2C_RCB* l2cu_allocate_rcb(uint16_t psm) {
tL2C_RCB* p_rcb = &l2cb.rcb_pool[0];
uint16_t xx;
for (xx = 0; xx < MAX_L2CAP_CLIENTS; xx++, p_rcb++) {
if (!p_rcb->in_use) {
p_rcb->in_use = true;
p_rcb->psm = psm;
return (p_rcb);
}
}
/* If here, no free RCB found */
return (NULL);
}
/*******************************************************************************
*
* Function l2cu_allocate_ble_rcb
*
* Description Look through the BLE Registration Control Blocks for a free
* one.
*
* Returns Pointer to the BLE RCB or NULL if not found
*
******************************************************************************/
tL2C_RCB* l2cu_allocate_ble_rcb(uint16_t psm) {
tL2C_RCB* p_rcb = &l2cb.ble_rcb_pool[0];
uint16_t xx;
for (xx = 0; xx < BLE_MAX_L2CAP_CLIENTS; xx++, p_rcb++) {
if (!p_rcb->in_use) {
p_rcb->in_use = true;
p_rcb->psm = psm;
return (p_rcb);
}
}
/* If here, no free RCB found */
return (NULL);
}
/*******************************************************************************
*
* Function l2cu_release_rcb
*
* Description Mark an RCB as no longet in use
*
* Returns void
*
******************************************************************************/
void l2cu_release_rcb(tL2C_RCB* p_rcb) {
p_rcb->in_use = false;
p_rcb->psm = 0;
}
/*******************************************************************************
*
* Function l2cu_release_ble_rcb
*
* Description Mark an LE RCB as no longer in use
*
* Returns void
*
******************************************************************************/
void l2cu_release_ble_rcb(tL2C_RCB* p_rcb) {
L2CA_FreeLePSM(p_rcb->psm);
p_rcb->in_use = false;
p_rcb->psm = 0;
}
/*******************************************************************************
*
* Function l2cu_disconnect_chnl
*
* Description Disconnect a channel. Typically, this is due to either
* receiving a bad configuration, bad packet or max_retries
* expiring.
*
******************************************************************************/
void l2cu_disconnect_chnl(tL2C_CCB* p_ccb) {
uint16_t local_cid = p_ccb->local_cid;
if (local_cid >= L2CAP_BASE_APPL_CID) {
tL2CA_DISCONNECT_IND_CB* p_disc_cb =
p_ccb->p_rcb->api.pL2CA_DisconnectInd_Cb;
log::warn("L2CAP - disconnect_chnl CID: 0x{:04x}", local_cid);
l2cu_send_peer_disc_req(p_ccb);
l2cu_release_ccb(p_ccb);
(*p_disc_cb)(local_cid, false);
} else {
/* failure on the AMP channel, probably need to disconnect ACL */
log::error("L2CAP - disconnect_chnl CID: 0x{:04x} Ignored", local_cid);
}
}
/*******************************************************************************
*
* Function l2cu_find_rcb_by_psm
*
* Description Look through the Registration Control Blocks to see if
* anyone registered to handle the PSM in question
*
* Returns Pointer to the RCB or NULL if not found
*
******************************************************************************/
tL2C_RCB* l2cu_find_rcb_by_psm(uint16_t psm) {
tL2C_RCB* p_rcb = &l2cb.rcb_pool[0];
uint16_t xx;
for (xx = 0; xx < MAX_L2CAP_CLIENTS; xx++, p_rcb++) {
if ((p_rcb->in_use) && (p_rcb->psm == psm)) return (p_rcb);
}
/* If here, no match found */
return (NULL);
}
/*******************************************************************************
*
* Function l2cu_find_ble_rcb_by_psm
*
* Description Look through the BLE Registration Control Blocks to see if
* anyone registered to handle the PSM in question
*
* Returns Pointer to the BLE RCB or NULL if not found
*
******************************************************************************/
tL2C_RCB* l2cu_find_ble_rcb_by_psm(uint16_t psm) {
tL2C_RCB* p_rcb = &l2cb.ble_rcb_pool[0];
uint16_t xx;
for (xx = 0; xx < BLE_MAX_L2CAP_CLIENTS; xx++, p_rcb++) {
if ((p_rcb->in_use) && (p_rcb->psm == psm)) return (p_rcb);
}
/* If here, no match found */
return (NULL);
}
/*******************************************************************************
*
* Function l2cu_process_peer_cfg_req
*
* Description This function is called when the peer sends us a "config
* request" message. It extracts the configuration of interest
* and saves it in the CCB.
*
* Note: Negotiation of the FCR channel type is handled
* internally, all others are passed to the upper layer.
*
* Returns uint8_t - L2CAP_PEER_CFG_OK if passed to upper layer,
* L2CAP_PEER_CFG_UNACCEPTABLE if automatically
* responded to because parameters are
* unnacceptable from a specification point
* of view.
* L2CAP_PEER_CFG_DISCONNECT if no compatible channel
* modes between the two devices, and shall
* be closed.
*
******************************************************************************/
uint8_t l2cu_process_peer_cfg_req(tL2C_CCB* p_ccb, tL2CAP_CFG_INFO* p_cfg) {
bool mtu_ok = true;
bool qos_type_ok = true;
bool flush_to_ok = true;
bool fcr_ok = true;
uint8_t fcr_status;
uint16_t required_remote_mtu =
std::max<uint16_t>(L2CAP_MIN_MTU, p_ccb->p_rcb->required_remote_mtu);
/* Ignore FCR parameters for basic mode */
if (!p_cfg->fcr_present) p_cfg->fcr.mode = L2CAP_FCR_BASIC_MODE;
if (!p_cfg->mtu_present && required_remote_mtu > L2CAP_DEFAULT_MTU) {
// We reject if we have a MTU requirement higher than default MTU
p_cfg->mtu = required_remote_mtu;
mtu_ok = false;
} else if (p_cfg->mtu_present) {
/* Make sure MTU is at least the minimum */
if (p_cfg->mtu >= required_remote_mtu) {
/* In basic mode, limit the MTU to our buffer size */
if ((!p_cfg->fcr_present) && (p_cfg->mtu > L2CAP_MTU_SIZE))
p_cfg->mtu = L2CAP_MTU_SIZE;
/* Save the accepted value in case of renegotiation */
p_ccb->peer_cfg.mtu = p_cfg->mtu;
p_ccb->peer_cfg.mtu_present = true;
} else /* Illegal MTU value */
{
p_cfg->mtu = required_remote_mtu;
mtu_ok = false;
}
}
/* Reload mtu from a previously accepted config request */
else if (p_ccb->peer_cfg.mtu_present && !(p_ccb->config_done & IB_CFG_DONE)) {
p_cfg->mtu_present = true;
p_cfg->mtu = p_ccb->peer_cfg.mtu;
}
/* Verify that the flush timeout is a valid value (0 is illegal) */
if (p_cfg->flush_to_present) {
if (!p_cfg->flush_to) {
p_cfg->flush_to = 0xFFFF; /* Infinite retransmissions (spec default) */
flush_to_ok = false;
} else /* Save the accepted value in case of renegotiation */
{
p_ccb->peer_cfg.flush_to_present = true;
p_ccb->peer_cfg.flush_to = p_cfg->flush_to;
}
}
/* Reload flush_to from a previously accepted config request */
else if (p_ccb->peer_cfg.flush_to_present &&
!(p_ccb->config_done & IB_CFG_DONE)) {
p_cfg->flush_to_present = true;
p_cfg->flush_to = p_ccb->peer_cfg.flush_to;
}
/* Save the QOS settings the the peer is using */
if (p_cfg->qos_present) {
/* Make sure service type is not a reserved value; otherwise let upper
layer decide if acceptable
*/
if (p_cfg->qos.service_type <= SVC_TYPE_GUARANTEED) {
p_ccb->peer_cfg.qos = p_cfg->qos;
p_ccb->peer_cfg.qos_present = true;
} else /* Illegal service type value */
{
p_cfg->qos.service_type = SVC_TYPE_BEST_EFFORT;
qos_type_ok = false;
}
}
/* Reload QOS from a previously accepted config request */
else if (p_ccb->peer_cfg.qos_present && !(p_ccb->config_done & IB_CFG_DONE)) {
p_cfg->qos_present = true;
p_cfg->qos = p_ccb->peer_cfg.qos;
}
fcr_status = l2c_fcr_process_peer_cfg_req(p_ccb, p_cfg);
if (fcr_status == L2CAP_PEER_CFG_DISCONNECT) {
/* Notify caller to disconnect the channel (incompatible modes) */
p_cfg->result = L2CAP_CFG_FAILED_NO_REASON;
p_cfg->mtu_present = p_cfg->qos_present = p_cfg->flush_to_present = 0;
return (L2CAP_PEER_CFG_DISCONNECT);
}
fcr_ok = (fcr_status == L2CAP_PEER_CFG_OK);
/* Return any unacceptable parameters */
if (mtu_ok && flush_to_ok && qos_type_ok && fcr_ok) {
l2cu_adjust_out_mps(p_ccb);
return (L2CAP_PEER_CFG_OK);
} else {
p_cfg->result = L2CAP_CFG_UNACCEPTABLE_PARAMS;
if (mtu_ok) p_cfg->mtu_present = false;
if (flush_to_ok) p_cfg->flush_to_present = false;
if (qos_type_ok) p_cfg->qos_present = false;
if (fcr_ok) p_cfg->fcr_present = false;
return (L2CAP_PEER_CFG_UNACCEPTABLE);
}
}
/*******************************************************************************
*
* Function l2cu_process_peer_cfg_rsp
*
* Description This function is called when the peer sends us a "config
* response" message. It extracts the configuration of interest
* and saves it in the CCB.
*
* Returns void
*
******************************************************************************/
void l2cu_process_peer_cfg_rsp(tL2C_CCB* p_ccb, tL2CAP_CFG_INFO* p_cfg) {
/* If we wanted QoS and the peer sends us a positive response with QoS, use
* his values */
if ((p_cfg->qos_present) && (p_ccb->our_cfg.qos_present))
p_ccb->our_cfg.qos = p_cfg->qos;
if (p_cfg->fcr_present) {
/* Save the retransmission and monitor timeout values */
if (p_cfg->fcr.mode == L2CAP_FCR_ERTM_MODE) {
p_ccb->peer_cfg.fcr.rtrans_tout = p_cfg->fcr.rtrans_tout;
p_ccb->peer_cfg.fcr.mon_tout = p_cfg->fcr.mon_tout;
}
/* Calculate the max number of packets for which we can delay sending an ack
*/
if (p_cfg->fcr.tx_win_sz < p_ccb->our_cfg.fcr.tx_win_sz)
p_ccb->fcrb.max_held_acks = p_cfg->fcr.tx_win_sz / 3;
else
p_ccb->fcrb.max_held_acks = p_ccb->our_cfg.fcr.tx_win_sz / 3;
log::verbose(
"l2cu_process_peer_cfg_rsp(): peer tx_win_sz: {}, our tx_win_sz: {}, "
"max_held_acks: {}",
p_cfg->fcr.tx_win_sz, p_ccb->our_cfg.fcr.tx_win_sz,
p_ccb->fcrb.max_held_acks);
}
}
/*******************************************************************************
*
* Function l2cu_process_our_cfg_req
*
* Description This function is called when we send a "config request"
* message. It extracts the configuration of interest and saves
* it in the CCB.
*
* Returns void
*
******************************************************************************/
void l2cu_process_our_cfg_req(tL2C_CCB* p_ccb, tL2CAP_CFG_INFO* p_cfg) {
/* Save the QOS settings we are using for transmit */
if (p_cfg->qos_present) {
p_ccb->our_cfg.qos_present = true;
p_ccb->our_cfg.qos = p_cfg->qos;
}
if (p_cfg->fcr_present) {
/* Override FCR options if attempting streaming or basic */
if (p_cfg->fcr.mode == L2CAP_FCR_BASIC_MODE)
memset(&p_cfg->fcr, 0, sizeof(tL2CAP_FCR_OPTS));
else {
/* On BR/EDR, timer values are zero in config request */
/* On class 2 AMP, timer value in config request shall be non-0 processing
* time */
/* timer value in config response shall be greater than
* received processing time */
p_cfg->fcr.mon_tout = p_cfg->fcr.rtrans_tout = 0;
}
/* Set the threshold to send acks (may be updated in the cfg response) */
p_ccb->fcrb.max_held_acks = p_cfg->fcr.tx_win_sz / 3;
/* Include FCS option only if peer can handle it */
if ((p_ccb->p_lcb->peer_ext_fea & L2CAP_EXTFEA_NO_CRC) == 0) {
p_cfg->fcs_present = false;
}
} else {
p_cfg->fcr.mode = L2CAP_FCR_BASIC_MODE;
}
p_ccb->our_cfg.fcr.mode = p_cfg->fcr.mode;
p_ccb->our_cfg.fcr_present = p_cfg->fcr_present;
}
/*******************************************************************************
*
* Function l2cu_process_our_cfg_rsp
*
* Description This function is called when we send the peer a "config
* response" message. It extracts the configuration of interest
* and saves it in the CCB.
*
* Returns void
*
******************************************************************************/
void l2cu_process_our_cfg_rsp(tL2C_CCB* p_ccb, tL2CAP_CFG_INFO* p_cfg) {
/* If peer wants QoS, we are allowed to change the values in a positive
* response */
if ((p_cfg->qos_present) && (p_ccb->peer_cfg.qos_present))
p_ccb->peer_cfg.qos = p_cfg->qos;
else
p_cfg->qos_present = false;
l2c_fcr_adj_our_rsp_options(p_ccb, p_cfg);
}
/*******************************************************************************
*
* Function l2cu_device_reset
*
* Description This function is called when reset of the device is
* completed. For all active connection simulate HCI_DISC
*
* Returns void
*
******************************************************************************/
void l2cu_device_reset(void) {
int xx;
tL2C_LCB* p_lcb = &l2cb.lcb_pool[0];
for (xx = 0; xx < MAX_L2CAP_LINKS; xx++, p_lcb++) {
if ((p_lcb->in_use) && (p_lcb->Handle() != HCI_INVALID_HANDLE)) {
l2c_link_hci_disc_comp(p_lcb->Handle(), HCI_ERR_UNDEFINED);
}
}
}
/* This function initiates an acl connection to a LE device.
* Returns true if request started successfully, false otherwise. */
bool l2cu_create_conn_le(tL2C_LCB* p_lcb) {
if (!controller_get_interface()->SupportsBle()) return false;
p_lcb->transport = BT_TRANSPORT_LE;
return (l2cble_create_conn(p_lcb));
}
/* This function initiates an acl connection to a Classic device via HCI. */
void l2cu_create_conn_br_edr(tL2C_LCB* p_lcb) {
const bool controller_supports_role_switch =
bluetooth::shim::GetController()->SupportsRoleSwitch();
/* While creating a new classic connection, check check all the other
* active connections where we are not SCO nor central.
* If our controller supports role switching, try switching
* roles back to CENTRAL on those connections.
*/
tL2C_LCB* p_lcb_cur = &l2cb.lcb_pool[0];
for (uint8_t xx = 0; xx < MAX_L2CAP_LINKS; xx++, p_lcb_cur++) {
if (p_lcb_cur == p_lcb) continue;
if (!p_lcb_cur->in_use) continue;
if (BTM_IsScoActiveByBdaddr(p_lcb_cur->remote_bd_addr)) {
log::verbose("Central peripheral switch not allowed when SCO active");
continue;
}
if (p_lcb->IsLinkRoleCentral()) continue;
/* The LMP_switch_req shall be sent only if the ACL logical transport
is in active mode, when encryption is disabled, and all synchronous
logical transports on the same physical link are disabled." */
/*4_1_TODO check if btm_cb.devcb.local_features to be used instead */
if (controller_supports_role_switch) {
/* mark this lcb waiting for switch to be completed and
start switch on the other one */
p_lcb->link_state = LST_CONNECTING_WAIT_SWITCH;
p_lcb->SetLinkRoleAsCentral();
if (BTM_SwitchRoleToCentral(p_lcb_cur->remote_bd_addr) ==
BTM_CMD_STARTED) {
alarm_set_on_mloop(p_lcb->l2c_lcb_timer,
L2CAP_LINK_ROLE_SWITCH_TIMEOUT_MS,
l2c_lcb_timer_timeout, p_lcb);
return;
}
}
}
p_lcb->link_state = LST_CONNECTING;
l2cu_create_conn_after_switch(p_lcb);
}
/*******************************************************************************
*
* Function l2cu_get_num_hi_priority
*
* Description Gets the number of high priority channels.
*
* Returns
*
******************************************************************************/
uint8_t l2cu_get_num_hi_priority(void) {
uint8_t no_hi = 0;
int xx;
tL2C_LCB* p_lcb = &l2cb.lcb_pool[0];
for (xx = 0; xx < MAX_L2CAP_LINKS; xx++, p_lcb++) {
if ((p_lcb->in_use) && (p_lcb->acl_priority == L2CAP_PRIORITY_HIGH)) {
no_hi++;
}
}
return no_hi;
}
/*******************************************************************************
*
* Function l2cu_create_conn_after_switch
*
* Description This continues a connection creation possibly after
* a role switch.
*
******************************************************************************/
void l2cu_create_conn_after_switch(tL2C_LCB* p_lcb) {
const bool there_are_high_priority_channels =
(l2cu_get_num_hi_priority() > 0);
acl_create_classic_connection(p_lcb->remote_bd_addr,
there_are_high_priority_channels,
p_lcb->IsBonding());
alarm_set_on_mloop(p_lcb->l2c_lcb_timer, L2CAP_LINK_CONNECT_TIMEOUT_MS,
l2c_lcb_timer_timeout, p_lcb);
}
/*******************************************************************************
*
* Function l2cu_find_lcb_by_state
*
* Description Look through all active LCBs for a match based on the
* LCB state.
*
* Returns pointer to first matched LCB, or NULL if no match
*
******************************************************************************/
tL2C_LCB* l2cu_find_lcb_by_state(tL2C_LINK_STATE state) {
uint16_t i;
tL2C_LCB* p_lcb = &l2cb.lcb_pool[0];
for (i = 0; i < MAX_L2CAP_LINKS; i++, p_lcb++) {
if ((p_lcb->in_use) && (p_lcb->link_state == state)) {
return (p_lcb);
}
}
/* If here, no match found */
return (NULL);
}
/*******************************************************************************
*
* Function l2cu_lcb_disconnecting
*
* Description On each active lcb, check if the lcb is in disconnecting
* state, or if there are no ccb's on the lcb (implying
idle timeout is running), or if last ccb on the link
is in disconnecting state.
*
* Returns true if any of above conditions met, false otherwise
*
******************************************************************************/
bool l2cu_lcb_disconnecting(void) {
tL2C_LCB* p_lcb;
tL2C_CCB* p_ccb;
uint16_t i;
bool status = false;
p_lcb = &l2cb.lcb_pool[0];
for (i = 0; i < MAX_L2CAP_LINKS; i++, p_lcb++) {
if (p_lcb->in_use) {
/* no ccbs on lcb, or lcb is in disconnecting state */
if ((!p_lcb->ccb_queue.p_first_ccb) ||
(p_lcb->link_state == LST_DISCONNECTING)) {
status = true;
break;
}
/* only one ccb left on lcb */
else if (p_lcb->ccb_queue.p_first_ccb == p_lcb->ccb_queue.p_last_ccb) {
p_ccb = p_lcb->ccb_queue.p_first_ccb;
if ((p_ccb->in_use) &&
((p_ccb->chnl_state == CST_W4_L2CAP_DISCONNECT_RSP) ||
(p_ccb->chnl_state == CST_W4_L2CA_DISCONNECT_RSP))) {
status = true;
break;
}
}
}
}
return status;
}
/*******************************************************************************
*
* Function l2cu_set_acl_priority_latency_brcm
*
* Description Sends a VSC to set the ACL priority and recorded latency on
* Broadcom chip.
*
* Returns void
*
******************************************************************************/
static void l2cu_set_acl_priority_latency_brcm(tL2C_LCB* p_lcb,
tL2CAP_PRIORITY priority) {
uint8_t vs_param;
if (priority == L2CAP_PRIORITY_HIGH) {
// priority to high, if using latency mode check preset latency
if (p_lcb->use_latency_mode &&
p_lcb->preset_acl_latency == L2CAP_LATENCY_LOW) {
log::info("Set ACL priority: High Priority and Low Latency Mode");
vs_param = HCI_BRCM_ACL_HIGH_PRIORITY_LOW_LATENCY;
p_lcb->set_latency(L2CAP_LATENCY_LOW);
} else {
log::info("Set ACL priority: High Priority Mode");
vs_param = HCI_BRCM_ACL_HIGH_PRIORITY;
}
} else {
// priority to normal
log::info("Set ACL priority: Normal Mode");
vs_param = HCI_BRCM_ACL_NORMAL_PRIORITY;
p_lcb->set_latency(L2CAP_LATENCY_NORMAL);
}
uint8_t command[HCI_BRCM_ACL_PRIORITY_PARAM_SIZE];
uint8_t* pp = command;
UINT16_TO_STREAM(pp, p_lcb->Handle());
UINT8_TO_STREAM(pp, vs_param);
BTM_VendorSpecificCommand(HCI_BRCM_SET_ACL_PRIORITY,
HCI_BRCM_ACL_PRIORITY_PARAM_SIZE, command, NULL);
}
/*******************************************************************************
*
* Function l2cu_set_acl_priority_latency_syna
*
* Description Sends a VSC to set the ACL priority and recorded latency on
* Synaptics chip.
*
* Returns void
*
******************************************************************************/
static void l2cu_set_acl_priority_latency_syna(tL2C_LCB* p_lcb,
tL2CAP_PRIORITY priority) {
uint8_t vs_param;
if (priority == L2CAP_PRIORITY_HIGH) {
// priority to high, if using latency mode check preset latency
if (p_lcb->use_latency_mode &&
p_lcb->preset_acl_latency == L2CAP_LATENCY_LOW) {
log::info("Set ACL priority: High Priority and Low Latency Mode");
vs_param = HCI_SYNA_ACL_HIGH_PRIORITY_LOW_LATENCY;
p_lcb->set_latency(L2CAP_LATENCY_LOW);
} else {
log::info("Set ACL priority: High Priority Mode");
vs_param = HCI_SYNA_ACL_HIGH_PRIORITY;
}
} else {
// priority to normal
log::info("Set ACL priority: Normal Mode");
vs_param = HCI_SYNA_ACL_NORMAL_PRIORITY;
p_lcb->set_latency(L2CAP_LATENCY_NORMAL);
}
uint8_t command[HCI_SYNA_ACL_PRIORITY_PARAM_SIZE];
uint8_t* pp = command;
UINT16_TO_STREAM(pp, p_lcb->Handle());
UINT8_TO_STREAM(pp, vs_param);
BTM_VendorSpecificCommand(HCI_SYNA_SET_ACL_PRIORITY,
HCI_SYNA_ACL_PRIORITY_PARAM_SIZE, command, NULL);
}
/*******************************************************************************
*
* Function l2cu_set_acl_priority_unisoc
*
* Description Sends a VSC to set the ACL priority on Unisoc chip.
*
* Returns void
*
******************************************************************************/
static void l2cu_set_acl_priority_unisoc(tL2C_LCB* p_lcb,
tL2CAP_PRIORITY priority) {
uint8_t vs_param;
if (priority == L2CAP_PRIORITY_HIGH) {
// priority to high
log::info("Set ACL priority: High Priority Mode");
vs_param = HCI_UNISOC_ACL_HIGH_PRIORITY;
} else {
// priority to normal
log::info("Set ACL priority: Normal Mode");
vs_param = HCI_UNISOC_ACL_NORMAL_PRIORITY;
}
uint8_t command[HCI_UNISOC_ACL_PRIORITY_PARAM_SIZE];
uint8_t* pp = command;
UINT16_TO_STREAM(pp, p_lcb->Handle());
UINT8_TO_STREAM(pp, vs_param);
BTM_VendorSpecificCommand(HCI_UNISOC_SET_ACL_PRIORITY,
HCI_UNISOC_ACL_PRIORITY_PARAM_SIZE, command, NULL);
}
/*******************************************************************************
*
* Function l2cu_set_acl_priority_latency_mtk
*
* Description Sends a VSC to set the ACL priority and recorded latency on
* Mediatek chip.
*
* Returns void
*
******************************************************************************/
static void l2cu_set_acl_priority_latency_mtk(tL2C_LCB* p_lcb,
tL2CAP_PRIORITY priority) {
uint8_t vs_param;
if (priority == L2CAP_PRIORITY_HIGH) {
// priority to high, if using latency mode check preset latency
log::info("Set ACL priority: High Priority Mode");
vs_param = HCI_MTK_ACL_HIGH_PRIORITY;
} else {
// priority to normal
log::info("Set ACL priority: Normal Mode");
vs_param = HCI_MTK_ACL_NORMAL_PRIORITY;
}
BTM_VendorSpecificCommand(HCI_MTK_SET_ACL_PRIORITY,
HCI_MTK_ACL_PRIORITY_PARAM_SIZE, &vs_param, NULL);
}
/*******************************************************************************
*
* Function l2cu_set_acl_priority
*
* Description Sets the transmission priority for a channel.
* (For initial implementation only two values are valid.
* L2CAP_PRIORITY_NORMAL and L2CAP_PRIORITY_HIGH).
*
* Returns true if a valid channel, else false
*
******************************************************************************/
bool l2cu_set_acl_priority(const RawAddress& bd_addr, tL2CAP_PRIORITY priority,
bool reset_after_rs) {
tL2C_LCB* p_lcb;
log::verbose("SET ACL PRIORITY {}", priority);
/* Find the link control block for the acl channel */
p_lcb = l2cu_find_lcb_by_bd_addr(bd_addr, BT_TRANSPORT_BR_EDR);
if (p_lcb == NULL) {
log::warn("L2CAP - no LCB for L2CA_SetAclPriority");
return (false);
}
/* Link priority is set if:
* 1. Change in priority requested from above L2CAP through API, Or
* 2. High priority requested because of central/peripheral role switch */
if ((!reset_after_rs && (priority != p_lcb->acl_priority)) ||
(reset_after_rs && p_lcb->acl_priority == L2CAP_PRIORITY_HIGH)) {
#ifndef TARGET_FLOSS
/* Use vendor specific commands to set the link priority */
switch (controller_get_interface()->get_bt_version()->manufacturer) {
case LMP_COMPID_BROADCOM:
l2cu_set_acl_priority_latency_brcm(p_lcb, priority);
break;
case LMP_COMPID_SYNAPTICS:
l2cu_set_acl_priority_latency_syna(p_lcb, priority);
break;
case LMP_COMPID_UNISOC:
l2cu_set_acl_priority_unisoc(p_lcb, priority);
break;
case LMP_COMPID_MEDIATEK:
l2cu_set_acl_priority_latency_mtk(p_lcb, priority);
break;
default:
/* Not supported/required for other vendors */
break;
}
#endif
}
/* Adjust lmp buffer allocation for this channel if priority changed */
if (p_lcb->acl_priority != priority) {
p_lcb->acl_priority = priority;
l2c_link_adjust_allocation();
}
return (true);
}
/*******************************************************************************
*
* Function l2cu_set_acl_latency_brcm
*
* Description Sends a VSC to set the ACL latency on Broadcom chip.
*
* Returns void
*
******************************************************************************/
static void l2cu_set_acl_latency_brcm(tL2C_LCB* p_lcb, tL2CAP_LATENCY latency) {
log::info("Set ACL latency: {}",
latency == L2CAP_LATENCY_LOW ? "Low Latancy" : "Normal Latency");
uint8_t command[HCI_BRCM_ACL_PRIORITY_PARAM_SIZE];
uint8_t* pp = command;
uint8_t vs_param = latency == L2CAP_LATENCY_LOW
? HCI_BRCM_ACL_HIGH_PRIORITY_LOW_LATENCY
: HCI_BRCM_ACL_HIGH_PRIORITY;
UINT16_TO_STREAM(pp, p_lcb->Handle());
UINT8_TO_STREAM(pp, vs_param);
BTM_VendorSpecificCommand(HCI_BRCM_SET_ACL_PRIORITY,
HCI_BRCM_ACL_PRIORITY_PARAM_SIZE, command, NULL);
}
/*******************************************************************************
*
* Function l2cu_set_acl_latency_syna
*
* Description Sends a VSC to set the ACL latency on Synatics chip.
*
* Returns void
*
******************************************************************************/
static void l2cu_set_acl_latency_syna(tL2C_LCB* p_lcb, tL2CAP_LATENCY latency) {
log::info("Set ACL latency: {}",
latency == L2CAP_LATENCY_LOW ? "Low Latancy" : "Normal Latency");
uint8_t command[HCI_SYNA_ACL_PRIORITY_PARAM_SIZE];
uint8_t* pp = command;
uint8_t vs_param = latency == L2CAP_LATENCY_LOW
? HCI_SYNA_ACL_HIGH_PRIORITY_LOW_LATENCY
: HCI_SYNA_ACL_HIGH_PRIORITY;
UINT16_TO_STREAM(pp, p_lcb->Handle());
UINT8_TO_STREAM(pp, vs_param);
BTM_VendorSpecificCommand(HCI_SYNA_SET_ACL_PRIORITY,
HCI_SYNA_ACL_PRIORITY_PARAM_SIZE, command, NULL);
}
/*******************************************************************************
*
* Function l2cu_set_acl_latency
*
* Description Sets the transmission latency for a channel.
*
* Returns true if a valid channel, else false
*
******************************************************************************/
bool l2cu_set_acl_latency(const RawAddress& bd_addr, tL2CAP_LATENCY latency) {
log::info("Set ACL low latency: {}", latency);
/* Find the link control block for the acl channel */
tL2C_LCB* p_lcb = l2cu_find_lcb_by_bd_addr(bd_addr, BT_TRANSPORT_BR_EDR);
if (p_lcb == nullptr) {
log::warn("Set latency failed: LCB is null");
return false;
}
/* only change controller's latency when stream using latency mode */
if (p_lcb->use_latency_mode && p_lcb->is_high_priority() &&
latency != p_lcb->acl_latency) {
switch (controller_get_interface()->get_bt_version()->manufacturer) {
case LMP_COMPID_BROADCOM:
l2cu_set_acl_latency_brcm(p_lcb, latency);
break;
case LMP_COMPID_SYNAPTICS:
l2cu_set_acl_latency_syna(p_lcb, latency);
break;
default:
/* Not supported/required for other vendors */
break;
}
p_lcb->set_latency(latency);
}
/* save the latency mode even if acl does not use latency mode or start*/
p_lcb->preset_acl_latency = latency;
return true;
}
/******************************************************************************
*
* Function l2cu_set_non_flushable_pbf
*
* Description set L2CAP_PKT_START_NON_FLUSHABLE if controller supoorts
*
* Returns void
*
******************************************************************************/
void l2cu_set_non_flushable_pbf(bool is_supported) {
if (is_supported)
l2cb.non_flushable_pbf =
(L2CAP_PKT_START_NON_FLUSHABLE << L2CAP_PKT_TYPE_SHIFT);
else
l2cb.non_flushable_pbf = (L2CAP_PKT_START << L2CAP_PKT_TYPE_SHIFT);
}
/*******************************************************************************
*
* Function l2cu_resubmit_pending_sec_req
*
* Description This function is called when required security procedures
* are completed and any pending requests can be re-submitted.
*
* Returns void
*
******************************************************************************/
void l2cu_resubmit_pending_sec_req(const RawAddress* p_bda) {
tL2C_LCB* p_lcb;
tL2C_CCB* p_ccb;
tL2C_CCB* p_next_ccb;
int xx;
log::verbose("l2cu_resubmit_pending_sec_req p_bda: 0x{}", fmt::ptr(p_bda));
/* If we are called with a BDA, only resubmit for that BDA */
if (p_bda) {
p_lcb = l2cu_find_lcb_by_bd_addr(*p_bda, BT_TRANSPORT_BR_EDR);
/* If we don't have one, this is an error */
if (p_lcb) {
/* For all channels, send the event through their FSMs */
for (p_ccb = p_lcb->ccb_queue.p_first_ccb; p_ccb; p_ccb = p_next_ccb) {
p_next_ccb = p_ccb->p_next_ccb;
l2c_csm_execute(p_ccb, L2CEVT_SEC_RE_SEND_CMD, NULL);
}
} else {
log::warn("l2cu_resubmit_pending_sec_req - unknown BD_ADDR");
}
} else {
/* No BDA pasesed in, so check all links */
for (xx = 0, p_lcb = &l2cb.lcb_pool[0]; xx < MAX_L2CAP_LINKS;
xx++, p_lcb++) {
if (p_lcb->in_use) {
/* For all channels, send the event through their FSMs */
for (p_ccb = p_lcb->ccb_queue.p_first_ccb; p_ccb; p_ccb = p_next_ccb) {
p_next_ccb = p_ccb->p_next_ccb;
l2c_csm_execute(p_ccb, L2CEVT_SEC_RE_SEND_CMD, NULL);
}
}
}
}
}
#if (L2CAP_CONFORMANCE_TESTING == TRUE)
/*******************************************************************************
*
* Function l2cu_set_info_rsp_mask
*
* Description This function allows the script wrapper to change the
* info resp mask for conformance testing.
*
* Returns pointer to CCB, or NULL if none
*
******************************************************************************/
void l2cu_set_info_rsp_mask(uint32_t mask) { l2cb.test_info_resp = mask; }
#endif /* L2CAP_CONFORMANCE_TESTING */
/*******************************************************************************
*
* Function l2cu_adjust_out_mps
*
* Description Sets our MPS based on current controller capabilities
*
* Returns void
*
******************************************************************************/
void l2cu_adjust_out_mps(tL2C_CCB* p_ccb) {
uint16_t packet_size;
/* on the tx side MTU is selected based on packet size of the controller */
packet_size = BTM_GetMaxPacketSize(p_ccb->p_lcb->remote_bd_addr);
if (packet_size <= (L2CAP_PKT_OVERHEAD + L2CAP_FCR_OVERHEAD +
L2CAP_SDU_LEN_OVERHEAD + L2CAP_FCS_LEN)) {
/* something is very wrong */
log::error("l2cu_adjust_out_mps bad packet size: {} will use MPS: {}",
packet_size, p_ccb->peer_cfg.fcr.mps);
p_ccb->tx_mps = p_ccb->peer_cfg.fcr.mps;
} else {
packet_size -= (L2CAP_PKT_OVERHEAD + L2CAP_FCR_OVERHEAD +
L2CAP_SDU_LEN_OVERHEAD + L2CAP_FCS_LEN);
/* We try to negotiate MTU that each packet can be split into whole
number of max packets. For example if link is 1.2 max packet size is 339
bytes.
At first calculate how many whole packets it is. MAX L2CAP is 1691 + 4
overhead.
1695, that will be 5 Dh5 packets. Now maximum L2CAP packet is
5 * 339 = 1695. Minus 4 bytes L2CAP header 1691.
For EDR 2.0 packet size is 1027. So we better send RFCOMM packet as 1 3DH5
packet
1 * 1027 = 1027. Minus 4 bytes L2CAP header 1023. */
if (p_ccb->peer_cfg.fcr.mps >= packet_size)
p_ccb->tx_mps = p_ccb->peer_cfg.fcr.mps / packet_size * packet_size;
else
p_ccb->tx_mps = p_ccb->peer_cfg.fcr.mps;
log::verbose(
"l2cu_adjust_out_mps use {} Based on peer_cfg.fcr.mps: {} "
"packet_size: {}",
p_ccb->tx_mps, p_ccb->peer_cfg.fcr.mps, packet_size);
}
}
/*******************************************************************************
*
* Function l2cu_initialize_fixed_ccb
*
* Description Initialize a fixed channel's CCB
*
* Returns true or false
*
******************************************************************************/
bool l2cu_initialize_fixed_ccb(tL2C_LCB* p_lcb, uint16_t fixed_cid) {
tL2C_CCB* p_ccb;
/* If we already have a CCB, then simply return */
p_ccb = p_lcb->p_fixed_ccbs[fixed_cid - L2CAP_FIRST_FIXED_CHNL];
if ((p_ccb != NULL) && p_ccb->in_use) {
/*
* NOTE: The "in_use" check is needed to ignore leftover entries
* that have been already released by l2cu_release_ccb().
*/
return (true);
}
p_ccb = l2cu_allocate_ccb(NULL, 0);
if (p_ccb == NULL) return (false);
if (p_lcb->link_state == LST_DISCONNECTED) {
alarm_cancel(p_lcb->l2c_lcb_timer);
} else {
log::warn(
"Unable to cancel link control block for link connection to device {}",
ADDRESS_TO_LOGGABLE_CSTR(p_lcb->remote_bd_addr));
}
/* Set CID for the connection */
p_ccb->local_cid = fixed_cid;
p_ccb->remote_cid = fixed_cid;
p_ccb->is_flushable = false;
/* Link ccb to lcb and lcb to ccb */
p_lcb->p_fixed_ccbs[fixed_cid - L2CAP_FIRST_FIXED_CHNL] = p_ccb;
p_ccb->p_lcb = p_lcb;
/* There is no configuration, so if the link is up, the channel is up */
if (p_lcb->link_state == LST_CONNECTED) p_ccb->chnl_state = CST_OPEN;
/* Set the default idle timeout value to use */
p_ccb->fixed_chnl_idle_tout =
l2cb.fixed_reg[fixed_cid - L2CAP_FIRST_FIXED_CHNL].default_idle_tout;
return (true);
}
/*******************************************************************************
*
* Function l2cu_no_dynamic_ccbs
*
* Description Handles the case when there are no more dynamic CCBs. If
* there are any fixed CCBs, start the longest of the fixed CCB
* timeouts, otherwise start the default link idle timeout or
* disconnect.
*
* Returns void
*
******************************************************************************/
void l2cu_no_dynamic_ccbs(tL2C_LCB* p_lcb) {
tBTM_STATUS rc;
uint64_t timeout_ms = p_lcb->idle_timeout * 1000;
bool start_timeout = true;
int xx;
for (xx = 0; xx < L2CAP_NUM_FIXED_CHNLS; xx++) {
if ((p_lcb->p_fixed_ccbs[xx] != NULL) &&
(p_lcb->p_fixed_ccbs[xx]->fixed_chnl_idle_tout * 1000 > timeout_ms)) {
if (p_lcb->p_fixed_ccbs[xx]->fixed_chnl_idle_tout ==
L2CAP_NO_IDLE_TIMEOUT) {
log::verbose("NO IDLE timeout set for fixed cid 0x{:04x}",
p_lcb->p_fixed_ccbs[xx]->local_cid);
start_timeout = false;
}
timeout_ms = p_lcb->p_fixed_ccbs[xx]->fixed_chnl_idle_tout * 1000;
}
}
/* If the link is pairing, do not mess with the timeouts */
if (p_lcb->IsBonding()) return;
log::verbose("l2cu_no_dynamic_ccbs() with_active_local_clients={}",
p_lcb->with_active_local_clients);
// Inactive connections should not timeout, since the ATT channel might still
// be in use even without a GATT client. We only timeout if either a dynamic
// channel or a GATT client was used, since then we expect the client to
// manage the lifecycle of the connection.
if (!p_lcb->with_active_local_clients) {
return;
}
if (timeout_ms == 0) {
log::verbose("l2cu_no_dynamic_ccbs() IDLE timer 0, disconnecting link");
rc = btm_sec_disconnect(
p_lcb->Handle(), HCI_ERR_PEER_USER,
"stack::l2cap::l2c_utils::l2cu_no_dynamic_ccbs Idle timer popped");
if (rc == BTM_CMD_STARTED) {
l2cu_process_fixed_disc_cback(p_lcb);
p_lcb->link_state = LST_DISCONNECTING;
timeout_ms = L2CAP_LINK_DISCONNECT_TIMEOUT_MS;
} else if (rc == BTM_SUCCESS) {
l2cu_process_fixed_disc_cback(p_lcb);
/* BTM SEC will make sure that link is release (probably after pairing is
* done) */
p_lcb->link_state = LST_DISCONNECTING;
start_timeout = false;
} else if (p_lcb->IsBonding()) {
acl_disconnect_from_handle(
p_lcb->Handle(), HCI_ERR_PEER_USER,
"stack::l2cap::l2c_utils::l2cu_no_dynamic_ccbs Bonding no traffic");
l2cu_process_fixed_disc_cback(p_lcb);
p_lcb->link_state = LST_DISCONNECTING;
timeout_ms = L2CAP_LINK_DISCONNECT_TIMEOUT_MS;
} else {
/* probably no buffer to send disconnect */
timeout_ms = BT_1SEC_TIMEOUT_MS;
}
}
if (start_timeout) {
alarm_set_on_mloop(p_lcb->l2c_lcb_timer, timeout_ms, l2c_lcb_timer_timeout,
p_lcb);
log::debug("Started link IDLE timeout_ms:{}", (unsigned long)timeout_ms);
} else {
alarm_cancel(p_lcb->l2c_lcb_timer);
}
}
/*******************************************************************************
*
* Function l2cu_process_fixed_chnl_resp
*
* Description handle a fixed channel response (or lack thereof)
* if the link failed, or a fixed channel response was
* not received, the bitfield is all zeros.
*
******************************************************************************/
void l2cu_process_fixed_chnl_resp(tL2C_LCB* p_lcb) {
if (p_lcb->transport == BT_TRANSPORT_BR_EDR) {
/* ignore all not assigned BR/EDR channels */
p_lcb->peer_chnl_mask[0] &=
(L2CAP_FIXED_CHNL_SIG_BIT | L2CAP_FIXED_CHNL_CNCTLESS_BIT |
L2CAP_FIXED_CHNL_SMP_BR_BIT);
} else
p_lcb->peer_chnl_mask[0] = l2cb.l2c_ble_fixed_chnls_mask;
/* Tell all registered fixed channels about the connection */
for (int xx = 0; xx < L2CAP_NUM_FIXED_CHNLS; xx++) {
uint16_t channel_id = xx + L2CAP_FIRST_FIXED_CHNL;
/* See BT Spec Ver 5.0 | Vol 3, Part A 2.1 table 2.1 and 2.2 */
/* skip sending LE fix channel callbacks on BR/EDR links */
if (p_lcb->transport == BT_TRANSPORT_BR_EDR &&
channel_id >= L2CAP_ATT_CID && channel_id <= L2CAP_SMP_CID)
continue;
/* skip sending BR fix channel callbacks on LE links */
if (p_lcb->transport == BT_TRANSPORT_LE && channel_id == L2CAP_SMP_BR_CID)
continue;
if (!l2cb.fixed_reg[xx].pL2CA_FixedConn_Cb) continue;
if (p_lcb->peer_chnl_mask[(channel_id) / 8] & (1 << ((channel_id) % 8))) {
if (p_lcb->p_fixed_ccbs[xx])
p_lcb->p_fixed_ccbs[xx]->chnl_state = CST_OPEN;
(*l2cb.fixed_reg[xx].pL2CA_FixedConn_Cb)(
channel_id, p_lcb->remote_bd_addr, true, 0, p_lcb->transport);
} else {
(*l2cb.fixed_reg[xx].pL2CA_FixedConn_Cb)(
channel_id, p_lcb->remote_bd_addr, false, p_lcb->DisconnectReason(),
p_lcb->transport);
if (p_lcb->p_fixed_ccbs[xx]) {
l2cu_release_ccb(p_lcb->p_fixed_ccbs[xx]);
p_lcb->p_fixed_ccbs[xx] = NULL;
}
}
}
}
/*******************************************************************************
*
* Function l2cu_process_fixed_disc_cback
*
* Description send l2cap fixed channel disconnection callback to the
* application
*
* Returns void
*
******************************************************************************/
void l2cu_process_fixed_disc_cback(tL2C_LCB* p_lcb) {
/* Select peer channels mask to use depending on transport */
uint8_t peer_channel_mask = p_lcb->peer_chnl_mask[0];
// For LE, reset the stored peer channel mask
if (p_lcb->transport == BT_TRANSPORT_LE) p_lcb->peer_chnl_mask[0] = 0;
for (int xx = 0; xx < L2CAP_NUM_FIXED_CHNLS; xx++) {
if (p_lcb->p_fixed_ccbs[xx]) {
if (p_lcb->p_fixed_ccbs[xx] != p_lcb->p_pending_ccb) {
tL2C_CCB* p_l2c_chnl_ctrl_block;
p_l2c_chnl_ctrl_block = p_lcb->p_fixed_ccbs[xx];
p_lcb->p_fixed_ccbs[xx] = NULL;
l2cu_release_ccb(p_l2c_chnl_ctrl_block);
(*l2cb.fixed_reg[xx].pL2CA_FixedConn_Cb)(
xx + L2CAP_FIRST_FIXED_CHNL, p_lcb->remote_bd_addr, false,
p_lcb->DisconnectReason(), p_lcb->transport);
}
} else if ((peer_channel_mask & (1 << (xx + L2CAP_FIRST_FIXED_CHNL))) &&
(l2cb.fixed_reg[xx].pL2CA_FixedConn_Cb != NULL))
(*l2cb.fixed_reg[xx].pL2CA_FixedConn_Cb)(
xx + L2CAP_FIRST_FIXED_CHNL, p_lcb->remote_bd_addr, false,
p_lcb->DisconnectReason(), p_lcb->transport);
}
}
/*******************************************************************************
*
* Function l2cu_send_peer_ble_par_req
*
* Description Build and send a BLE parameter update request message
* to the peer.
*
* Returns void
*
******************************************************************************/
void l2cu_send_peer_ble_par_req(tL2C_LCB* p_lcb, uint16_t min_int,
uint16_t max_int, uint16_t latency,
uint16_t timeout) {
BT_HDR* p_buf;
uint8_t* p;
/* Create an identifier for this packet */
p_lcb->signal_id++;
l2cu_adj_id(p_lcb);
p_buf = l2cu_build_header(p_lcb, L2CAP_CMD_BLE_UPD_REQ_LEN,
L2CAP_CMD_BLE_UPDATE_REQ, p_lcb->signal_id);
if (p_buf == NULL) {
log::warn("l2cu_send_peer_ble_par_req - no buffer");
return;
}
p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET + HCI_DATA_PREAMBLE_SIZE +
L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD;
UINT16_TO_STREAM(p, min_int);
UINT16_TO_STREAM(p, max_int);
UINT16_TO_STREAM(p, latency);
UINT16_TO_STREAM(p, timeout);
l2c_link_check_send_pkts(p_lcb, 0, p_buf);
}
/*******************************************************************************
*
* Function l2cu_send_peer_ble_par_rsp
*
* Description Build and send a BLE parameter update response message
* to the peer.
*
* Returns void
*
******************************************************************************/
void l2cu_send_peer_ble_par_rsp(tL2C_LCB* p_lcb, uint16_t reason,
uint8_t rem_id) {
BT_HDR* p_buf;
uint8_t* p;
p_buf = l2cu_build_header(p_lcb, L2CAP_CMD_BLE_UPD_RSP_LEN,
L2CAP_CMD_BLE_UPDATE_RSP, rem_id);
if (p_buf == NULL) {
log::warn("l2cu_send_peer_ble_par_rsp - no buffer");
return;
}
p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET + HCI_DATA_PREAMBLE_SIZE +
L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD;
UINT16_TO_STREAM(p, reason);
l2c_link_check_send_pkts(p_lcb, 0, p_buf);
}
/*******************************************************************************
*
* Function l2cu_send_peer_ble_credit_based_conn_req
*
* Description Build and send a BLE packet to establish LE connection
* oriented L2CAP channel.
*
* Returns void
*
******************************************************************************/
void l2cu_send_peer_ble_credit_based_conn_req(tL2C_CCB* p_ccb) {
BT_HDR* p_buf;
uint8_t* p;
tL2C_LCB* p_lcb = NULL;
uint16_t mtu;
uint16_t mps;
uint16_t initial_credit;
if (!p_ccb) return;
p_lcb = p_ccb->p_lcb;
/* Create an identifier for this packet */
p_ccb->p_lcb->signal_id++;
l2cu_adj_id(p_ccb->p_lcb);
p_ccb->local_id = p_ccb->p_lcb->signal_id;
p_buf =
l2cu_build_header(p_lcb, L2CAP_CMD_BLE_CREDIT_BASED_CONN_REQ_LEN,
L2CAP_CMD_BLE_CREDIT_BASED_CONN_REQ, p_lcb->signal_id);
if (p_buf == NULL) {
log::warn("l2cu_send_peer_ble_credit_based_conn_req - no buffer");
return;
}
p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET + HCI_DATA_PREAMBLE_SIZE +
L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD;
mtu = p_ccb->local_conn_cfg.mtu;
mps = p_ccb->local_conn_cfg.mps;
initial_credit = p_ccb->local_conn_cfg.credits;
log::verbose(
"l2cu_send_peer_ble_credit_based_conn_req PSM:0x{:04x} local_cid:{} "
"mtu:{} mps:{} initial_credit:{}",
p_ccb->p_rcb->real_psm, p_ccb->local_cid, mtu, mps, initial_credit);
UINT16_TO_STREAM(p, p_ccb->p_rcb->real_psm);
UINT16_TO_STREAM(p, p_ccb->local_cid);
UINT16_TO_STREAM(p, mtu);
UINT16_TO_STREAM(p, mps);
UINT16_TO_STREAM(p, initial_credit);
l2c_link_check_send_pkts(p_lcb, 0, p_buf);
}
/*******************************************************************************
*
* Function l2cu_send_peer_credit_based_conn_req
*
* Description Build and send a BLE packet to establish enhanced connection
* oriented L2CAP channel.
*
* Returns void
*
******************************************************************************/
void l2cu_send_peer_credit_based_conn_req(tL2C_CCB* p_ccb) {
BT_HDR* p_buf;
uint8_t* p;
tL2C_LCB* p_lcb = NULL;
uint16_t mtu;
uint16_t mps;
uint16_t initial_credit;
if (!p_ccb) return;
p_lcb = p_ccb->p_lcb;
/* Create an identifier for this packet */
p_ccb->p_lcb->signal_id++;
l2cu_adj_id(p_ccb->p_lcb);
p_ccb->local_id = p_lcb->signal_id;
p_buf = l2cu_build_header(p_lcb,
L2CAP_CMD_CREDIT_BASED_CONN_REQ_MIN_LEN +
2 * p_lcb->pending_ecoc_conn_cnt,
L2CAP_CMD_CREDIT_BASED_CONN_REQ, p_ccb->local_id);
if (p_buf == NULL) {
log::warn("no buffer");
return;
}
p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET + HCI_DATA_PREAMBLE_SIZE +
L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD;
mtu = p_ccb->local_conn_cfg.mtu;
mps = p_ccb->local_conn_cfg.mps;
initial_credit = p_ccb->local_conn_cfg.credits;
log::verbose("PSM:0x{:04x} mtu:{} mps:{} initial_credit:{}, cids_cnt {}",
p_ccb->p_rcb->real_psm, mtu, mps, initial_credit,
p_lcb->pending_ecoc_conn_cnt);
UINT16_TO_STREAM(p, p_ccb->p_rcb->real_psm);
UINT16_TO_STREAM(p, mtu);
UINT16_TO_STREAM(p, mps);
UINT16_TO_STREAM(p, initial_credit);
for (int i = 0; i < p_lcb->pending_ecoc_conn_cnt; i++) {
uint16_t cid = p_lcb->pending_ecoc_connection_cids[i];
log::verbose(" cid: {}", cid);
UINT16_TO_STREAM(p, cid);
}
l2c_link_check_send_pkts(p_lcb, 0, p_buf);
}
/*******************************************************************************
*
* Function l2cu_reject_ble_coc_connection
*
* Description Build and send an L2CAP "Credit based connection res"
* message to the peer. This function is called for non-success
* cases.
*
* Returns void
*
******************************************************************************/
void l2cu_reject_ble_coc_connection(tL2C_LCB* p_lcb, uint8_t rem_id,
uint16_t result) {
BT_HDR* p_buf;
uint8_t* p;
p_buf = l2cu_build_header(p_lcb, L2CAP_CMD_BLE_CREDIT_BASED_CONN_RES_LEN,
L2CAP_CMD_BLE_CREDIT_BASED_CONN_RES, rem_id);
if (p_buf == NULL) {
log::warn("l2cu_reject_ble_coc_connection - no buffer");
return;
}
p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET + HCI_DATA_PREAMBLE_SIZE +
L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD;
UINT16_TO_STREAM(p, 0); /* Local CID of 0 */
UINT16_TO_STREAM(p, 0); /* MTU */
UINT16_TO_STREAM(p, 0); /* MPS */
UINT16_TO_STREAM(p, 0); /* initial credit */
UINT16_TO_STREAM(p, result);
l2c_link_check_send_pkts(p_lcb, 0, p_buf);
}
/*******************************************************************************
*
* Function l2cu_reject_credit_based_connection_req
*
* Description Build and send an L2CAP "credit based connection
*res" message to the peer. This function is called for non-success cases.
*
* Returns void
*
******************************************************************************/
void l2cu_reject_credit_based_conn_req(tL2C_LCB* p_lcb, uint8_t rem_id,
uint8_t num_of_channels,
uint16_t result) {
BT_HDR* p_buf;
uint8_t* p;
uint8_t rsp_len = L2CAP_CMD_CREDIT_BASED_CONN_RES_MIN_LEN +
sizeof(uint16_t) * num_of_channels;
p_buf = l2cu_build_header(p_lcb, rsp_len, L2CAP_CMD_CREDIT_BASED_CONN_RES,
rem_id);
if (p_buf == NULL) {
log::warn("l2cu_reject_credit_based_conn_req - no buffer");
return;
}
p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET + HCI_DATA_PREAMBLE_SIZE +
L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD;
memset(p, 0, rsp_len);
UINT16_TO_STREAM(p, L2CAP_CREDIT_BASED_MIN_MTU); /* dummy MTU to satisy PTS */
UINT16_TO_STREAM(p, L2CAP_CREDIT_BASED_MIN_MPS); /* dummy MPS to satisy PTS*/
UINT16_TO_STREAM(p, 1); /* dummy initial credit to satisy PTS */
UINT16_TO_STREAM(p, result);
l2c_link_check_send_pkts(p_lcb, 0, p_buf);
}
/*******************************************************************************
*
* Function l2cu_send_peer_credit_based_conn_res
*
* Description Build and send an L2CAP "Credit based connection res"
* message to the peer. This function is called in case of
* success.
*
* Returns void
*
******************************************************************************/
void l2cu_send_peer_credit_based_conn_res(tL2C_CCB* p_ccb,
std::vector<uint16_t>& accepted_cids,
uint16_t result) {
BT_HDR* p_buf;
uint8_t* p;
log::verbose("");
uint8_t rsp_len = L2CAP_CMD_CREDIT_BASED_CONN_RES_MIN_LEN +
p_ccb->p_lcb->pending_ecoc_conn_cnt * sizeof(uint16_t);
p_buf = l2cu_build_header(p_ccb->p_lcb, rsp_len,
L2CAP_CMD_CREDIT_BASED_CONN_RES, p_ccb->remote_id);
if (p_buf == NULL) {
log::warn("no buffer");
return;
}
p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET + HCI_DATA_PREAMBLE_SIZE +
L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD;
memset(p, 0, rsp_len);
UINT16_TO_STREAM(p, p_ccb->local_conn_cfg.mtu); /* MTU */
UINT16_TO_STREAM(p, p_ccb->local_conn_cfg.mps); /* MPS */
UINT16_TO_STREAM(p, p_ccb->local_conn_cfg.credits); /* initial credit */
if (result == L2CAP_CONN_OK) {
/* In case of success, we need to check if stack
* did not have previous result stored e.g. when there was no
* resources for allocation all the requrested channels,
* before user indication.
*/
result = p_ccb->p_lcb->pending_l2cap_result;
}
UINT16_TO_STREAM(p, result);
/* We need to keep order from the request.
* if this vector contais 0 it means channel has been rejected by
* the stack.
* If there is valid cid, we need to verify if it is accepted by upper layer.
*/
for (int i = 0; i < p_ccb->p_lcb->pending_ecoc_conn_cnt; i++) {
uint16_t cid = p_ccb->p_lcb->pending_ecoc_connection_cids[i];
if (cid == 0) {
UINT16_TO_STREAM(p, 0);
continue;
}
auto it = std::find(accepted_cids.begin(), accepted_cids.end(), cid);
if (it != accepted_cids.end()) {
UINT16_TO_STREAM(p, cid);
} else {
UINT16_TO_STREAM(p, 0);
}
}
l2c_link_check_send_pkts(p_ccb->p_lcb, 0, p_buf);
}
/*******************************************************************************
*
* Function l2cu_reject_ble_connection
*
* Description Build and send an L2CAP "Credit based connection res"
* message to the peer. This function is called for non-success
* cases.
*
* Returns void
*
******************************************************************************/
void l2cu_reject_ble_connection(tL2C_CCB* p_ccb, uint8_t rem_id,
uint16_t result) {
if (p_ccb->ecoc)
l2cu_reject_credit_based_conn_req(
p_ccb->p_lcb, rem_id, p_ccb->p_lcb->pending_ecoc_conn_cnt, result);
else
l2cu_reject_ble_coc_connection(p_ccb->p_lcb, rem_id, result);
}
/*******************************************************************************
*
* Function l2cu_send_ble_reconfig_rsp
*
* Description Build and send an L2CAP "Credit based reconfig res"
* message to the peer. This function is called for non-success
* cases.
*
* Returns void
*
******************************************************************************/
void l2cu_send_ble_reconfig_rsp(tL2C_LCB* p_lcb, uint8_t rem_id,
uint16_t result) {
BT_HDR* p_buf;
uint8_t* p;
log::verbose("l2cu_send_ble_reconfig_rsp result 0x04{:x}", result);
p_buf = l2cu_build_header(p_lcb, L2CAP_CMD_CREDIT_BASED_RECONFIG_RES_LEN,
L2CAP_CMD_CREDIT_BASED_RECONFIG_RES, rem_id);
if (p_buf == NULL) {
log::warn("l2cu_send_peer_ble_credit_based_conn_res - no buffer");
return;
}
p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET + HCI_DATA_PREAMBLE_SIZE +
L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD;
memset(p, 0, L2CAP_CMD_CREDIT_BASED_RECONFIG_RES_LEN);
UINT16_TO_STREAM(p, result);
l2c_link_check_send_pkts(p_lcb, 0, p_buf);
}
/*******************************************************************************
*
* Function l2cu_send_peer_ble_credit_based_conn_res
*
* Description Build and send an L2CAP "Credit based connection res"
* message to the peer. This function is called in case of
* success.
*
* Returns void
*
******************************************************************************/
void l2cu_send_peer_ble_credit_based_conn_res(tL2C_CCB* p_ccb,
uint16_t result) {
BT_HDR* p_buf;
uint8_t* p;
log::verbose("l2cu_send_peer_ble_credit_based_conn_res");
p_buf =
l2cu_build_header(p_ccb->p_lcb, L2CAP_CMD_BLE_CREDIT_BASED_CONN_RES_LEN,
L2CAP_CMD_BLE_CREDIT_BASED_CONN_RES, p_ccb->remote_id);
if (p_buf == NULL) {
log::warn("l2cu_send_peer_ble_credit_based_conn_res - no buffer");
return;
}
p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET + HCI_DATA_PREAMBLE_SIZE +
L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD;
UINT16_TO_STREAM(p, p_ccb->local_cid); /* Local CID */
UINT16_TO_STREAM(p, p_ccb->local_conn_cfg.mtu); /* MTU */
UINT16_TO_STREAM(p, p_ccb->local_conn_cfg.mps); /* MPS */
UINT16_TO_STREAM(p, p_ccb->local_conn_cfg.credits); /* initial credit */
UINT16_TO_STREAM(p, result);
l2c_link_check_send_pkts(p_ccb->p_lcb, 0, p_buf);
}
/*******************************************************************************
*
* Function l2cu_send_peer_ble_flow_control_credit
*
* Description Build and send a BLE packet to give credits to peer device
* for LE connection oriented L2CAP channel.
*
* Returns void
*
******************************************************************************/
void l2cu_send_peer_ble_flow_control_credit(tL2C_CCB* p_ccb,
uint16_t credit_value) {
BT_HDR* p_buf;
uint8_t* p;
tL2C_LCB* p_lcb = NULL;
if (!p_ccb) return;
p_lcb = p_ccb->p_lcb;
/* Create an identifier for this packet */
p_ccb->p_lcb->signal_id++;
l2cu_adj_id(p_ccb->p_lcb);
p_ccb->local_id = p_ccb->p_lcb->signal_id;
p_buf = l2cu_build_header(p_lcb, L2CAP_CMD_BLE_FLOW_CTRL_CREDIT_LEN,
L2CAP_CMD_BLE_FLOW_CTRL_CREDIT, p_lcb->signal_id);
if (p_buf == NULL) {
log::warn("l2cu_send_peer_ble_credit_based_conn_req - no buffer");
return;
}
p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET + HCI_DATA_PREAMBLE_SIZE +
L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD;
UINT16_TO_STREAM(p, p_ccb->local_cid);
UINT16_TO_STREAM(p, credit_value);
l2c_link_check_send_pkts(p_lcb, 0, p_buf);
}
/*******************************************************************************
*
* Function l2cu_send_peer_ble_credit_based_conn_req
*
* Description Build and send a BLE packet to disconnect LE connection
* oriented L2CAP channel.
*
* Returns void
*
******************************************************************************/
void l2cu_send_peer_ble_credit_based_disconn_req(tL2C_CCB* p_ccb) {
BT_HDR* p_buf;
uint8_t* p;
tL2C_LCB* p_lcb = NULL;
log::verbose("");
if (!p_ccb) return;
p_lcb = p_ccb->p_lcb;
/* Create an identifier for this packet */
p_ccb->p_lcb->signal_id++;
l2cu_adj_id(p_ccb->p_lcb);
p_ccb->local_id = p_ccb->p_lcb->signal_id;
p_buf = l2cu_build_header(p_lcb, L2CAP_DISC_REQ_LEN, L2CAP_CMD_DISC_REQ,
p_lcb->signal_id);
if (p_buf == NULL) {
log::warn("l2cu_send_peer_ble_credit_based_disconn_req - no buffer");
return;
}
p = (uint8_t*)(p_buf + 1) + L2CAP_SEND_CMD_OFFSET + HCI_DATA_PREAMBLE_SIZE +
L2CAP_PKT_OVERHEAD + L2CAP_CMD_OVERHEAD;
UINT16_TO_STREAM(p, p_ccb->remote_cid);
UINT16_TO_STREAM(p, p_ccb->local_cid);
l2c_link_check_send_pkts(p_lcb, 0, p_buf);
}
/*******************************************************************************
* Functions used by both Full and Light Stack
******************************************************************************/
/*******************************************************************************
*
* Function l2cu_find_lcb_by_handle
*
* Description Look through all active LCBs for a match based on the
* HCI handle.
*
* Returns pointer to matched LCB, or NULL if no match
*
******************************************************************************/
tL2C_LCB* l2cu_find_lcb_by_handle(uint16_t handle) {
int xx;
tL2C_LCB* p_lcb = &l2cb.lcb_pool[0];
for (xx = 0; xx < MAX_L2CAP_LINKS; xx++, p_lcb++) {
if ((p_lcb->in_use) && (p_lcb->Handle() == handle)) {
return (p_lcb);
}
}
/* If here, no match found */
return (NULL);
}
/*******************************************************************************
*
* Function l2cu_find_ccb_by_cid
*
* Description Look through all active CCBs on a link for a match based
* on the local CID. If passed the link pointer is NULL, all
* active links are searched.
*
* Returns pointer to matched CCB, or NULL if no match
*
******************************************************************************/
tL2C_CCB* l2cu_find_ccb_by_cid(tL2C_LCB* p_lcb, uint16_t local_cid) {
tL2C_CCB* p_ccb = NULL;
if (local_cid >= L2CAP_BASE_APPL_CID) {
/* find the associated CCB by "index" */
local_cid -= L2CAP_BASE_APPL_CID;
if (local_cid >= MAX_L2CAP_CHANNELS) return NULL;
p_ccb = l2cb.ccb_pool + local_cid;
/* make sure the CCB is in use */
if (!p_ccb->in_use) {
p_ccb = NULL;
}
/* make sure it's for the same LCB */
else if (p_lcb && p_lcb != p_ccb->p_lcb) {
p_ccb = NULL;
}
}
return (p_ccb);
}
void l2cu_tx_complete(tL2C_TX_COMPLETE_CB_INFO* p_cbi) {
if (p_cbi->cb != NULL) p_cbi->cb(p_cbi->local_cid, p_cbi->num_sdu);
}
/******************************************************************************
*
* Function l2cu_set_acl_hci_header
*
* Description Set HCI handle for ACL packet
*
* Returns None
*
******************************************************************************/
void l2cu_set_acl_hci_header(BT_HDR* p_buf, tL2C_CCB* p_ccb) {
uint8_t* p;
/* Set the pointer to the beginning of the data minus 4 bytes for the packet
* header */
p = (uint8_t*)(p_buf + 1) + p_buf->offset - HCI_DATA_PREAMBLE_SIZE;
if (p_ccb->p_lcb->transport == BT_TRANSPORT_LE) {
UINT16_TO_STREAM(p, p_ccb->p_lcb->Handle() | (L2CAP_PKT_START_NON_FLUSHABLE
<< L2CAP_PKT_TYPE_SHIFT));
uint16_t acl_data_size =
controller_get_interface()->get_acl_data_size_ble();
/* The HCI transport will segment the buffers. */
if (p_buf->len > acl_data_size) {
UINT16_TO_STREAM(p, acl_data_size);
} else {
UINT16_TO_STREAM(p, p_buf->len);
}
} else {
if (((p_buf->layer_specific & L2CAP_FLUSHABLE_MASK) ==
L2CAP_FLUSHABLE_CH_BASED) &&
(p_ccb->is_flushable)) {
UINT16_TO_STREAM(p, p_ccb->p_lcb->Handle() |
(L2CAP_PKT_START << L2CAP_PKT_TYPE_SHIFT));
} else {
UINT16_TO_STREAM(p, p_ccb->p_lcb->Handle() | l2cb.non_flushable_pbf);
}
uint16_t acl_data_size =
controller_get_interface()->get_acl_data_size_classic();
/* The HCI transport will segment the buffers. */
if (p_buf->len > acl_data_size) {
UINT16_TO_STREAM(p, acl_data_size);
} else {
UINT16_TO_STREAM(p, p_buf->len);
}
}
p_buf->offset -= HCI_DATA_PREAMBLE_SIZE;
p_buf->len += HCI_DATA_PREAMBLE_SIZE;
}
static void send_congestion_status_to_all_clients(tL2C_CCB* p_ccb,
bool status) {
p_ccb->cong_sent = status;
if (p_ccb->p_rcb && p_ccb->p_rcb->api.pL2CA_CongestionStatus_Cb) {
log::verbose(
"L2CAP - Calling CongestionStatus_Cb ({}), CID: 0x{:04x} "
"xmit_hold_q.count: {} buff_quota: {}",
status, p_ccb->local_cid, fixed_queue_length(p_ccb->xmit_hold_q),
p_ccb->buff_quota);
/* Prevent recursive calling */
if (status == false) l2cb.is_cong_cback_context = true;
(*p_ccb->p_rcb->api.pL2CA_CongestionStatus_Cb)(p_ccb->local_cid, status);
if (status == false) l2cb.is_cong_cback_context = false;
}
else {
for (uint8_t xx = 0; xx < L2CAP_NUM_FIXED_CHNLS; xx++) {
if (p_ccb->p_lcb->p_fixed_ccbs[xx] == p_ccb) {
if (l2cb.fixed_reg[xx].pL2CA_FixedCong_Cb != NULL)
(*l2cb.fixed_reg[xx].pL2CA_FixedCong_Cb)(p_ccb->p_lcb->remote_bd_addr,
status);
break;
}
}
}
}
/* check if any change in congestion status */
void l2cu_check_channel_congestion(tL2C_CCB* p_ccb) {
/* If the CCB queue limit is subject to a quota, check for congestion if this
* channel has outgoing traffic */
if (p_ccb->buff_quota == 0) return;
size_t q_count = fixed_queue_length(p_ccb->xmit_hold_q);
if (p_ccb->cong_sent) {
/* if channel was congested, but is not congested now, tell the app */
if (q_count <= (p_ccb->buff_quota / 2))
send_congestion_status_to_all_clients(p_ccb, false);
} else {
/* if channel was not congested, but is congested now, tell the app */
if (q_count > p_ccb->buff_quota)
send_congestion_status_to_all_clients(p_ccb, true);
}
}
/*******************************************************************************
*
* Function l2cu_is_ccb_active
*
* Description Check if Channel Control Block is in use or released
*
* Returns bool - true if Channel Control Block is in use
* false if p_ccb is null or is released.
*
******************************************************************************/
bool l2cu_is_ccb_active(tL2C_CCB* p_ccb) { return (p_ccb && p_ccb->in_use); }
/*******************************************************************************
*
* Function le_result_to_l2c_conn
*
* Description Connvert an LE result code to L2C connection code.
*
* Returns The converted L2C connection code.
*
******************************************************************************/
uint16_t le_result_to_l2c_conn(uint16_t result) {
tL2CAP_LE_RESULT_CODE code = (tL2CAP_LE_RESULT_CODE)result;
switch (code) {
case L2CAP_LE_RESULT_CONN_OK:
case L2CAP_LE_RESULT_NO_PSM:
case L2CAP_LE_RESULT_NO_RESOURCES:
return code;
case L2CAP_LE_RESULT_INSUFFICIENT_AUTHENTICATION:
case L2CAP_LE_RESULT_INSUFFICIENT_AUTHORIZATION:
case L2CAP_LE_RESULT_INSUFFICIENT_ENCRYP_KEY_SIZE:
case L2CAP_LE_RESULT_INSUFFICIENT_ENCRYP:
case L2CAP_LE_RESULT_INVALID_SOURCE_CID:
case L2CAP_LE_RESULT_SOURCE_CID_ALREADY_ALLOCATED:
case L2CAP_LE_RESULT_UNACCEPTABLE_PARAMETERS:
case L2CAP_LE_RESULT_INVALID_PARAMETERS:
return L2CAP_CONN_LE_MASK | code;
default:
if (result < L2CAP_CONN_LE_MASK) {
return L2CAP_CONN_LE_MASK | code;
}
return L2CAP_CONN_OTHER_ERROR;
}
}