blob: 328778503b5f1e11cfed0720710074c8060124b7 [file] [log] [blame]
/******************************************************************************
*
* Copyright 2003-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 AVCTP module interfaces to L2CAP
*
******************************************************************************/
#define LOG_TAG "avctp"
#include <android_bluetooth_sysprop.h>
#include <bluetooth/log.h>
#include "avct_api.h"
#include "avct_int.h"
#include "internal_include/bt_target.h"
#include "l2c_api.h"
#include "l2cdefs.h"
#include "osi/include/allocator.h"
#include "osi/include/osi.h"
#include "stack/include/bt_hdr.h"
#include "types/raw_address.h"
using namespace bluetooth;
/* callback function declarations */
void avct_l2c_connect_ind_cback(const RawAddress& bd_addr, uint16_t lcid,
uint16_t psm, uint8_t id);
void avct_l2c_connect_cfm_cback(uint16_t lcid, uint16_t result);
void avct_l2c_config_cfm_cback(uint16_t lcid, uint16_t result,
tL2CAP_CFG_INFO* p_cfg);
void avct_l2c_config_ind_cback(uint16_t lcid, tL2CAP_CFG_INFO* p_cfg);
void avct_l2c_disconnect_ind_cback(uint16_t lcid, bool ack_needed);
void avct_l2c_congestion_ind_cback(uint16_t lcid, bool is_congested);
void avct_l2c_data_ind_cback(uint16_t lcid, BT_HDR* p_buf);
static void avct_on_l2cap_error(uint16_t lcid, uint16_t result);
/* L2CAP callback function structure */
const tL2CAP_APPL_INFO avct_l2c_appl = {
avct_l2c_connect_ind_cback,
avct_l2c_connect_cfm_cback,
avct_l2c_config_ind_cback,
avct_l2c_config_cfm_cback,
avct_l2c_disconnect_ind_cback,
NULL,
avct_l2c_data_ind_cback,
avct_l2c_congestion_ind_cback,
NULL,
avct_on_l2cap_error,
NULL,
NULL,
NULL,
NULL,
};
/*******************************************************************************
*
* Function avct_l2c_is_passive
*
* Description check is the CCB associated with the given LCB was created
* as passive
*
* Returns true, if the given LCB is created as AVCT_PASSIVE
*
******************************************************************************/
static bool avct_l2c_is_passive(tAVCT_LCB* p_lcb) {
bool is_passive = false;
tAVCT_CCB* p_ccb = &avct_cb.ccb[0];
int i;
for (i = 0; i < AVCT_NUM_CONN; i++, p_ccb++) {
if (p_ccb->allocated && (p_ccb->p_lcb == p_lcb)) {
log::verbose("avct_l2c_is_ct control:x{:x}", p_ccb->cc.control);
if (p_ccb->cc.control & AVCT_PASSIVE) {
is_passive = true;
break;
}
}
}
return is_passive;
}
/*******************************************************************************
*
* Function avct_l2c_connect_ind_cback
*
* Description This is the L2CAP connect indication callback function.
*
*
* Returns void
*
******************************************************************************/
void avct_l2c_connect_ind_cback(const RawAddress& bd_addr, uint16_t lcid,
UNUSED_ATTR uint16_t psm, uint8_t id) {
tAVCT_LCB* p_lcb;
uint16_t result = L2CAP_CONN_OK;
/* do we already have a channel for this peer? */
p_lcb = avct_lcb_by_bd(bd_addr);
if (p_lcb == NULL) {
/* no, allocate lcb */
p_lcb = avct_lcb_alloc(bd_addr);
if (p_lcb == NULL) {
/* no ccb available, reject L2CAP connection */
result = L2CAP_CONN_NO_RESOURCES;
}
}
/* else we already have a channel for this peer */
else {
if (!avct_l2c_is_passive(p_lcb) || (p_lcb->ch_state == AVCT_CH_OPEN)) {
/* this LCB included CT role - reject */
result = L2CAP_CONN_NO_RESOURCES;
} else {
/* TG role only - accept the connection from CT. move the channel ID to
* the conflict list */
p_lcb->conflict_lcid = p_lcb->ch_lcid;
log::verbose("avct_l2c_connect_ind_cback conflict_lcid:0x{:x}",
p_lcb->conflict_lcid);
}
}
if (p_lcb) {
log::verbose("avct_l2c_connect_ind_cback: 0x{:x}, res: {}, ch_state: {}",
lcid, result, p_lcb->ch_state);
}
/* If we reject the connection, send DisconnectReq */
if (result != L2CAP_CONN_OK) {
L2CA_DisconnectReq(lcid);
}
/* if result ok, proceed with connection */
if (result == L2CAP_CONN_OK) {
if (GET_SYSPROP(A2dp, src_sink_coexist, false)) {
tAVCT_CCB* p_ccb = &avct_cb.ccb[0];
for (int i = 0; i < AVCT_NUM_CONN; i++, p_ccb++) {
if (p_ccb && p_ccb->allocated && (p_ccb->p_lcb == NULL) &&
(p_ccb->cc.role == AVCT_ACP)) {
p_ccb->p_lcb = p_lcb;
log::verbose(
"ACP bind {} ccb to lcb, alloc {}, lcb {}, role {}, pid 0x{:x}",
i, p_ccb->allocated, fmt::ptr(p_ccb->p_lcb), p_ccb->cc.role,
p_ccb->cc.pid);
}
}
}
/* store LCID */
p_lcb->ch_lcid = lcid;
/* transition to configuration state */
p_lcb->ch_state = AVCT_CH_CFG;
}
if (p_lcb) log::verbose("ch_state cni: {} ", p_lcb->ch_state);
}
static void avct_on_l2cap_error(uint16_t lcid, uint16_t result) {
tAVCT_LCB* p_lcb = avct_lcb_by_lcid(lcid);
if (p_lcb == nullptr) return;
if (p_lcb->ch_state == AVCT_CH_CONN) {
log::verbose("avct_l2c_connect_cfm_cback conflict_lcid:0x{:x}",
p_lcb->conflict_lcid);
if (p_lcb->conflict_lcid == lcid) {
p_lcb->conflict_lcid = 0;
} else {
tAVCT_LCB_EVT avct_lcb_evt;
avct_lcb_evt.result = result;
avct_lcb_event(p_lcb, AVCT_LCB_LL_CLOSE_EVT, &avct_lcb_evt);
}
} else if (p_lcb->ch_state == AVCT_CH_CFG) {
log::verbose("ERROR avct_l2c_config_cfm_cback L2CA_DisconnectReq {} ",
p_lcb->ch_state);
/* store result value */
p_lcb->ch_result = result;
/* Send L2CAP disconnect req */
L2CA_DisconnectReq(lcid);
}
}
/*******************************************************************************
*
* Function avct_l2c_connect_cfm_cback
*
* Description This is the L2CAP connect confirm callback function.
*
*
* Returns void
*
******************************************************************************/
void avct_l2c_connect_cfm_cback(uint16_t lcid, uint16_t result) {
tAVCT_LCB* p_lcb;
/* look up lcb for this channel */
p_lcb = avct_lcb_by_lcid(lcid);
if (p_lcb != NULL) {
log::verbose(
"avct_l2c_connect_cfm_cback lcid:0x{:x} result: {} ch_state: {}, "
"conflict_lcid:0x{:x}",
lcid, result, p_lcb->ch_state, p_lcb->conflict_lcid);
/* if in correct state */
if (p_lcb->ch_state == AVCT_CH_CONN) {
/* if result successful */
if (result == L2CAP_CONN_OK) {
/* set channel state */
p_lcb->ch_state = AVCT_CH_CFG;
}
/* else failure */
else {
log::error("invoked with non OK status");
}
} else if (p_lcb->conflict_lcid == lcid) {
/* we must be in AVCT_CH_CFG state for the ch_lcid channel */
log::verbose(
"avct_l2c_connect_cfm_cback ch_state: {}, conflict_lcid:0x{:x}",
p_lcb->ch_state, p_lcb->conflict_lcid);
if (result == L2CAP_CONN_OK) {
/* just in case the peer also accepts our connection - Send L2CAP
* disconnect req */
L2CA_DisconnectReq(lcid);
}
p_lcb->conflict_lcid = 0;
}
log::verbose("ch_state cnc: {} ", p_lcb->ch_state);
}
}
/*******************************************************************************
*
* Function avct_l2c_config_cfm_cback
*
* Description This is the L2CAP config confirm callback function.
*
*
* Returns void
*
******************************************************************************/
void avct_l2c_config_cfm_cback(uint16_t lcid, uint16_t initiator,
tL2CAP_CFG_INFO* p_cfg) {
avct_l2c_config_ind_cback(lcid, p_cfg);
tAVCT_LCB* p_lcb;
/* look up lcb for this channel */
p_lcb = avct_lcb_by_lcid(lcid);
if (p_lcb != NULL) {
log::verbose("avct_l2c_config_cfm_cback: 0x{:x}, ch_state: {},", lcid,
p_lcb->ch_state);
/* if in correct state */
if (p_lcb->ch_state == AVCT_CH_CFG) {
p_lcb->ch_state = AVCT_CH_OPEN;
avct_lcb_event(p_lcb, AVCT_LCB_LL_OPEN_EVT, NULL);
}
log::verbose("ch_state cfc: {} ", p_lcb->ch_state);
}
}
/*******************************************************************************
*
* Function avct_l2c_config_ind_cback
*
* Description This is the L2CAP config indication callback function.
*
*
* Returns void
*
******************************************************************************/
void avct_l2c_config_ind_cback(uint16_t lcid, tL2CAP_CFG_INFO* p_cfg) {
tAVCT_LCB* p_lcb;
/* look up lcb for this channel */
p_lcb = avct_lcb_by_lcid(lcid);
if (p_lcb != NULL) {
log::verbose("avct_l2c_config_ind_cback: 0x{:x}, ch_state: {}", lcid,
p_lcb->ch_state);
/* store the mtu in tbl */
if (p_cfg->mtu_present) {
p_lcb->peer_mtu = p_cfg->mtu;
} else {
p_lcb->peer_mtu = L2CAP_DEFAULT_MTU;
}
}
}
/*******************************************************************************
*
* Function avct_l2c_disconnect_ind_cback
*
* Description This is the L2CAP disconnect indication callback function.
*
*
* Returns void
*
******************************************************************************/
void avct_l2c_disconnect_ind_cback(uint16_t lcid, bool ack_needed) {
tAVCT_LCB* p_lcb;
uint16_t result = AVCT_RESULT_FAIL;
/* look up lcb for this channel */
p_lcb = avct_lcb_by_lcid(lcid);
if (p_lcb != NULL) {
log::verbose("avct_l2c_disconnect_ind_cback: 0x{:x}, ch_state: {}", lcid,
p_lcb->ch_state);
tAVCT_LCB_EVT avct_lcb_evt;
avct_lcb_evt.result = result;
avct_lcb_event(p_lcb, AVCT_LCB_LL_CLOSE_EVT, &avct_lcb_evt);
log::verbose("ch_state di: {} ", p_lcb->ch_state);
}
}
void avct_l2c_disconnect(uint16_t lcid, uint16_t result) {
L2CA_DisconnectReq(lcid);
tAVCT_LCB* p_lcb;
uint16_t res;
/* look up lcb for this channel */
p_lcb = avct_lcb_by_lcid(lcid);
if (p_lcb != NULL) {
log::verbose("avct_l2c_disconnect_cfm_cback: 0x{:x}, ch_state: {}, res: {}",
lcid, p_lcb->ch_state, result);
/* result value may be previously stored */
res = (p_lcb->ch_result != 0) ? p_lcb->ch_result : result;
p_lcb->ch_result = 0;
tAVCT_LCB_EVT avct_lcb_evt;
avct_lcb_evt.result = res;
avct_lcb_event(p_lcb, AVCT_LCB_LL_CLOSE_EVT, &avct_lcb_evt);
log::verbose("ch_state dc: {} ", p_lcb->ch_state);
}
}
/*******************************************************************************
*
* Function avct_l2c_congestion_ind_cback
*
* Description This is the L2CAP congestion indication callback function.
*
*
* Returns void
*
******************************************************************************/
void avct_l2c_congestion_ind_cback(uint16_t lcid, bool is_congested) {
tAVCT_LCB* p_lcb;
log::verbose("avct_l2c_congestion_ind_cback: 0x{:x}", lcid);
/* look up lcb for this channel */
p_lcb = avct_lcb_by_lcid(lcid);
if (p_lcb != NULL) {
tAVCT_LCB_EVT avct_lcb_evt;
avct_lcb_evt.cong = is_congested;
avct_lcb_event(p_lcb, AVCT_LCB_LL_CONG_EVT, &avct_lcb_evt);
}
}
/*******************************************************************************
*
* Function avct_l2c_data_ind_cback
*
* Description This is the L2CAP data indication callback function.
*
*
* Returns void
*
******************************************************************************/
void avct_l2c_data_ind_cback(uint16_t lcid, BT_HDR* p_buf) {
tAVCT_LCB* p_lcb;
log::verbose("avct_l2c_data_ind_cback: 0x{:x}", lcid);
/* look up lcb for this channel */
p_lcb = avct_lcb_by_lcid(lcid);
if (p_lcb != NULL) {
avct_lcb_event(p_lcb, AVCT_LCB_LL_MSG_EVT, (tAVCT_LCB_EVT*)&p_buf);
} else /* prevent buffer leak */
{
log::warn("ERROR -> avct_l2c_data_ind_cback drop buffer");
osi_free(p_buf);
}
}