diff options
Diffstat (limited to 'stack/mcap/mca_csm.c')
-rw-r--r-- | stack/mcap/mca_csm.c | 372 |
1 files changed, 372 insertions, 0 deletions
diff --git a/stack/mcap/mca_csm.c b/stack/mcap/mca_csm.c new file mode 100644 index 0000000..411ee6a --- /dev/null +++ b/stack/mcap/mca_csm.c @@ -0,0 +1,372 @@ +/***************************************************************************** +** +** Name: mca_csm.c +** +** Description: This is the implementation file for the MCAP +** Control channel state machine. +** +** Copyright (c) 2009-2011, Broadcom Corp., All Rights Reserved. +** Broadcom Bluetooth Core. Proprietary and confidential. +** +*****************************************************************************/ +#include <string.h> + +#include "bt_target.h" +#include "mca_api.h" +#include "mca_defs.h" +#include "mca_int.h" +#include "btu.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 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 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 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 (*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 +}; + +#if (BT_TRACE_VERBOSE == TRUE) +/* 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" +}; +#endif + +/******************************************************************************* +** +** 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) +{ + if (p_ccb->timer_entry.event == BTU_TTYPE_MCA_CCB_RSP) + { + btu_stop_timer(&p_ccb->timer_entry); + p_ccb->timer_entry.event = 0; + } +} + +/******************************************************************************* +** +** 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 event, tMCA_CCB_EVT *p_data) +{ + tMCA_CCB_ST_TBL state_table; + UINT8 action; + +#if (BT_TRACE_VERBOSE == TRUE) + MCA_TRACE_EVENT3("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]); +#else + MCA_TRACE_EVENT3("CCB ccb=%d event=%d state=%d", mca_ccb_to_hdl(p_ccb), event, p_ccb->state); +#endif + + /* 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 */ + if ((action = state_table[event][MCA_CCB_ACT_COL]) != 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, BD_ADDR 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 && memcmp(p_ccb_tmp->peer_addr, bd_addr, BD_ADDR_LEN) == 0) + { + 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, BD_ADDR 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_DEBUG1("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->state = MCA_CCB_OPENING_ST; + p_ccb_tmp->cong = TRUE; + memcpy(p_ccb_tmp->peer_addr, bd_addr, BD_ADDR_LEN); + 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_DEBUG1("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); + } + mca_free_buf ((void **)&p_ccb->p_rx_msg); + mca_free_buf ((void **)&p_ccb->p_tx_req); + mca_stop_timer(p_ccb); + + if (p_data) + { + /* non-NULL -> an action function -> report disconnect event */ + memcpy (evt_data.disconnect_ind.bd_addr, p_ccb->peer_addr, BD_ADDR_LEN); + 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); + 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) (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. +** +*******************************************************************************/ +BOOLEAN mca_ccb_uses_mdl_id(tMCA_CCB *p_ccb, UINT16 mdl_id) +{ + BOOLEAN 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; +} |