328 lines
12 KiB
C++
328 lines
12 KiB
C++
/******************************************************************************
|
|
*
|
|
* Copyright (C) 2009-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 is the implementation file for the MCAP Control channel state
|
|
* machine.
|
|
*
|
|
******************************************************************************/
|
|
#include <string.h>
|
|
|
|
#include "bt_target.h"
|
|
#include "btu.h"
|
|
#include "mca_api.h"
|
|
#include "mca_defs.h"
|
|
#include "mca_int.h"
|
|
|
|
/*****************************************************************************
|
|
* data channel state machine constants and types
|
|
****************************************************************************/
|
|
enum {
|
|
MCA_CCB_FREE_MSG,
|
|
MCA_CCB_SND_REQ,
|
|
MCA_CCB_SND_RSP,
|
|
MCA_CCB_DO_DISCONN,
|
|
MCA_CCB_CONG,
|
|
MCA_CCB_HDL_REQ,
|
|
MCA_CCB_HDL_RSP,
|
|
MCA_CCB_LL_OPEN,
|
|
MCA_CCB_DL_OPEN,
|
|
MCA_CCB_DEALLOC,
|
|
MCA_CCB_RSP_TOUT,
|
|
MCA_CCB_NUM_ACTIONS
|
|
};
|
|
#define MCA_CCB_IGNORE MCA_CCB_NUM_ACTIONS
|
|
|
|
/* action function list */
|
|
const tMCA_CCB_ACTION mca_ccb_action[] = {
|
|
mca_ccb_free_msg, mca_ccb_snd_req, mca_ccb_snd_rsp, mca_ccb_do_disconn,
|
|
mca_ccb_cong, mca_ccb_hdl_req, mca_ccb_hdl_rsp, mca_ccb_ll_open,
|
|
mca_ccb_dl_open, mca_ccb_dealloc, mca_ccb_rsp_tout,
|
|
};
|
|
|
|
/* state table information */
|
|
#define MCA_CCB_ACTIONS 1 /* number of actions */
|
|
#define MCA_CCB_ACT_COL 0 /* position of action function */
|
|
#define MCA_CCB_NEXT_STATE 1 /* position of next state */
|
|
#define MCA_CCB_NUM_COLS 2 /* number of columns in state tables */
|
|
|
|
/* state table for opening state */
|
|
const uint8_t mca_ccb_st_opening[][MCA_CCB_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* MCA_CCB_API_CONNECT_EVT */ {MCA_CCB_IGNORE, MCA_CCB_OPENING_ST},
|
|
/* MCA_CCB_API_DISCONNECT_EVT */ {MCA_CCB_DO_DISCONN, MCA_CCB_CLOSING_ST},
|
|
/* MCA_CCB_API_REQ_EVT */ {MCA_CCB_FREE_MSG, MCA_CCB_OPENING_ST},
|
|
/* MCA_CCB_API_RSP_EVT */ {MCA_CCB_IGNORE, MCA_CCB_OPENING_ST},
|
|
/* MCA_CCB_MSG_REQ_EVT */ {MCA_CCB_FREE_MSG, MCA_CCB_OPENING_ST},
|
|
/* MCA_CCB_MSG_RSP_EVT */ {MCA_CCB_FREE_MSG, MCA_CCB_OPENING_ST},
|
|
/* MCA_CCB_DL_OPEN_EVT */ {MCA_CCB_IGNORE, MCA_CCB_OPENING_ST},
|
|
/* MCA_CCB_LL_OPEN_EVT */ {MCA_CCB_LL_OPEN, MCA_CCB_OPEN_ST},
|
|
/* MCA_CCB_LL_CLOSE_EVT */ {MCA_CCB_DEALLOC, MCA_CCB_NULL_ST},
|
|
/* MCA_CCB_LL_CONG_EVT */ {MCA_CCB_CONG, MCA_CCB_OPENING_ST},
|
|
/* MCA_CCB_RSP_TOUT_EVT */ {MCA_CCB_IGNORE, MCA_CCB_OPENING_ST}};
|
|
|
|
/* state table for open state */
|
|
const uint8_t mca_ccb_st_open[][MCA_CCB_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* MCA_CCB_API_CONNECT_EVT */ {MCA_CCB_IGNORE, MCA_CCB_OPEN_ST},
|
|
/* MCA_CCB_API_DISCONNECT_EVT */ {MCA_CCB_DO_DISCONN, MCA_CCB_CLOSING_ST},
|
|
/* MCA_CCB_API_REQ_EVT */ {MCA_CCB_SND_REQ, MCA_CCB_OPEN_ST},
|
|
/* MCA_CCB_API_RSP_EVT */ {MCA_CCB_SND_RSP, MCA_CCB_OPEN_ST},
|
|
/* MCA_CCB_MSG_REQ_EVT */ {MCA_CCB_HDL_REQ, MCA_CCB_OPEN_ST},
|
|
/* MCA_CCB_MSG_RSP_EVT */ {MCA_CCB_HDL_RSP, MCA_CCB_OPEN_ST},
|
|
/* MCA_CCB_DL_OPEN_EVT */ {MCA_CCB_DL_OPEN, MCA_CCB_OPEN_ST},
|
|
/* MCA_CCB_LL_OPEN_EVT */ {MCA_CCB_IGNORE, MCA_CCB_OPEN_ST},
|
|
/* MCA_CCB_LL_CLOSE_EVT */ {MCA_CCB_DEALLOC, MCA_CCB_NULL_ST},
|
|
/* MCA_CCB_LL_CONG_EVT */ {MCA_CCB_CONG, MCA_CCB_OPEN_ST},
|
|
/* MCA_CCB_RSP_TOUT_EVT */ {MCA_CCB_RSP_TOUT, MCA_CCB_OPEN_ST}};
|
|
|
|
/* state table for closing state */
|
|
const uint8_t mca_ccb_st_closing[][MCA_CCB_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* MCA_CCB_API_CONNECT_EVT */ {MCA_CCB_IGNORE, MCA_CCB_CLOSING_ST},
|
|
/* MCA_CCB_API_DISCONNECT_EVT */ {MCA_CCB_IGNORE, MCA_CCB_CLOSING_ST},
|
|
/* MCA_CCB_API_REQ_EVT */ {MCA_CCB_FREE_MSG, MCA_CCB_CLOSING_ST},
|
|
/* MCA_CCB_API_RSP_EVT */ {MCA_CCB_IGNORE, MCA_CCB_CLOSING_ST},
|
|
/* MCA_CCB_MSG_REQ_EVT */ {MCA_CCB_FREE_MSG, MCA_CCB_CLOSING_ST},
|
|
/* MCA_CCB_MSG_RSP_EVT */ {MCA_CCB_FREE_MSG, MCA_CCB_CLOSING_ST},
|
|
/* MCA_CCB_DL_OPEN_EVT */ {MCA_CCB_IGNORE, MCA_CCB_CLOSING_ST},
|
|
/* MCA_CCB_LL_OPEN_EVT */ {MCA_CCB_IGNORE, MCA_CCB_CLOSING_ST},
|
|
/* MCA_CCB_LL_CLOSE_EVT */ {MCA_CCB_DEALLOC, MCA_CCB_NULL_ST},
|
|
/* MCA_CCB_LL_CONG_EVT */ {MCA_CCB_IGNORE, MCA_CCB_CLOSING_ST},
|
|
/* MCA_CCB_RSP_TOUT_EVT */ {MCA_CCB_IGNORE, MCA_CCB_CLOSING_ST}};
|
|
|
|
/* type for state table */
|
|
typedef const uint8_t (*tMCA_CCB_ST_TBL)[MCA_CCB_NUM_COLS];
|
|
|
|
/* state table */
|
|
const tMCA_CCB_ST_TBL mca_ccb_st_tbl[] = {mca_ccb_st_opening, mca_ccb_st_open,
|
|
mca_ccb_st_closing};
|
|
|
|
/* verbose event strings for trace */
|
|
static const char* const mca_ccb_evt_str[] = {
|
|
"API_CONNECT_EVT", "API_DISCONNECT_EVT", "API_REQ_EVT", "API_RSP_EVT",
|
|
"MSG_REQ_EVT", "MSG_RSP_EVT", "DL_OPEN_EVT", "LL_OPEN_EVT",
|
|
"LL_CLOSE_EVT", "LL_CONG_EVT", "RSP_TOUT_EVT"};
|
|
/* verbose state strings for trace */
|
|
static const char* const mca_ccb_st_str[] = {"NULL_ST", "OPENING_ST", "OPEN_ST",
|
|
"CLOSING_ST"};
|
|
|
|
/*******************************************************************************
|
|
*
|
|
* Function mca_stop_timer
|
|
*
|
|
* Description This function is stop a MCAP timer
|
|
*
|
|
* This function is for use internal to MCAP only.
|
|
*
|
|
* Returns void
|
|
*
|
|
******************************************************************************/
|
|
void mca_stop_timer(tMCA_CCB* p_ccb) { alarm_cancel(p_ccb->mca_ccb_timer); }
|
|
|
|
/*******************************************************************************
|
|
*
|
|
* Function mca_ccb_event
|
|
*
|
|
* Description This function is the CCB state machine main function.
|
|
* It uses the state and action function tables to execute
|
|
* action functions.
|
|
*
|
|
* Returns void.
|
|
*
|
|
******************************************************************************/
|
|
void mca_ccb_event(tMCA_CCB* p_ccb, uint8_t event, tMCA_CCB_EVT* p_data) {
|
|
tMCA_CCB_ST_TBL state_table;
|
|
uint8_t action;
|
|
|
|
MCA_TRACE_EVENT("CCB ccb=%d event=%s state=%s", mca_ccb_to_hdl(p_ccb),
|
|
mca_ccb_evt_str[event], mca_ccb_st_str[p_ccb->state]);
|
|
|
|
/* look up the state table for the current state */
|
|
state_table = mca_ccb_st_tbl[p_ccb->state - 1];
|
|
|
|
/* set next state */
|
|
p_ccb->state = state_table[event][MCA_CCB_NEXT_STATE];
|
|
|
|
/* execute action functions */
|
|
action = state_table[event][MCA_CCB_ACT_COL];
|
|
if (action != MCA_CCB_IGNORE) {
|
|
(*mca_ccb_action[action])(p_ccb, p_data);
|
|
}
|
|
}
|
|
|
|
/*******************************************************************************
|
|
*
|
|
* Function mca_ccb_by_bd
|
|
*
|
|
* Description This function looks up the CCB based on the BD address.
|
|
* It returns a pointer to the CCB.
|
|
* If no CCB is found it returns NULL.
|
|
*
|
|
* Returns void.
|
|
*
|
|
******************************************************************************/
|
|
tMCA_CCB* mca_ccb_by_bd(tMCA_HANDLE handle, const RawAddress& bd_addr) {
|
|
tMCA_CCB* p_ccb = NULL;
|
|
tMCA_RCB* p_rcb = mca_rcb_by_handle(handle);
|
|
tMCA_CCB* p_ccb_tmp;
|
|
int i;
|
|
|
|
if (p_rcb) {
|
|
i = handle - 1;
|
|
p_ccb_tmp = &mca_cb.ccb[i * MCA_NUM_LINKS];
|
|
for (i = 0; i < MCA_NUM_LINKS; i++, p_ccb_tmp++) {
|
|
if (p_ccb_tmp->state != MCA_CCB_NULL_ST &&
|
|
p_ccb_tmp->peer_addr == bd_addr) {
|
|
p_ccb = p_ccb_tmp;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
return p_ccb;
|
|
}
|
|
|
|
/*******************************************************************************
|
|
*
|
|
* Function mca_ccb_alloc
|
|
*
|
|
* Description This function allocates a CCB and copies the BD address to
|
|
* the CCB. It returns a pointer to the CCB. If no CCB can
|
|
* be allocated it returns NULL.
|
|
*
|
|
* Returns void.
|
|
*
|
|
******************************************************************************/
|
|
tMCA_CCB* mca_ccb_alloc(tMCA_HANDLE handle, const RawAddress& bd_addr) {
|
|
tMCA_CCB* p_ccb = NULL;
|
|
tMCA_RCB* p_rcb = mca_rcb_by_handle(handle);
|
|
tMCA_CCB* p_ccb_tmp;
|
|
int i;
|
|
|
|
MCA_TRACE_DEBUG("mca_ccb_alloc handle:0x%x", handle);
|
|
if (p_rcb) {
|
|
i = handle - 1;
|
|
p_ccb_tmp = &mca_cb.ccb[i * MCA_NUM_LINKS];
|
|
for (i = 0; i < MCA_NUM_LINKS; i++, p_ccb_tmp++) {
|
|
if (p_ccb_tmp->state == MCA_CCB_NULL_ST) {
|
|
p_ccb_tmp->p_rcb = p_rcb;
|
|
p_ccb_tmp->mca_ccb_timer = alarm_new("mca.mca_ccb_timer");
|
|
p_ccb_tmp->state = MCA_CCB_OPENING_ST;
|
|
p_ccb_tmp->cong = true;
|
|
p_ccb_tmp->peer_addr = bd_addr;
|
|
p_ccb = p_ccb_tmp;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
return p_ccb;
|
|
}
|
|
|
|
/*******************************************************************************
|
|
*
|
|
* Function mca_ccb_dealloc
|
|
*
|
|
* Description This function deallocates a CCB.
|
|
*
|
|
* Returns void.
|
|
*
|
|
******************************************************************************/
|
|
void mca_ccb_dealloc(tMCA_CCB* p_ccb, tMCA_CCB_EVT* p_data) {
|
|
tMCA_CTRL evt_data;
|
|
|
|
MCA_TRACE_DEBUG("mca_ccb_dealloc ctrl_vpsm:0x%x", p_ccb->ctrl_vpsm);
|
|
mca_dcb_close_by_mdl_id(p_ccb, MCA_ALL_MDL_ID);
|
|
if (p_ccb->ctrl_vpsm) {
|
|
L2CA_Deregister(p_ccb->ctrl_vpsm);
|
|
}
|
|
if (p_ccb->data_vpsm) {
|
|
L2CA_Deregister(p_ccb->data_vpsm);
|
|
}
|
|
osi_free_and_reset((void**)&p_ccb->p_rx_msg);
|
|
osi_free_and_reset((void**)&p_ccb->p_tx_req);
|
|
mca_stop_timer(p_ccb);
|
|
|
|
if (p_data) {
|
|
/* non-NULL -> an action function -> report disconnect event */
|
|
evt_data.disconnect_ind.bd_addr = p_ccb->peer_addr;
|
|
evt_data.disconnect_ind.reason = p_data->close.reason;
|
|
mca_ccb_report_event(p_ccb, MCA_DISCONNECT_IND_EVT, &evt_data);
|
|
}
|
|
mca_free_tc_tbl_by_lcid(p_ccb->lcid);
|
|
alarm_free(p_ccb->mca_ccb_timer);
|
|
memset(p_ccb, 0, sizeof(tMCA_CCB));
|
|
}
|
|
|
|
/*******************************************************************************
|
|
*
|
|
* Function mca_ccb_to_hdl
|
|
*
|
|
* Description This function converts a pointer to a CCB to a tMCA_CL
|
|
* and returns the value.
|
|
*
|
|
* Returns void.
|
|
*
|
|
******************************************************************************/
|
|
tMCA_CL mca_ccb_to_hdl(tMCA_CCB* p_ccb) {
|
|
return (uint8_t)(p_ccb - mca_cb.ccb + 1);
|
|
}
|
|
|
|
/*******************************************************************************
|
|
*
|
|
* Function mca_ccb_by_hdl
|
|
*
|
|
* Description This function converts an index value to a CCB. It returns
|
|
* a pointer to the CCB. If no valid CCB matches the index it
|
|
* returns NULL.
|
|
*
|
|
* Returns void.
|
|
*
|
|
******************************************************************************/
|
|
tMCA_CCB* mca_ccb_by_hdl(tMCA_CL mcl) {
|
|
tMCA_CCB* p_ccb = NULL;
|
|
if (mcl && mcl <= MCA_NUM_CCBS && mca_cb.ccb[mcl - 1].state)
|
|
p_ccb = &mca_cb.ccb[mcl - 1];
|
|
return p_ccb;
|
|
}
|
|
|
|
/*******************************************************************************
|
|
*
|
|
* Function mca_ccb_uses_mdl_id
|
|
*
|
|
* Description This function checkes if a given mdl_id is in use.
|
|
*
|
|
* Returns true, if the given mdl_id is currently used in the MCL.
|
|
*
|
|
******************************************************************************/
|
|
bool mca_ccb_uses_mdl_id(tMCA_CCB* p_ccb, uint16_t mdl_id) {
|
|
bool uses = false;
|
|
tMCA_DCB* p_dcb;
|
|
int i;
|
|
|
|
i = mca_ccb_to_hdl(p_ccb) - 1;
|
|
p_dcb = &mca_cb.dcb[i * MCA_NUM_MDLS];
|
|
for (i = 0; i < MCA_NUM_MDLS; i++, p_dcb++) {
|
|
if (p_dcb->state != MCA_DCB_NULL_ST && p_dcb->mdl_id == mdl_id) {
|
|
uses = true;
|
|
break;
|
|
}
|
|
}
|
|
|
|
return uses;
|
|
}
|