/*******************************************************************************
**
** Function avct_lcb_last_ccb
**
** Description See if given ccb is only one on the lcb.
**
**
** Returns TRUE if ccb is last, FALSE otherwise.
**
*******************************************************************************/
BOOLEAN avct_lcb_last_ccb(tAVCT_LCB *p_lcb, tAVCT_CCB *p_ccb_last)
{
tAVCT_CCB *p_ccb = &avct_cb.ccb[0];
int i;
AVCT_TRACE_WARNING("avct_lcb_last_ccb");
for (i = 0; i < AVCT_NUM_CONN; i++, p_ccb++) {
AVCT_TRACE_WARNING("%x: aloc:%d, lcb:%p/%p, ccb:%p/%p",
i, p_ccb->allocated, p_ccb->p_lcb, p_lcb, p_ccb, p_ccb_last);
if (p_ccb->allocated && (p_ccb->p_lcb == p_lcb) && (p_ccb != p_ccb_last)) {
return FALSE;
}
}
return TRUE;
}
/*******************************************************************************
**
** Function avct_ccb_by_idx
**
** Description Return ccb pointer based on ccb index (or handle).
**
**
** Returns pointer to the ccb, or NULL if none found.
**
*******************************************************************************/
tAVCT_CCB *avct_ccb_by_idx(UINT8 idx)
{
tAVCT_CCB *p_ccb;
/* verify index */
if (idx < AVCT_NUM_CONN) {
p_ccb = &avct_cb.ccb[idx];
/* verify ccb is allocated */
if (!p_ccb->allocated) {
p_ccb = NULL;
AVCT_TRACE_WARNING("ccb %d not allocated", idx);
}
} else {
p_ccb = NULL;
AVCT_TRACE_WARNING("No ccb for idx %d", idx);
}
return p_ccb;
}
/*******************************************************************************
**
** Function avct_l2c_data_ind_cback
**
** Description This is the L2CAP data indication callback function.
**
**
** Returns void
**
*******************************************************************************/
void avct_l2c_data_ind_cback(UINT16 lcid, BT_HDR *p_buf)
{
tAVCT_LCB *p_lcb;
AVCT_TRACE_DEBUG("avct_l2c_data_ind_cback: 0x%x", lcid);
/* look up lcb for this channel */
if ((p_lcb = avct_lcb_by_lcid(lcid)) != NULL) {
avct_lcb_event(p_lcb, AVCT_LCB_LL_MSG_EVT, (tAVCT_LCB_EVT *) &p_buf);
} else { /* prevent buffer leak */
AVCT_TRACE_WARNING("ERROR -> avct_l2c_data_ind_cback drop buffer");
osi_free(p_buf);
}
}
/*******************************************************************************
**
** Function avct_lcb_has_pid
**
** Description See if any ccbs on this lcb have a particular pid.
**
**
** Returns Pointer to CCB if PID found, NULL otherwise.
**
*******************************************************************************/
tAVCT_CCB *avct_lcb_has_pid(tAVCT_LCB *p_lcb, UINT16 pid)
{
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) && (p_ccb->cc.pid == pid))
{
AVCT_TRACE_DEBUG("avct_lcb_has_pid, found");
return p_ccb;
}
}
AVCT_TRACE_WARNING("avct_lcb_has_pid, not found");
return NULL;
}
/*******************************************************************************
**
** Function avct_lcb_by_lcid
**
** Description Find the LCB associated with the L2CAP LCID
**
**
** Returns pointer to the lcb, or NULL if none found.
**
*******************************************************************************/
tAVCT_LCB *avct_lcb_by_lcid(UINT16 lcid)
{
tAVCT_LCB *p_lcb = &avct_cb.lcb[0];
int i;
for (i = 0; i < AVCT_NUM_LINKS; i++, p_lcb++) {
if (p_lcb->allocated && ((p_lcb->ch_lcid == lcid) || (p_lcb->conflict_lcid == lcid))) {
break;
}
}
if (i == AVCT_NUM_LINKS) {
/* out of lcbs */
p_lcb = NULL;
AVCT_TRACE_WARNING("No lcb for lcid %x", lcid);
}
return p_lcb;
}
/*******************************************************************************
**
** Function avct_ccb_alloc
**
** Description Allocate a connection control block; copy parameters to ccb.
**
**
** Returns pointer to the ccb, or NULL if none could be allocated.
**
*******************************************************************************/
tAVCT_CCB *avct_ccb_alloc(tAVCT_CC *p_cc)
{
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->allocated = AVCT_ALOC_LCB;
memcpy(&p_ccb->cc, p_cc, sizeof(tAVCT_CC));
AVCT_TRACE_DEBUG("avct_ccb_alloc %d", i);
break;
}
}
if (i == AVCT_NUM_CONN) {
/* out of ccbs */
p_ccb = NULL;
AVCT_TRACE_WARNING("Out of ccbs");
}
return p_ccb;
}
tAVCT_BCB *avct_bcb_by_lcid(UINT16 lcid)
{
AVCT_TRACE_DEBUG("avct_bcb_by_lcid :=%x",lcid);
tAVCT_BCB *p_bcb = &avct_cb.bcb[0];
int i;
for (i = 0; i < AVCT_NUM_LINKS; i++, p_bcb++)
{
if (p_bcb->allocated && ((p_bcb->ch_lcid == lcid)))
{
AVCT_TRACE_DEBUG("avct_bcb_by_lcid :=%x",p_bcb->ch_lcid);
break;
}
}
if (i == AVCT_NUM_LINKS)
{
/*out of bcbs */
p_bcb = NULL;
AVCT_TRACE_WARNING("###No bcb for lcid %x", lcid);
}
return p_bcb;
}
/*******************************************************************************
**
** Function avct_lcb_alloc
**
** Description Allocate a link control block.
**
**
** Returns pointer to the lcb, or NULL if none could be allocated.
**
*******************************************************************************/
tAVCT_LCB *avct_lcb_alloc(BD_ADDR bd_addr)
{
tAVCT_LCB *p_lcb = &avct_cb.lcb[0];
int i;
for (i = 0; i < AVCT_NUM_LINKS; i++, p_lcb++) {
if (!p_lcb->allocated) {
p_lcb->allocated = (UINT8)(i + 1);
memcpy(p_lcb->peer_addr, bd_addr, BD_ADDR_LEN);
AVCT_TRACE_DEBUG("avct_lcb_alloc %d", p_lcb->allocated);
p_lcb->tx_q = fixed_queue_new(SIZE_MAX);
break;
}
}
if (i == AVCT_NUM_LINKS) {
/* out of lcbs */
p_lcb = NULL;
AVCT_TRACE_WARNING("Out of lcbs");
}
return p_lcb;
}
