C++程序
|
3212行
|
110.22 KB
/******************************************************************************
*
* Copyright (C) 2004-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 action functions for advanced audio/video stream
* state machine. these functions are shared by both audio and video
* streams.
*
******************************************************************************/
#include "bt_target.h"
#if defined(BTA_AV_INCLUDED) && (BTA_AV_INCLUDED == TRUE)
#include <assert.h>
#include <string.h>
#include "avdt_api.h"
#include "bta_av_int.h"
#include "bt_utils.h"
#include "l2cdefs.h"
#include "l2c_api.h"
#include "osi/include/properties.h"
#include "utl.h"
#include "vendor.h"
#if( defined BTA_AR_INCLUDED ) && (BTA_AR_INCLUDED == TRUE)
#include "bta_ar_api.h"
#endif
/*****************************************************************************
** Constants
*****************************************************************************/
/* the delay time in milliseconds to start service discovery on AVRCP */
#ifndef BTA_AV_RC_DISC_TIME_VAL
#define BTA_AV_RC_DISC_TIME_VAL 3500
#endif
/* the timer in milliseconds to guard against link busy and AVDT_CloseReq failed to be sent */
#ifndef BTA_AV_CLOSE_REQ_TIME_VAL
#define BTA_AV_CLOSE_REQ_TIME_VAL 4000
#endif
/* number to retry on reconfigure failure - some headsets requirs this number to be more than 1 */
#ifndef BTA_AV_RECONFIG_RETRY
#define BTA_AV_RECONFIG_RETRY 6
#endif
/* ACL quota we are letting FW use for A2DP Offload Tx. */
#define BTA_AV_A2DP_OFFLOAD_XMIT_QUOTA 4
static void bta_av_st_rc_timer(tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data);
static const size_t SBC_MAX_BITPOOL_OFFSET = 6;
static const size_t SBC_MAX_BITPOOL = 53;
/* state machine states */
enum
{
BTA_AV_INIT_SST,
BTA_AV_INCOMING_SST,
BTA_AV_OPENING_SST,
BTA_AV_OPEN_SST,
BTA_AV_RCFG_SST,
BTA_AV_CLOSING_SST
};
/* the call out functions for audio stream */
const tBTA_AV_CO_FUNCTS bta_av_a2d_cos =
{
bta_av_co_audio_init,
bta_av_co_audio_disc_res,
bta_av_co_audio_getconfig,
bta_av_co_audio_setconfig,
bta_av_co_audio_open,
bta_av_co_audio_close,
bta_av_co_audio_start,
bta_av_co_audio_stop,
bta_av_co_audio_src_data_path,
bta_av_co_audio_delay
};
/* ssm action functions for audio stream */
const tBTA_AV_SACT bta_av_a2d_action[] =
{
bta_av_do_disc_a2d, /* BTA_AV_DO_DISC */
bta_av_cleanup, /* BTA_AV_CLEANUP */
bta_av_free_sdb, /* BTA_AV_FREE_SDB */
bta_av_config_ind, /* BTA_AV_CONFIG_IND */
bta_av_disconnect_req, /* BTA_AV_DISCONNECT_REQ */
bta_av_security_req, /* BTA_AV_SECURITY_REQ */
bta_av_security_rsp, /* BTA_AV_SECURITY_RSP */
bta_av_setconfig_rsp, /* BTA_AV_SETCONFIG_RSP */
bta_av_st_rc_timer, /* BTA_AV_ST_RC_TIMER */
bta_av_str_opened, /* BTA_AV_STR_OPENED */
bta_av_security_ind, /* BTA_AV_SECURITY_IND */
bta_av_security_cfm, /* BTA_AV_SECURITY_CFM */
bta_av_do_close, /* BTA_AV_DO_CLOSE */
bta_av_connect_req, /* BTA_AV_CONNECT_REQ */
bta_av_sdp_failed, /* BTA_AV_SDP_FAILED */
bta_av_disc_results, /* BTA_AV_DISC_RESULTS */
bta_av_disc_res_as_acp, /* BTA_AV_DISC_RES_AS_ACP */
bta_av_open_failed, /* BTA_AV_OPEN_FAILED */
bta_av_getcap_results, /* BTA_AV_GETCAP_RESULTS */
bta_av_setconfig_rej, /* BTA_AV_SETCONFIG_REJ */
bta_av_discover_req, /* BTA_AV_DISCOVER_REQ */
bta_av_conn_failed, /* BTA_AV_CONN_FAILED */
bta_av_do_start, /* BTA_AV_DO_START */
bta_av_str_stopped, /* BTA_AV_STR_STOPPED */
bta_av_reconfig, /* BTA_AV_RECONFIG */
bta_av_data_path, /* BTA_AV_DATA_PATH */
bta_av_start_ok, /* BTA_AV_START_OK */
bta_av_start_failed, /* BTA_AV_START_FAILED */
bta_av_str_closed, /* BTA_AV_STR_CLOSED */
bta_av_clr_cong, /* BTA_AV_CLR_CONG */
bta_av_suspend_cfm, /* BTA_AV_SUSPEND_CFM */
bta_av_rcfg_str_ok, /* BTA_AV_RCFG_STR_OK */
bta_av_rcfg_failed, /* BTA_AV_RCFG_FAILED */
bta_av_rcfg_connect, /* BTA_AV_RCFG_CONNECT */
bta_av_rcfg_discntd, /* BTA_AV_RCFG_DISCNTD */
bta_av_suspend_cont, /* BTA_AV_SUSPEND_CONT */
bta_av_rcfg_cfm, /* BTA_AV_RCFG_CFM */
bta_av_rcfg_open, /* BTA_AV_RCFG_OPEN */
bta_av_security_rej, /* BTA_AV_SECURITY_REJ */
bta_av_open_rc, /* BTA_AV_OPEN_RC */
bta_av_chk_2nd_start, /* BTA_AV_CHK_2ND_START */
bta_av_save_caps, /* BTA_AV_SAVE_CAPS */
bta_av_set_use_rc, /* BTA_AV_SET_USE_RC */
bta_av_cco_close, /* BTA_AV_CCO_CLOSE */
bta_av_switch_role, /* BTA_AV_SWITCH_ROLE */
bta_av_role_res, /* BTA_AV_ROLE_RES */
bta_av_delay_co, /* BTA_AV_DELAY_CO */
bta_av_open_at_inc, /* BTA_AV_OPEN_AT_INC */
bta_av_offload_req, /* BTA_AV_OFFLOAD_REQ */
bta_av_offload_rsp, /* BTA_AV_OFFLOAD_RSP */
NULL
};
/* these tables translate AVDT events to SSM events */
static const UINT16 bta_av_stream_evt_ok[] = {
BTA_AV_STR_DISC_OK_EVT, /* AVDT_DISCOVER_CFM_EVT */
BTA_AV_STR_GETCAP_OK_EVT, /* AVDT_GETCAP_CFM_EVT */
BTA_AV_STR_OPEN_OK_EVT, /* AVDT_OPEN_CFM_EVT */
BTA_AV_STR_OPEN_OK_EVT, /* AVDT_OPEN_IND_EVT */
BTA_AV_STR_CONFIG_IND_EVT, /* AVDT_CONFIG_IND_EVT */
BTA_AV_STR_START_OK_EVT, /* AVDT_START_CFM_EVT */
BTA_AV_STR_START_OK_EVT, /* AVDT_START_IND_EVT */
BTA_AV_STR_SUSPEND_CFM_EVT, /* AVDT_SUSPEND_CFM_EVT */
BTA_AV_STR_SUSPEND_CFM_EVT, /* AVDT_SUSPEND_IND_EVT */
BTA_AV_STR_CLOSE_EVT, /* AVDT_CLOSE_CFM_EVT */
BTA_AV_STR_CLOSE_EVT, /* AVDT_CLOSE_IND_EVT */
BTA_AV_STR_RECONFIG_CFM_EVT, /* AVDT_RECONFIG_CFM_EVT */
0, /* AVDT_RECONFIG_IND_EVT */
BTA_AV_STR_SECURITY_CFM_EVT, /* AVDT_SECURITY_CFM_EVT */
BTA_AV_STR_SECURITY_IND_EVT, /* AVDT_SECURITY_IND_EVT */
BTA_AV_STR_WRITE_CFM_EVT, /* AVDT_WRITE_CFM_EVT */
BTA_AV_AVDT_CONNECT_EVT, /* AVDT_CONNECT_IND_EVT */
BTA_AV_AVDT_DISCONNECT_EVT, /* AVDT_DISCONNECT_IND_EVT */
#if (AVDT_REPORTING == TRUE)
BTA_AV_AVDT_RPT_CONN_EVT, /* AVDT_REPORT_CONN_EVT */
BTA_AV_AVDT_RPT_CONN_EVT, /* AVDT_REPORT_DISCONN_EVT */
#endif
BTA_AV_AVDT_DELAY_RPT_EVT, /* AVDT_DELAY_REPORT_EVT */
0 /* AVDT_DELAY_REPORT_CFM_EVT */
};
static const UINT16 bta_av_stream_evt_fail[] = {
BTA_AV_STR_DISC_FAIL_EVT, /* AVDT_DISCOVER_CFM_EVT */
BTA_AV_STR_GETCAP_FAIL_EVT, /* AVDT_GETCAP_CFM_EVT */
BTA_AV_STR_OPEN_FAIL_EVT, /* AVDT_OPEN_CFM_EVT */
BTA_AV_STR_OPEN_OK_EVT, /* AVDT_OPEN_IND_EVT */
BTA_AV_STR_CONFIG_IND_EVT, /* AVDT_CONFIG_IND_EVT */
BTA_AV_STR_START_FAIL_EVT, /* AVDT_START_CFM_EVT */
BTA_AV_STR_START_OK_EVT, /* AVDT_START_IND_EVT */
BTA_AV_STR_SUSPEND_CFM_EVT, /* AVDT_SUSPEND_CFM_EVT */
BTA_AV_STR_SUSPEND_CFM_EVT, /* AVDT_SUSPEND_IND_EVT */
BTA_AV_STR_CLOSE_EVT, /* AVDT_CLOSE_CFM_EVT */
BTA_AV_STR_CLOSE_EVT, /* AVDT_CLOSE_IND_EVT */
BTA_AV_STR_RECONFIG_CFM_EVT, /* AVDT_RECONFIG_CFM_EVT */
0, /* AVDT_RECONFIG_IND_EVT */
BTA_AV_STR_SECURITY_CFM_EVT, /* AVDT_SECURITY_CFM_EVT */
BTA_AV_STR_SECURITY_IND_EVT, /* AVDT_SECURITY_IND_EVT */
BTA_AV_STR_WRITE_CFM_EVT, /* AVDT_WRITE_CFM_EVT */
BTA_AV_AVDT_CONNECT_EVT, /* AVDT_CONNECT_IND_EVT */
BTA_AV_AVDT_DISCONNECT_EVT, /* AVDT_DISCONNECT_IND_EVT */
#if (AVDT_REPORTING == TRUE)
BTA_AV_AVDT_RPT_CONN_EVT, /* AVDT_REPORT_CONN_EVT */
BTA_AV_AVDT_RPT_CONN_EVT, /* AVDT_REPORT_DISCONN_EVT */
#endif
BTA_AV_AVDT_DELAY_RPT_EVT, /* AVDT_DELAY_REPORT_EVT */
0 /* AVDT_DELAY_REPORT_CFM_EVT */
};
void bta_av_stream_data_cback(UINT8 handle, BT_HDR *p_pkt, UINT32 time_stamp, UINT8 m_pt);
static void bta_av_stream0_cback(UINT8 handle, BD_ADDR bd_addr, UINT8 event, tAVDT_CTRL *p_data);
static void bta_av_stream1_cback(UINT8 handle, BD_ADDR bd_addr, UINT8 event, tAVDT_CTRL *p_data);
#if BTA_AV_NUM_STRS > 2
static void bta_av_stream2_cback(UINT8 handle, BD_ADDR bd_addr, UINT8 event, tAVDT_CTRL *p_data);
#endif
#if BTA_AV_NUM_STRS > 3
static void bta_av_stream3_cback(UINT8 handle, BD_ADDR bd_addr, UINT8 event, tAVDT_CTRL *p_data);
#endif
#if BTA_AV_NUM_STRS > 4
static void bta_av_stream4_cback(UINT8 handle, BD_ADDR bd_addr, UINT8 event, tAVDT_CTRL *p_data);
#endif
#if BTA_AV_NUM_STRS > 5
static void bta_av_stream5_cback(UINT8 handle, BD_ADDR bd_addr, UINT8 event, tAVDT_CTRL *p_data);
#endif
/* the array of callback functions to receive events from AVDT control channel */
tAVDT_CTRL_CBACK * const bta_av_dt_cback[] =
{
bta_av_stream0_cback
,bta_av_stream1_cback
#if BTA_AV_NUM_STRS > 2
,bta_av_stream2_cback
#endif
#if BTA_AV_NUM_STRS > 3
,bta_av_stream3_cback
#endif
#if BTA_AV_NUM_STRS > 4
,bta_av_stream4_cback
#endif
#if BTA_AV_NUM_STRS > 5
,bta_av_stream5_cback
#endif
};
/***********************************************
**
** Function bta_get_scb_handle
**
** Description gives the registered AVDT handle.by checking with sep_type.
**
**
** Returns void
***********************************************/
static UINT8 bta_av_get_scb_handle(tBTA_AV_SCB *p_scb, UINT8 local_sep)
{
for (int i = 0; i < BTA_AV_MAX_SEPS; i++) {
if ((p_scb->seps[i].tsep == local_sep) &&
(p_scb->seps[i].codec_type == p_scb->codec_type))
return (p_scb->seps[i].av_handle);
}
APPL_TRACE_DEBUG(" bta_av_get_scb_handle appropiate sep_type not found")
return 0; /* return invalid handle */
}
/***********************************************
**
** Function bta_av_get_scb_sep_type
**
** Description gives the sep type by cross-checking with AVDT handle
**
**
** Returns void
***********************************************/
static UINT8 bta_av_get_scb_sep_type(tBTA_AV_SCB *p_scb, UINT8 tavdt_handle)
{
for (int i = 0; i < BTA_AV_MAX_SEPS; i++) {
if (p_scb->seps[i].av_handle == tavdt_handle)
return (p_scb->seps[i].tsep);
}
APPL_TRACE_DEBUG(" bta_av_get_scb_sep_type appropiate handle not found")
return 3; /* return invalid sep type */
}
/*******************************************************************************
**
** Function bta_av_save_addr
**
** Description copy the bd_addr and maybe reset the supported flags
**
**
** Returns void
**
*******************************************************************************/
static void bta_av_save_addr(tBTA_AV_SCB *p_scb, const BD_ADDR b)
{
APPL_TRACE_DEBUG("bta_av_save_addr r:%d, s:%d",
p_scb->recfg_sup, p_scb->suspend_sup);
if(bdcmp(p_scb->peer_addr, b) != 0)
{
APPL_TRACE_ERROR("reset flags");
/* a new addr, reset the supported flags */
p_scb->recfg_sup = TRUE;
p_scb->suspend_sup = TRUE;
}
/* do this copy anyway, just in case the first addr matches
* the control block one by accident */
bdcpy(p_scb->peer_addr, b);
}
/*******************************************************************************
**
** Function notify_start_failed
**
** Description notify up-layer AV start failed
**
**
** Returns void
**
*******************************************************************************/
static void notify_start_failed(tBTA_AV_SCB *p_scb)
{
tBTA_AV_START start;
/* if start failed, clear role */
p_scb->role &= ~BTA_AV_ROLE_START_INT;
start.chnl = p_scb->chnl;
start.status = BTA_AV_FAIL;
start.initiator = TRUE;
start.hndl = p_scb->hndl;
(*bta_av_cb.p_cback)(BTA_AV_START_EVT, (tBTA_AV *) &start);
}
/*******************************************************************************
**
** Function bta_av_st_rc_timer
**
** Description start the AVRC timer if no RC connection & CT is supported &
** RC is used or
** as ACP (we do not really know if we want AVRC)
**
** Returns void
**
*******************************************************************************/
static void bta_av_st_rc_timer(tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
UNUSED(p_data);
APPL_TRACE_DEBUG("bta_av_st_rc_timer rc_handle:%d, use_rc: %d",
p_scb->rc_handle, p_scb->use_rc);
/* for outgoing RC connection as INT/CT */
if ((p_scb->rc_handle == BTA_AV_RC_HANDLE_NONE) &&
/* (bta_av_cb.features & BTA_AV_FEAT_RCCT) && */
(p_scb->use_rc == TRUE || (p_scb->role & BTA_AV_ROLE_AD_ACP)))
{
if ((p_scb->wait & BTA_AV_WAIT_ROLE_SW_BITS) == 0) {
bta_sys_start_timer(p_scb->avrc_ct_timer, BTA_AV_RC_DISC_TIME_VAL,
BTA_AV_AVRC_TIMER_EVT, p_scb->hndl);
} else {
p_scb->wait |= BTA_AV_WAIT_CHECK_RC;
}
}
}
/*******************************************************************************
**
** Function bta_av_next_getcap
**
** Description The function gets the capabilities of the next available
** stream found in the discovery results.
**
** Returns TRUE if we sent request to AVDT, FALSE otherwise.
**
*******************************************************************************/
static BOOLEAN bta_av_next_getcap(tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
int i;
tAVDT_GETCAP_REQ *p_req;
BOOLEAN sent_cmd = FALSE;
UINT16 uuid_int = p_scb->uuid_int;
UINT8 sep_requested = 0;
if(uuid_int == UUID_SERVCLASS_AUDIO_SOURCE)
sep_requested = AVDT_TSEP_SNK;
else if(uuid_int == UUID_SERVCLASS_AUDIO_SINK)
sep_requested = AVDT_TSEP_SRC;
for (i = p_scb->sep_info_idx; i < p_scb->num_seps; i++)
{
/* steam not in use, is a sink, and is the right media type (audio/video) */
if ((p_scb->sep_info[i].in_use == FALSE) &&
(p_scb->sep_info[i].tsep == sep_requested) &&
(p_scb->sep_info[i].media_type == p_scb->media_type))
{
p_scb->sep_info_idx = i;
/* we got a stream; get its capabilities */
if (p_scb->p_cap == NULL)
p_scb->p_cap = (tAVDT_CFG *)osi_malloc(sizeof(tAVDT_CFG));
if (p_scb->avdt_version >= AVDT_VERSION_SYNC)
{
p_req = AVDT_GetAllCapReq;
}
else
{
p_req = AVDT_GetCapReq;
}
(*p_req)(p_scb->peer_addr,
p_scb->sep_info[i].seid,
p_scb->p_cap, bta_av_dt_cback[p_scb->hdi]);
sent_cmd = TRUE;
break;
}
}
/* if no streams available then stream open fails */
if (!sent_cmd)
{
bta_av_ssm_execute(p_scb, BTA_AV_STR_GETCAP_FAIL_EVT, p_data);
}
return sent_cmd;
}
/*******************************************************************************
**
** Function bta_av_proc_stream_evt
**
** Description Utility function to compose stream events.
**
** Returns void
**
*******************************************************************************/
static void bta_av_proc_stream_evt(UINT8 handle, BD_ADDR bd_addr, UINT8 event, tAVDT_CTRL *p_data, int index)
{
UINT16 sec_len = 0;
tBTA_AV_SCB *p_scb = bta_av_cb.p_scb[index];
if (p_data)
{
if (event == AVDT_SECURITY_IND_EVT)
{
sec_len = (p_data->security_ind.len < BTA_AV_SECURITY_MAX_LEN) ?
p_data->security_ind.len : BTA_AV_SECURITY_MAX_LEN;
}
else if (event == AVDT_SECURITY_CFM_EVT && p_data->hdr.err_code == 0)
{
sec_len = (p_data->security_cfm.len < BTA_AV_SECURITY_MAX_LEN) ?
p_data->security_cfm.len : BTA_AV_SECURITY_MAX_LEN;
}
}
if (p_scb) {
tBTA_AV_STR_MSG *p_msg =
(tBTA_AV_STR_MSG *)osi_malloc(sizeof(tBTA_AV_STR_MSG) + sec_len);
/* copy event data, bd addr, and handle to event message buffer */
p_msg->hdr.offset = 0;
if (bd_addr != NULL)
{
bdcpy(p_msg->bd_addr, bd_addr);
APPL_TRACE_DEBUG(" bd_addr:%02x-%02x-%02x-%02x-%02x-%02x",
bd_addr[0], bd_addr[1],
bd_addr[2], bd_addr[3],
bd_addr[4], bd_addr[5]);
}
if (p_data != NULL)
{
memcpy(&p_msg->msg, p_data, sizeof (tAVDT_CTRL));
/* copy config params to event message buffer */
switch (event)
{
case AVDT_RECONFIG_CFM_EVT:
APPL_TRACE_DEBUG("reconfig cfm event codec info = 0x%06x-%06x-%06x-%02x",
(p_msg->msg.reconfig_cfm.p_cfg->codec_info[0]<<16)+(p_msg->msg.reconfig_cfm.p_cfg->codec_info[1]<<8)+p_msg->msg.reconfig_cfm.p_cfg->codec_info[2],
(p_msg->msg.reconfig_cfm.p_cfg->codec_info[3]<<16)+(p_msg->msg.reconfig_cfm.p_cfg->codec_info[4]<<8)+p_msg->msg.reconfig_cfm.p_cfg->codec_info[5],
(p_msg->msg.reconfig_cfm.p_cfg->codec_info[6]<<16)+(p_msg->msg.reconfig_cfm.p_cfg->codec_info[7]<<8)+p_msg->msg.reconfig_cfm.p_cfg->codec_info[8],
p_msg->msg.reconfig_cfm.p_cfg->codec_info[9]);
break;
case AVDT_CONFIG_IND_EVT:
/* We might have 2 SEP signallings(A2DP + VDP) with one peer device on one L2CAP.
* If we already have a signalling connection with the bd_addr and the streaming
* SST is at INIT state, change it to INCOMING state to handle the signalling
* from the 2nd SEP. */
if ((bta_av_find_lcb(bd_addr, BTA_AV_LCB_FIND) != NULL) && (bta_av_is_scb_init(p_scb)))
{
bta_av_set_scb_sst_incoming (p_scb);
/* When ACP_CONNECT_EVT was received, we put first available scb to incoming state.
* Later when we receive AVDT_CONFIG_IND_EVT, we use a new p_scb and set its state to
* incoming which we do it above.
* We also have to set the old p_scb state to init to be used later */
for (int i = 0; i < BTA_AV_NUM_STRS; i++) {
if ((bta_av_cb.p_scb[i]) && (i != index)) {
if (bta_av_cb.p_scb[i]->state == BTA_AV_INCOMING_SST) {
bta_av_cb.p_scb[i]->state = BTA_AV_INIT_SST;
bta_av_cb.p_scb[i]->coll_mask = 0;
break;
}
}
}
}
memcpy(&p_msg->cfg, p_data->config_ind.p_cfg, sizeof(tAVDT_CFG));
break;
case AVDT_SECURITY_IND_EVT:
p_msg->msg.security_ind.p_data = (UINT8 *) (p_msg + 1);
memcpy(p_msg->msg.security_ind.p_data, p_data->security_ind.p_data, sec_len);
break;
case AVDT_SECURITY_CFM_EVT:
p_msg->msg.security_cfm.p_data = (UINT8 *) (p_msg + 1);
if (p_data->hdr.err_code == 0)
{
memcpy(p_msg->msg.security_cfm.p_data, p_data->security_cfm.p_data, sec_len);
}
break;
case AVDT_SUSPEND_IND_EVT:
p_msg->msg.hdr.err_code = 0;
break;
default:
break;
}
}
else
p_msg->msg.hdr.err_code = 0;
/* look up application event */
if ((p_data == NULL) || (p_data->hdr.err_code == 0))
{
p_msg->hdr.event = bta_av_stream_evt_ok[event];
}
else
{
p_msg->hdr.event = bta_av_stream_evt_fail[event];
}
p_msg->initiator = FALSE;
if (event == AVDT_SUSPEND_CFM_EVT)
p_msg->initiator = TRUE;
APPL_TRACE_VERBOSE("hndl:x%x", p_scb->hndl);
p_msg->hdr.layer_specific = p_scb->hndl;
p_msg->handle = handle;
p_msg->avdt_event = event;
bta_sys_sendmsg(p_msg);
}
/* coverity[var_deref_model] */
/* false-positive: bta_av_conn_cback only processes AVDT_CONNECT_IND_EVT and AVDT_DISCONNECT_IND_EVT event
* these 2 events always have associated p_data */
if (p_data)
{
bta_av_conn_cback(handle, bd_addr, event, p_data);
}
else
{
APPL_TRACE_ERROR("%s: p_data is null", __func__);
}
}
/*******************************************************************************
**
** Function bta_av_stream_data_cback
**
** Description This is the AVDTP callback function for stream events.
**
** Returns void
**
*******************************************************************************/
void bta_av_stream_data_cback(UINT8 handle, BT_HDR *p_pkt, UINT32 time_stamp, UINT8 m_pt)
{
int index = 0;
tBTA_AV_SCB *p_scb ;
APPL_TRACE_DEBUG("bta_av_stream_data_cback avdt_handle: %d pkt_len=0x%x ofst = 0x%x", handle,p_pkt->len,p_pkt->offset);
APPL_TRACE_DEBUG(" Number of frames 0x%x",*((UINT8*)(p_pkt + 1) + p_pkt->offset));
APPL_TRACE_DEBUG("Sequence Number 0x%x",p_pkt->layer_specific);
/* Get SCB and correct sep type*/
for(index = 0; index < BTA_AV_NUM_STRS;index ++ )
{
p_scb = bta_av_cb.p_scb[index];
if((p_scb->avdt_handle == handle)&&(p_scb->seps[p_scb->sep_idx].tsep == AVDT_TSEP_SNK))
break;
}
if(index == BTA_AV_NUM_STRS) /* cannot find correct handler */
{
osi_free(p_pkt);
return;
}
p_pkt->event = BTA_AV_MEDIA_DATA_EVT;
p_scb->seps[p_scb->sep_idx].p_app_data_cback(BTA_AV_MEDIA_DATA_EVT, (tBTA_AV_MEDIA*)p_pkt);
osi_free(p_pkt); /* a copy of packet had been delivered, we free this buffer */
}
/*******************************************************************************
**
** Function bta_av_stream0_cback
**
** Description This is the AVDTP callback function for stream events.
**
** Returns void
**
*******************************************************************************/
static void bta_av_stream0_cback(UINT8 handle, BD_ADDR bd_addr, UINT8 event, tAVDT_CTRL *p_data)
{
APPL_TRACE_VERBOSE("bta_av_stream0_cback avdt_handle: %d event=0x%x", handle, event);
bta_av_proc_stream_evt(handle, bd_addr, event, p_data, 0);
}
/*******************************************************************************
**
** Function bta_av_stream1_cback
**
** Description This is the AVDTP callback function for stream events.
**
** Returns void
**
*******************************************************************************/
static void bta_av_stream1_cback(UINT8 handle, BD_ADDR bd_addr, UINT8 event, tAVDT_CTRL *p_data)
{
APPL_TRACE_EVENT("bta_av_stream1_cback avdt_handle: %d event=0x%x", handle, event);
bta_av_proc_stream_evt(handle, bd_addr, event, p_data, 1);
}
#if BTA_AV_NUM_STRS > 2
/*******************************************************************************
**
** Function bta_av_stream2_cback
**
** Description This is the AVDTP callback function for stream events.
**
** Returns void
**
*******************************************************************************/
static void bta_av_stream2_cback(UINT8 handle, BD_ADDR bd_addr, UINT8 event, tAVDT_CTRL *p_data)
{
APPL_TRACE_EVENT("bta_av_stream2_cback avdt_handle: %d event=0x%x", handle, event);
bta_av_proc_stream_evt(handle, bd_addr, event, p_data, 2);
}
#endif
#if BTA_AV_NUM_STRS > 3
/*******************************************************************************
**
** Function bta_av_stream3_cback
**
** Description This is the AVDTP callback function for stream events.
**
** Returns void
**
*******************************************************************************/
static void bta_av_stream3_cback(UINT8 handle, BD_ADDR bd_addr, UINT8 event, tAVDT_CTRL *p_data)
{
APPL_TRACE_EVENT("bta_av_stream3_cback avdt_handle: %d event=0x%x", handle, event);
bta_av_proc_stream_evt(handle, bd_addr, event, p_data, 3);
}
#endif
/*******************************************************************************
**
** Function bta_av_stream4_cback
**
** Description This is the AVDTP callback function for stream events.
**
** Returns void
**
*******************************************************************************/
#if BTA_AV_NUM_STRS > 4
static void bta_av_stream4_cback(UINT8 handle, BD_ADDR bd_addr, UINT8 event, tAVDT_CTRL *p_data)
{
APPL_TRACE_EVENT("bta_av_stream4_cback avdt_handle: %d event=0x%x", handle, event);
bta_av_proc_stream_evt(handle, bd_addr, event, p_data, 4);
}
#endif
/*******************************************************************************
**
** Function bta_av_stream5_cback
**
** Description This is the AVDTP callback function for stream events.
**
** Returns void
**
*******************************************************************************/
#if BTA_AV_NUM_STRS > 5
static void bta_av_stream5_cback(UINT8 handle, BD_ADDR bd_addr, UINT8 event, tAVDT_CTRL *p_data)
{
APPL_TRACE_EVENT("bta_av_stream5_cback avdt_handle: %d event=0x%x", handle, event);
bta_av_proc_stream_evt(handle, bd_addr, event, p_data, 5);
}
#endif
/*******************************************************************************
**
** Function bta_av_a2d_sdp_cback
**
** Description A2DP service discovery callback.
**
** Returns void
**
*******************************************************************************/
static void bta_av_a2d_sdp_cback(BOOLEAN found, tA2D_Service *p_service)
{
tBTA_AV_SCB *p_scb = bta_av_hndl_to_scb(bta_av_cb.handle);
if (p_scb == NULL) {
APPL_TRACE_ERROR("%s, no scb found for handle(0x%x)", __func__,
bta_av_cb.handle);
return;
}
tBTA_AV_SDP_RES *p_msg =
(tBTA_AV_SDP_RES *)osi_malloc(sizeof(tBTA_AV_SDP_RES));
p_msg->hdr.event = (found) ?
BTA_AV_SDP_DISC_OK_EVT : BTA_AV_SDP_DISC_FAIL_EVT;
if (found && (p_service != NULL))
p_scb->avdt_version = p_service->avdt_version;
else
p_scb->avdt_version = 0x00;
p_msg->hdr.layer_specific = bta_av_cb.handle;
bta_sys_sendmsg(p_msg);
}
/*******************************************************************************
**
** Function bta_av_adjust_seps_idx
**
** Description adjust the sep_idx
**
** Returns
**
*******************************************************************************/
static void bta_av_adjust_seps_idx(tBTA_AV_SCB *p_scb, UINT8 avdt_handle)
{
APPL_TRACE_DEBUG("bta_av_adjust_seps_idx codec_type: %d", p_scb->codec_type);
for (int i = 0; i < BTA_AV_MAX_SEPS; i++) {
APPL_TRACE_DEBUG("av_handle: %d codec_type: %d",
p_scb->seps[i].av_handle, p_scb->seps[i].codec_type);
if((p_scb->seps[i].av_handle && p_scb->codec_type == p_scb->seps[i].codec_type)
&& (p_scb->seps[i].av_handle == avdt_handle))
{
p_scb->sep_idx = i;
p_scb->avdt_handle = p_scb->seps[i].av_handle;
break;
}
}
}
/*******************************************************************************
**
** Function bta_av_switch_role
**
** Description Switch role was not started and a timer was started.
** another attempt to switch role now - still opening.
**
** Returns void
**
*******************************************************************************/
void bta_av_switch_role (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
tBTA_AV_RS_RES switch_res = BTA_AV_RS_NONE;
tBTA_AV_API_OPEN *p_buf = &p_scb->q_info.open;
UNUSED(p_data);
APPL_TRACE_DEBUG("bta_av_switch_role wait:x%x", p_scb->wait);
if (p_scb->wait & BTA_AV_WAIT_ROLE_SW_RES_START)
p_scb->wait |= BTA_AV_WAIT_ROLE_SW_RETRY;
/* clear the masks set when the timer is started */
p_scb->wait &= ~(BTA_AV_WAIT_ROLE_SW_RES_OPEN|BTA_AV_WAIT_ROLE_SW_RES_START);
if (p_scb->q_tag == BTA_AV_Q_TAG_OPEN)
{
if (bta_av_switch_if_needed(p_scb) || !bta_av_link_role_ok(p_scb, A2D_SET_MULTL_BIT))
{
p_scb->wait |= BTA_AV_WAIT_ROLE_SW_RES_OPEN;
}
else
{
/* this should not happen in theory. Just in case...
* continue to do_disc_a2d */
switch_res = BTA_AV_RS_DONE;
}
}
else
{
/* report failure on OPEN */
switch_res = BTA_AV_RS_FAIL;
}
if (switch_res != BTA_AV_RS_NONE)
{
if (bta_av_cb.rs_idx == (p_scb->hdi + 1))
{
bta_av_cb.rs_idx = 0;
}
p_scb->wait &= ~BTA_AV_WAIT_ROLE_SW_RETRY;
p_scb->q_tag = 0;
p_buf->switch_res = switch_res;
bta_av_do_disc_a2d(p_scb, (tBTA_AV_DATA *)p_buf);
}
}
/*******************************************************************************
**
** Function bta_av_role_res
**
** Description Handle the role changed event
**
**
** Returns void
**
*******************************************************************************/
void bta_av_role_res (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
BOOLEAN initiator = FALSE;
tBTA_AV_START start;
tBTA_AV_OPEN av_open;
APPL_TRACE_DEBUG("bta_av_role_res q_tag:%d, wait:x%x, role:x%x", p_scb->q_tag, p_scb->wait, p_scb->role);
if (p_scb->role & BTA_AV_ROLE_START_INT)
initiator = TRUE;
if (p_scb->q_tag == BTA_AV_Q_TAG_START)
{
if (p_scb->wait & BTA_AV_WAIT_ROLE_SW_STARTED)
{
p_scb->wait &= ~BTA_AV_WAIT_ROLE_SW_BITS;
if (p_data->role_res.hci_status != HCI_SUCCESS)
{
p_scb->role &= ~BTA_AV_ROLE_START_INT;
bta_sys_idle(BTA_ID_AV, bta_av_cb.audio_open_cnt, p_scb->peer_addr);
/* start failed because of role switch. */
start.chnl = p_scb->chnl;
start.status = BTA_AV_FAIL_ROLE;
start.hndl = p_scb->hndl;
start.initiator = initiator;
(*bta_av_cb.p_cback)(BTA_AV_START_EVT, (tBTA_AV *) &start);
}
else
{
bta_av_start_ok(p_scb, p_data);
}
}
else if (p_scb->wait & BTA_AV_WAIT_ROLE_SW_RES_START)
p_scb->wait |= BTA_AV_WAIT_ROLE_SW_FAILED;
}
else if (p_scb->q_tag == BTA_AV_Q_TAG_OPEN)
{
if (p_scb->wait & BTA_AV_WAIT_ROLE_SW_RES_OPEN)
{
p_scb->role &= ~BTA_AV_ROLE_START_INT;
p_scb->wait &= ~BTA_AV_WAIT_ROLE_SW_BITS;
if (p_data->role_res.hci_status != HCI_SUCCESS)
{
/* Open failed because of role switch. */
bdcpy(av_open.bd_addr, p_scb->peer_addr);
av_open.chnl = p_scb->chnl;
av_open.hndl = p_scb->hndl;
start.status = BTA_AV_FAIL_ROLE;
if(p_scb->seps[p_scb->sep_idx].tsep == AVDT_TSEP_SRC )
av_open.sep = AVDT_TSEP_SNK;
else if(p_scb->seps[p_scb->sep_idx].tsep == AVDT_TSEP_SNK )
av_open.sep = AVDT_TSEP_SRC;
(*bta_av_cb.p_cback)(BTA_AV_OPEN_EVT, (tBTA_AV *)&av_open);
}
else
{
/* Continue av open process */
p_scb->q_info.open.switch_res = BTA_AV_RS_DONE;
bta_av_do_disc_a2d (p_scb, (tBTA_AV_DATA *)&(p_scb->q_info.open));
}
}
else
{
APPL_TRACE_WARNING ("Unexpected role switch event: q_tag = %d wait = %d", p_scb->q_tag, p_scb->wait);
}
}
APPL_TRACE_DEBUG("wait:x%x, role:x%x", p_scb->wait, p_scb->role);
}
/*******************************************************************************
**
** Function bta_av_delay_co
**
** Description Call the delay call-out function to report the delay report
** from SNK
**
** Returns void
**
*******************************************************************************/
void bta_av_delay_co (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
p_scb->p_cos->delay(p_scb->hndl, p_data->str_msg.msg.delay_rpt_cmd.delay);
}
/*******************************************************************************
**
** Function bta_av_do_disc_a2d
**
** Description Do service discovery for A2DP.
**
** Returns void
**
*******************************************************************************/
void bta_av_do_disc_a2d (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
BOOLEAN ok_continue = FALSE;
tA2D_SDP_DB_PARAMS db_params;
UINT16 attr_list[] = {ATTR_ID_SERVICE_CLASS_ID_LIST,
ATTR_ID_PROTOCOL_DESC_LIST,
ATTR_ID_BT_PROFILE_DESC_LIST};
UINT16 sdp_uuid = 0; /* UUID for which SDP has to be done */
APPL_TRACE_DEBUG("bta_av_do_disc_a2d use_rc: %d rs:%d, oc:%d",
p_data->api_open.use_rc, p_data->api_open.switch_res, bta_av_cb.audio_open_cnt);
memcpy (&(p_scb->open_api), &(p_data->api_open), sizeof(tBTA_AV_API_OPEN));
switch(p_data->api_open.switch_res)
{
case BTA_AV_RS_NONE:
if (bta_av_switch_if_needed(p_scb) || !bta_av_link_role_ok(p_scb, A2D_SET_MULTL_BIT))
{
/* waiting for role switch result. save the api to control block */
memcpy(&p_scb->q_info.open, &p_data->api_open, sizeof(tBTA_AV_API_OPEN));
p_scb->wait |= BTA_AV_WAIT_ROLE_SW_RES_OPEN;
p_scb->q_tag = BTA_AV_Q_TAG_OPEN;
}
else
{
ok_continue = TRUE;
}
break;
case BTA_AV_RS_FAIL:
/* report a new failure event */
p_scb->open_status = BTA_AV_FAIL_ROLE;
bta_av_ssm_execute(p_scb, BTA_AV_SDP_DISC_FAIL_EVT, NULL);
break;
case BTA_AV_RS_OK:
p_data = (tBTA_AV_DATA *)&p_scb->q_info.open;
/* continue to open if link role is ok */
if (bta_av_link_role_ok(p_scb, A2D_SET_MULTL_BIT))
{
ok_continue = TRUE;
}
else
{
p_scb->wait |= BTA_AV_WAIT_ROLE_SW_RES_OPEN;
}
break;
case BTA_AV_RS_DONE:
ok_continue = TRUE;
break;
}
APPL_TRACE_DEBUG("ok_continue: %d wait:x%x, q_tag: %d", ok_continue, p_scb->wait, p_scb->q_tag);
if (!ok_continue)
return;
/* clear the role switch bits */
p_scb->wait &= ~BTA_AV_WAIT_ROLE_SW_BITS;
if (p_scb->wait & BTA_AV_WAIT_CHECK_RC)
{
p_scb->wait &= ~BTA_AV_WAIT_CHECK_RC;
bta_sys_start_timer(p_scb->avrc_ct_timer, BTA_AV_RC_DISC_TIME_VAL,
BTA_AV_AVRC_TIMER_EVT, p_scb->hndl);
}
if (bta_av_cb.features & BTA_AV_FEAT_MASTER)
{
L2CA_SetDesireRole(L2CAP_ROLE_DISALLOW_SWITCH);
if (bta_av_cb.audio_open_cnt == 1)
{
/* there's already an A2DP connection. do not allow switch */
bta_sys_clear_default_policy(BTA_ID_AV, HCI_ENABLE_MASTER_SLAVE_SWITCH);
}
}
/* store peer addr other parameters */
bta_av_save_addr(p_scb, p_data->api_open.bd_addr);
p_scb->sec_mask = p_data->api_open.sec_mask;
p_scb->use_rc = p_data->api_open.use_rc;
bta_sys_app_open(BTA_ID_AV, p_scb->app_id, p_scb->peer_addr);
if (p_scb->skip_sdp == TRUE)
{
tA2D_Service a2d_ser;
a2d_ser.avdt_version = AVDT_VERSION;
p_scb->skip_sdp = FALSE;
p_scb->uuid_int = p_data->api_open.uuid;
/* only one A2D find service is active at a time */
bta_av_cb.handle = p_scb->hndl;
APPL_TRACE_WARNING("%s: Skip Sdp for incoming A2dp connection", __func__);
bta_av_a2d_sdp_cback(TRUE, &a2d_ser);
return;
}
/* only one A2D find service is active at a time */
bta_av_cb.handle = p_scb->hndl;
/* set up parameters */
db_params.db_len = BTA_AV_DISC_BUF_SIZE;
db_params.num_attr = 3;
db_params.p_attrs = attr_list;
p_scb->uuid_int = p_data->api_open.uuid;
p_scb->sdp_discovery_started = TRUE;
if (p_scb->uuid_int == UUID_SERVCLASS_AUDIO_SINK)
sdp_uuid = UUID_SERVCLASS_AUDIO_SOURCE;
else if (p_scb->uuid_int == UUID_SERVCLASS_AUDIO_SOURCE)
sdp_uuid = UUID_SERVCLASS_AUDIO_SINK;
APPL_TRACE_DEBUG("%s: uuid_int 0x%x, Doing SDP For 0x%x", __func__,
p_scb->uuid_int, sdp_uuid);
if (A2D_FindService(sdp_uuid, p_scb->peer_addr, &db_params,
bta_av_a2d_sdp_cback) == A2D_SUCCESS)
return;
/* when the code reaches here, either the DB is NULL
* or A2D_FindService is not successful */
bta_av_a2d_sdp_cback(FALSE, NULL);
}
/*******************************************************************************
**
** Function bta_av_cleanup
**
** Description cleanup AV stream control block.
**
** Returns void
**
*******************************************************************************/
void bta_av_cleanup(tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
tBTA_AV_CONN_CHG msg;
UINT8 role = BTA_AV_ROLE_AD_INT;
UNUSED(p_data);
APPL_TRACE_DEBUG("bta_av_cleanup");
/* free any buffers */
osi_free_and_reset((void **)&p_scb->p_cap);
p_scb->sdp_discovery_started = FALSE;
p_scb->avdt_version = 0;
/* initialize some control block variables */
p_scb->open_status = BTA_AV_SUCCESS;
/* if de-registering shut everything down */
msg.hdr.layer_specific = p_scb->hndl;
p_scb->started = FALSE;
p_scb->cong = FALSE;
p_scb->role = role;
p_scb->cur_psc_mask = 0;
p_scb->wait = 0;
p_scb->num_disc_snks = 0;
alarm_cancel(p_scb->avrc_ct_timer);
vendor_get_interface()->send_command(
(vendor_opcode_t)BT_VND_OP_A2DP_OFFLOAD_STOP, (void*)&p_scb->l2c_cid);
if (p_scb->offload_start_pending) {
tBTA_AV_STATUS status = BTA_AV_FAIL_STREAM;
(*bta_av_cb.p_cback)(BTA_AV_OFFLOAD_START_RSP_EVT, (tBTA_AV *)&status);
}
p_scb->offload_start_pending = FALSE;
p_scb->skip_sdp = FALSE;
if (p_scb->deregistring)
{
/* remove stream */
for (int i = 0; i < BTA_AV_MAX_SEPS; i++) {
if (p_scb->seps[i].av_handle)
AVDT_RemoveStream(p_scb->seps[i].av_handle);
p_scb->seps[i].av_handle = 0;
}
bta_av_dereg_comp((tBTA_AV_DATA *) &msg);
}
else
{
/* report stream closed to main SM */
msg.is_up = FALSE;
bdcpy(msg.peer_addr, p_scb->peer_addr);
bta_av_conn_chg((tBTA_AV_DATA *) &msg);
}
}
/*******************************************************************************
**
** Function bta_av_free_sdb
**
** Description Free service discovery db buffer.
**
** Returns void
**
*******************************************************************************/
void bta_av_free_sdb(tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
UNUSED(p_data);
p_scb->sdp_discovery_started = FALSE;
}
/*******************************************************************************
**
** Function bta_av_config_ind
**
** Description Handle a stream configuration indication from the peer.
**
** Returns void
**
*******************************************************************************/
void bta_av_config_ind (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
tBTA_AV_CI_SETCONFIG setconfig;
tAVDT_SEP_INFO *p_info;
tAVDT_CFG *p_evt_cfg = &p_data->str_msg.cfg;
UINT8 psc_mask = (p_evt_cfg->psc_mask | p_scb->cfg.psc_mask);
UINT8 local_sep; /* sep type of local handle on which connection was received */
tBTA_AV_STR_MSG *p_msg = (tBTA_AV_STR_MSG *)p_data;
UNUSED(p_data);
local_sep = bta_av_get_scb_sep_type(p_scb, p_msg->handle);
p_scb->avdt_label = p_data->str_msg.msg.hdr.label;
memcpy(p_scb->cfg.codec_info, p_evt_cfg->codec_info, AVDT_CODEC_SIZE);
p_scb->codec_type = p_evt_cfg->codec_info[BTA_AV_CODEC_TYPE_IDX];
bta_av_save_addr(p_scb, p_data->str_msg.bd_addr);
/* Clear collision mask */
p_scb->coll_mask = 0;
alarm_cancel(bta_av_cb.accept_signalling_timer);
/* if no codec parameters in configuration, fail */
if ((p_evt_cfg->num_codec == 0) ||
/* or the peer requests for a service we do not support */
((psc_mask != p_scb->cfg.psc_mask) &&
(psc_mask != (p_scb->cfg.psc_mask&~AVDT_PSC_DELAY_RPT))) )
{
setconfig.hndl = p_scb->hndl; /* we may not need this */
setconfig.err_code = AVDT_ERR_UNSUP_CFG;
bta_av_ssm_execute(p_scb, BTA_AV_CI_SETCONFIG_FAIL_EVT, (tBTA_AV_DATA *) &setconfig);
}
else
{
p_info = &p_scb->sep_info[0];
p_info->in_use = 0;
p_info->media_type = p_scb->media_type;
p_info->seid = p_data->str_msg.msg.config_ind.int_seid;
/* Sep type of Peer will be oppsite role to our local sep */
if (local_sep == AVDT_TSEP_SRC)
p_info->tsep = AVDT_TSEP_SNK;
else if (local_sep == AVDT_TSEP_SNK)
p_info->tsep = AVDT_TSEP_SRC;
p_scb->role |= BTA_AV_ROLE_AD_ACP;
p_scb->cur_psc_mask = p_evt_cfg->psc_mask;
if (bta_av_cb.features & BTA_AV_FEAT_RCTG)
p_scb->use_rc = TRUE;
else
p_scb->use_rc = FALSE;
p_scb->num_seps = 1;
p_scb->sep_info_idx = 0;
APPL_TRACE_DEBUG("bta_av_config_ind: SEID: %d use_rc: %d cur_psc_mask:0x%x", p_info->seid, p_scb->use_rc, p_scb->cur_psc_mask);
/* in case of A2DP SINK this is the first time peer data is being sent to co functions */
if (local_sep == AVDT_TSEP_SNK)
{
p_scb->p_cos->setcfg(p_scb->hndl, p_scb->codec_type,
p_evt_cfg->codec_info,
p_info->seid,
p_scb->peer_addr,
p_evt_cfg->num_protect,
p_evt_cfg->protect_info,
AVDT_TSEP_SNK,
p_msg->handle);
}
else
{
p_scb->p_cos->setcfg(p_scb->hndl, p_scb->codec_type,
p_evt_cfg->codec_info,
p_info->seid,
p_scb->peer_addr,
p_evt_cfg->num_protect,
p_evt_cfg->protect_info,
AVDT_TSEP_SRC,
p_msg->handle);
}
}
}
/*******************************************************************************
**
** Function bta_av_disconnect_req
**
** Description Disconnect AVDTP connection.
**
** Returns void
**
*******************************************************************************/
void bta_av_disconnect_req (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
tBTA_AV_RCB *p_rcb;
UNUSED(p_data);
APPL_TRACE_DEBUG("%s conn_lcb: 0x%x", __func__, bta_av_cb.conn_lcb);
alarm_cancel(bta_av_cb.link_signalling_timer);
alarm_cancel(p_scb->avrc_ct_timer);
if (bta_av_cb.conn_lcb) {
p_rcb = bta_av_get_rcb_by_shdl((UINT8)(p_scb->hdi + 1));
if (p_rcb)
bta_av_del_rc(p_rcb);
AVDT_DisconnectReq(p_scb->peer_addr, bta_av_dt_cback[p_scb->hdi]);
} else {
bta_av_ssm_execute(p_scb, BTA_AV_AVDT_DISCONNECT_EVT, NULL);
}
}
/*******************************************************************************
**
** Function bta_av_security_req
**
** Description Send an AVDTP security request.
**
** Returns void
**
*******************************************************************************/
void bta_av_security_req (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
if (bta_av_cb.features & BTA_AV_FEAT_PROTECT)
{
AVDT_SecurityReq(p_scb->avdt_handle, p_data->api_protect_req.p_data,
p_data->api_protect_req.len);
}
}
/*******************************************************************************
**
** Function bta_av_security_rsp
**
** Description Send an AVDTP security response.
**
** Returns void
**
*******************************************************************************/
void bta_av_security_rsp (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
if (bta_av_cb.features & BTA_AV_FEAT_PROTECT)
{
AVDT_SecurityRsp(p_scb->avdt_handle, p_scb->avdt_label, p_data->api_protect_rsp.error_code,
p_data->api_protect_rsp.p_data, p_data->api_protect_rsp.len);
}
else
{
AVDT_SecurityRsp(p_scb->avdt_handle, p_scb->avdt_label, AVDT_ERR_NSC,
NULL, 0);
}
}
/*******************************************************************************
**
** Function bta_av_setconfig_rsp
**
** Description setconfig is OK
**
** Returns void
**
*******************************************************************************/
void bta_av_setconfig_rsp (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
UINT8 num = p_data->ci_setconfig.num_seid + 1;
UINT8 avdt_handle = p_data->ci_setconfig.avdt_handle;
UINT8 *p_seid = p_data->ci_setconfig.p_seid;
int i;
UINT8 local_sep;
/* we like this codec_type. find the sep_idx */
local_sep = bta_av_get_scb_sep_type(p_scb,avdt_handle);
bta_av_adjust_seps_idx(p_scb, avdt_handle);
APPL_TRACE_DEBUG("bta_av_setconfig_rsp: sep_idx: %d cur_psc_mask:0x%x", p_scb->sep_idx, p_scb->cur_psc_mask);
if ((AVDT_TSEP_SNK == local_sep) && (p_data->ci_setconfig.err_code == AVDT_SUCCESS) &&
(p_scb->seps[p_scb->sep_idx].p_app_data_cback != NULL)) {
tBTA_AV_MEDIA av_sink_codec_info;
memcpy(av_sink_codec_info.avk_config.bd_addr,p_scb->peer_addr,sizeof(BD_ADDR));
av_sink_codec_info.avk_config.codec_info = p_scb->cfg.codec_info;
p_scb->seps[p_scb->sep_idx].p_app_data_cback(BTA_AV_MEDIA_SINK_CFG_EVT,
&av_sink_codec_info);
}
AVDT_ConfigRsp(p_scb->avdt_handle, p_scb->avdt_label, p_data->ci_setconfig.err_code,
p_data->ci_setconfig.category);
alarm_cancel(bta_av_cb.link_signalling_timer);
if(p_data->ci_setconfig.err_code == AVDT_SUCCESS)
{
p_scb->wait = BTA_AV_WAIT_ACP_CAPS_ON;
if(p_data->ci_setconfig.recfg_needed)
p_scb->role |= BTA_AV_ROLE_SUSPEND_OPT;
APPL_TRACE_DEBUG("bta_av_setconfig_rsp recfg_needed:%d role:x%x num:%d",
p_data->ci_setconfig.recfg_needed, p_scb->role, num);
/* callout module tells BTA the number of "good" SEPs and their SEIDs.
* getcap on these SEID */
p_scb->num_seps = num;
if (p_scb->cur_psc_mask & AVDT_PSC_DELAY_RPT)
p_scb->avdt_version = AVDT_VERSION_SYNC;
if (p_scb->codec_type == BTA_AV_CODEC_SBC || num > 1)
{
/* if SBC is used by the SNK as INT, discover req is not sent in bta_av_config_ind.
* call disc_res now */
/* this is called in A2DP SRC path only, In case of SINK we don't need it */
if (local_sep == AVDT_TSEP_SRC)
p_scb->p_cos->disc_res(p_scb->hndl, num, num, 0, p_scb->peer_addr,
UUID_SERVCLASS_AUDIO_SOURCE);
}
else
{
/* we do not know the peer device and it is using non-SBC codec
* we need to know all the SEPs on SNK */
bta_av_discover_req(p_scb, NULL);
return;
}
for (i = 1; i < num; i++)
{
APPL_TRACE_DEBUG("sep_info[%d] SEID: %d", i, p_seid[i-1]);
/* initialize the sep_info[] to get capabilities */
p_scb->sep_info[i].in_use = FALSE;
p_scb->sep_info[i].tsep = AVDT_TSEP_SNK;
p_scb->sep_info[i].media_type = p_scb->media_type;
p_scb->sep_info[i].seid = p_seid[i-1];
}
/* only in case of local sep as SRC we need to look for other SEPs, In case of SINK we don't */
if (local_sep == AVDT_TSEP_SRC)
{
/* Make sure UUID has been initialized... */
if (p_scb->uuid_int == 0)
p_scb->uuid_int = p_scb->open_api.uuid;
bta_av_next_getcap(p_scb, p_data);
}
}
}
/*******************************************************************************
**
** Function bta_av_str_opened
**
** Description Stream opened OK (incoming/outgoing).
**
** Returns void
**
*******************************************************************************/
void bta_av_str_opened (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
tBTA_AV_CONN_CHG msg;
tBTA_AV_OPEN open;
UINT8 *p;
UINT16 mtu;
msg.hdr.layer_specific = p_scb->hndl;
msg.is_up = TRUE;
bdcpy(msg.peer_addr, p_scb->peer_addr);
p_scb->l2c_cid = AVDT_GetL2CapChannel(p_scb->avdt_handle);
bta_av_conn_chg((tBTA_AV_DATA *) &msg);
/* set the congestion flag, so AV would not send media packets by accident */
p_scb->cong = TRUE;
p_scb->offload_start_pending = FALSE;
p_scb->stream_mtu = p_data->str_msg.msg.open_ind.peer_mtu - AVDT_MEDIA_HDR_SIZE;
mtu = bta_av_chk_mtu(p_scb, p_scb->stream_mtu);
APPL_TRACE_DEBUG("bta_av_str_opened l2c_cid: 0x%x stream_mtu: %d mtu: %d",
p_scb->l2c_cid, p_scb->stream_mtu, mtu);
if(mtu == 0 || mtu > p_scb->stream_mtu)
mtu = p_scb->stream_mtu;
/* Set the media channel as medium priority */
L2CA_SetTxPriority(p_scb->l2c_cid, L2CAP_CHNL_PRIORITY_MEDIUM);
L2CA_SetChnlFlushability (p_scb->l2c_cid, TRUE);
bta_sys_conn_open(BTA_ID_AV, p_scb->app_id, p_scb->peer_addr);
memset(&p_scb->q_info, 0, sizeof(tBTA_AV_Q_INFO));
p_scb->l2c_bufs = 0;
p_scb->p_cos->open(p_scb->hndl,
p_scb->codec_type, p_scb->cfg.codec_info, mtu);
{
/* TODO check if other audio channel is open.
* If yes, check if reconfig is needed
* Rigt now we do not do this kind of checking.
* BTA-AV is INT for 2nd audio connection.
* The application needs to make sure the current codec_info is proper.
* If one audio connection is open and another SNK attempts to connect to AV,
* the connection will be rejected.
*/
/* check if other audio channel is started. If yes, start */
bdcpy(open.bd_addr, p_scb->peer_addr);
open.chnl = p_scb->chnl;
open.hndl = p_scb->hndl;
open.status = BTA_AV_SUCCESS;
open.starting = bta_av_chk_start(p_scb);
open.edr = 0;
if( NULL != (p = BTM_ReadRemoteFeatures(p_scb->peer_addr)))
{
if(HCI_EDR_ACL_2MPS_SUPPORTED(p))
open.edr |= BTA_AV_EDR_2MBPS;
if(HCI_EDR_ACL_3MPS_SUPPORTED(p))
open.edr |= BTA_AV_EDR_3MBPS;
}
#if( defined BTA_AR_INCLUDED ) && (BTA_AR_INCLUDED == TRUE)
bta_ar_avdt_conn(BTA_ID_AV, open.bd_addr);
#endif
if (p_scb->seps[p_scb->sep_idx].tsep == AVDT_TSEP_SRC )
open.sep = AVDT_TSEP_SNK;
else if (p_scb->seps[p_scb->sep_idx].tsep == AVDT_TSEP_SNK )
open.sep = AVDT_TSEP_SRC;
(*bta_av_cb.p_cback)(BTA_AV_OPEN_EVT, (tBTA_AV *) &open);
if(open.starting)
{
bta_av_ssm_execute(p_scb, BTA_AV_AP_START_EVT, NULL);
}
}
// This code is used to pass PTS TC for AVDTP ABORT
char value[PROPERTY_VALUE_MAX] = {0};
if ((osi_property_get("bluetooth.pts.force_a2dp_abort", value, "false"))
&& (!strcmp(value, "true")))
{
APPL_TRACE_ERROR ("%s: Calling AVDT_AbortReq", __func__);
AVDT_AbortReq(p_scb->avdt_handle);
}
}
/*******************************************************************************
**
** Function bta_av_security_ind
**
** Description Handle an AVDTP security indication.
**
** Returns void
**
*******************************************************************************/
void bta_av_security_ind (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
tBTA_AV_PROTECT_REQ protect_req;
p_scb->avdt_label = p_data->str_msg.msg.hdr.label;
if (bta_av_cb.features & BTA_AV_FEAT_PROTECT)
{
protect_req.chnl = p_scb->chnl;
protect_req.hndl = p_scb->hndl;
/*
APPL_TRACE_EVENT("sec ind handle: x%x", protect_req.hndl);
*/
protect_req.p_data = p_data->str_msg.msg.security_ind.p_data;
protect_req.len = p_data->str_msg.msg.security_ind.len;
(*bta_av_cb.p_cback)(BTA_AV_PROTECT_REQ_EVT, (tBTA_AV *) &protect_req);
}
/* app doesn't support security indication; respond with failure */
else
{
AVDT_SecurityRsp(p_scb->avdt_handle, p_scb->avdt_label, AVDT_ERR_NSC, NULL, 0);
}
}
/*******************************************************************************
**
** Function bta_av_security_cfm
**
** Description Handle an AVDTP security confirm.
**
** Returns void
**
*******************************************************************************/
void bta_av_security_cfm (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
tBTA_AV_PROTECT_RSP protect_rsp;
if (bta_av_cb.features & BTA_AV_FEAT_PROTECT)
{
protect_rsp.chnl = p_scb->chnl;
protect_rsp.hndl = p_scb->hndl;
protect_rsp.p_data = p_data->str_msg.msg.security_cfm.p_data;
protect_rsp.len = p_data->str_msg.msg.security_cfm.len;
protect_rsp.err_code= p_data->str_msg.msg.hdr.err_code;
(*bta_av_cb.p_cback)(BTA_AV_PROTECT_RSP_EVT, (tBTA_AV *) &protect_rsp);
}
}
/*******************************************************************************
**
** Function bta_av_do_close
**
** Description Close stream.
**
** Returns void
**
*******************************************************************************/
void bta_av_do_close (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
UNUSED(p_data);
/* stop stream if started */
if (p_scb->co_started)
{
bta_av_str_stopped(p_scb, NULL);
}
alarm_cancel(bta_av_cb.link_signalling_timer);
/* close stream */
p_scb->started = FALSE;
/* drop the buffers queued in L2CAP */
L2CA_FlushChannel (p_scb->l2c_cid, L2CAP_FLUSH_CHANS_ALL);
AVDT_CloseReq(p_scb->avdt_handle);
/* just in case that the link is congested, link is flow controled by peer or
* for whatever reason the the close request can not be sent in time.
* when this timer expires, AVDT_DisconnectReq will be called to disconnect the link
*/
bta_sys_start_timer(p_scb->avrc_ct_timer, BTA_AV_CLOSE_REQ_TIME_VAL,
BTA_AV_API_CLOSE_EVT, p_scb->hndl);
}
/*******************************************************************************
**
** Function bta_av_connect_req
**
** Description Connect AVDTP connection.
**
** Returns void
**
*******************************************************************************/
void bta_av_connect_req(tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
UNUSED(p_data);
p_scb->sdp_discovery_started = FALSE;
if (p_scb->coll_mask & BTA_AV_COLL_INC_TMR)
{
/* SNK initiated L2C connection while SRC was doing SDP. */
/* Wait until timeout to check if SNK starts signalling. */
APPL_TRACE_EVENT("%s: coll_mask = 0x%2X", __func__, p_scb->coll_mask);
p_scb->coll_mask |= BTA_AV_COLL_API_CALLED;
APPL_TRACE_EVENT("%s: updated coll_mask = 0x%2X", __func__,
p_scb->coll_mask);
return;
}
AVDT_ConnectReq(p_scb->peer_addr, p_scb->sec_mask, bta_av_dt_cback[p_scb->hdi]);
}
/*******************************************************************************
**
** Function bta_av_sdp_failed
**
** Description Service discovery failed.
**
** Returns void
**
*******************************************************************************/
void bta_av_sdp_failed(tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
if (!p_scb->open_status)
p_scb->open_status = BTA_AV_FAIL_SDP;
p_scb->sdp_discovery_started = FALSE;
bta_av_str_closed(p_scb, p_data);
}
/*******************************************************************************
**
** Function bta_av_disc_results
**
** Description Handle the AVDTP discover results. Search through the
** results and find the first available stream, and get
** its capabilities.
**
** Returns void
**
*******************************************************************************/
void bta_av_disc_results (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
UINT8 num_snks = 0, num_srcs =0, i;
/* our uuid in case we initiate connection */
UINT16 uuid_int = p_scb->uuid_int;
APPL_TRACE_DEBUG(" initiator UUID 0x%x", uuid_int);
/* store number of stream endpoints returned */
p_scb->num_seps = p_data->str_msg.msg.discover_cfm.num_seps;
for (i = 0; i < p_scb->num_seps; i++)
{
/* steam not in use, is a sink, and is audio */
if ((p_scb->sep_info[i].in_use == FALSE) &&
(p_scb->sep_info[i].media_type == p_scb->media_type))
{
if((p_scb->sep_info[i].tsep == AVDT_TSEP_SNK) &&
(uuid_int == UUID_SERVCLASS_AUDIO_SOURCE))
num_snks++;
if((p_scb->sep_info[i].tsep == AVDT_TSEP_SRC) &&
(uuid_int == UUID_SERVCLASS_AUDIO_SINK))
num_srcs++;
}
}
p_scb->p_cos->disc_res(p_scb->hndl, p_scb->num_seps, num_snks, num_srcs, p_scb->peer_addr,
uuid_int);
p_scb->num_disc_snks = num_snks;
p_scb->num_disc_srcs = num_srcs;
/* if we got any */
if (p_scb->num_seps > 0)
{
/* initialize index into discovery results */
p_scb->sep_info_idx = 0;
/* get the capabilities of the first available stream */
bta_av_next_getcap(p_scb, p_data);
}
/* else we got discover response but with no streams; we're done */
else
{
bta_av_ssm_execute(p_scb, BTA_AV_STR_DISC_FAIL_EVT, p_data);
}
}
/*******************************************************************************
**
** Function bta_av_disc_res_as_acp
**
** Description Handle the AVDTP discover results. Search through the
** results and find the first available stream, and get
** its capabilities.
**
** Returns void
**
*******************************************************************************/
void bta_av_disc_res_as_acp (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
UINT8 num_snks = 0, i;
/* store number of stream endpoints returned */
p_scb->num_seps = p_data->str_msg.msg.discover_cfm.num_seps;
for (i = 0; i < p_scb->num_seps; i++)
{
/* steam is a sink, and is audio */
if ((p_scb->sep_info[i].tsep == AVDT_TSEP_SNK) &&
(p_scb->sep_info[i].media_type == p_scb->media_type))
{
p_scb->sep_info[i].in_use = FALSE;
num_snks++;
}
}
p_scb->p_cos->disc_res(p_scb->hndl, p_scb->num_seps, num_snks, 0, p_scb->peer_addr,
UUID_SERVCLASS_AUDIO_SOURCE);
p_scb->num_disc_snks = num_snks;
p_scb->num_disc_srcs = 0;
/* if we got any */
if (p_scb->num_seps > 0)
{
/* initialize index into discovery results */
p_scb->sep_info_idx = 0;
/* get the capabilities of the first available stream */
bta_av_next_getcap(p_scb, p_data);
}
/* else we got discover response but with no streams; we're done */
else
{
bta_av_ssm_execute(p_scb, BTA_AV_STR_DISC_FAIL_EVT, p_data);
}
}
/*******************************************************************************
**
** Function bta_av_save_caps
**
** Description report the SNK SEP capabilities to application
**
** Returns void
**
*******************************************************************************/
void bta_av_save_caps(tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
tAVDT_CFG cfg;
tAVDT_SEP_INFO *p_info = &p_scb->sep_info[p_scb->sep_info_idx];
UINT8 old_wait = p_scb->wait;
BOOLEAN getcap_done = FALSE;
APPL_TRACE_DEBUG("bta_av_save_caps num_seps:%d sep_info_idx:%d wait:x%x",
p_scb->num_seps, p_scb->sep_info_idx, p_scb->wait);
memcpy(&cfg, p_scb->p_cap, sizeof(tAVDT_CFG));
/* let application know the capability of the SNK */
p_scb->p_cos->getcfg(p_scb->hndl, cfg.codec_info[BTA_AV_CODEC_TYPE_IDX],
cfg.codec_info, &p_scb->sep_info_idx, p_info->seid,
&cfg.num_protect, cfg.protect_info);
p_scb->sep_info_idx++;
if(p_scb->num_seps > p_scb->sep_info_idx)
{
/* Some devices have seps at the end of the discover list, which is not */
/* matching media type(video not audio). */
/* In this case, we are done with getcap without sending another */
/* request to AVDT. */
if (!bta_av_next_getcap(p_scb, p_data))
getcap_done = TRUE;
}
else
getcap_done = TRUE;
if (getcap_done)
{
/* we are done getting capabilities. restore the p_cb->sep_info_idx */
p_scb->sep_info_idx = 0;
p_scb->wait &= ~(BTA_AV_WAIT_ACP_CAPS_ON|BTA_AV_WAIT_ACP_CAPS_STARTED);
if (old_wait & BTA_AV_WAIT_ACP_CAPS_STARTED)
{
bta_av_start_ok (p_scb, NULL);
}
}
}
/*******************************************************************************
**
** Function bta_av_set_use_rc
**
** Description set to use AVRC for this stream control block.
**
** Returns void
**
*******************************************************************************/
void bta_av_set_use_rc (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
UNUSED(p_data);
p_scb->use_rc = TRUE;
}
/*******************************************************************************
**
** Function bta_av_cco_close
**
** Description call close call-out function.
**
** Returns void
**
*******************************************************************************/
void bta_av_cco_close (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
UINT16 mtu;
UNUSED(p_data);
mtu = bta_av_chk_mtu(p_scb, BTA_AV_MAX_A2DP_MTU);
p_scb->p_cos->close(p_scb->hndl, p_scb->codec_type, mtu);
}
/*******************************************************************************
**
** Function bta_av_open_failed
**
** Description Failed to open an AVDT stream
**
** Returns void
**
*******************************************************************************/
void bta_av_open_failed (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
BOOLEAN is_av_opened = FALSE;
tBTA_AV_SCB * p_opened_scb = NULL;
UINT8 idx;
tBTA_AV_OPEN open;
APPL_TRACE_DEBUG("bta_av_open_failed");
p_scb->open_status = BTA_AV_FAIL_STREAM;
bta_av_cco_close(p_scb, p_data);
/* check whether there is already an opened audio or video connection with the same device */
for (idx = 0; (idx < BTA_AV_NUM_STRS) && (is_av_opened == FALSE); idx++ )
{
p_opened_scb = bta_av_cb.p_scb[idx];
if (p_opened_scb && (p_opened_scb->state == BTA_AV_OPEN_SST) && (!bdcmp(p_opened_scb->peer_addr,p_scb->peer_addr )) )
is_av_opened = TRUE;
}
/* if there is already an active AV connnection with the same bd_addr,
don't send disconnect req, just report the open event with BTA_AV_FAIL_GET_CAP status */
if (is_av_opened == TRUE)
{
bdcpy(open.bd_addr, p_scb->peer_addr);
open.chnl = p_scb->chnl;
open.hndl = p_scb->hndl;
open.status = BTA_AV_FAIL_GET_CAP;
open.starting = bta_av_chk_start(p_scb);
open.edr = 0;
/* set the state back to initial state */
bta_av_set_scb_sst_init(p_scb);
if (p_scb->seps[p_scb->sep_idx].tsep == AVDT_TSEP_SRC )
open.sep = AVDT_TSEP_SNK;
else if (p_scb->seps[p_scb->sep_idx].tsep == AVDT_TSEP_SNK )
open.sep = AVDT_TSEP_SRC;
(*bta_av_cb.p_cback)(BTA_AV_OPEN_EVT, (tBTA_AV *) &open);
}
else
{
AVDT_DisconnectReq(p_scb->peer_addr, bta_av_dt_cback[p_scb->hdi]);
}
}
/*******************************************************************************
**
** Function bta_av_getcap_results
**
** Description Handle the AVDTP get capabilities results. Check the codec
** type and see if it matches ours. If it does not, get the
** capabilities of the next stream, if any.
**
** Returns void
**
*******************************************************************************/
void bta_av_getcap_results (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
tAVDT_CFG cfg;
UINT8 media_type;
tAVDT_SEP_INFO *p_info = &p_scb->sep_info[p_scb->sep_info_idx];
UINT16 uuid_int; /* UUID for which connection was initiatied */
memcpy(&cfg, &p_scb->cfg, sizeof(tAVDT_CFG));
cfg.num_codec = 1;
cfg.num_protect = p_scb->p_cap->num_protect;
memcpy(cfg.codec_info, p_scb->p_cap->codec_info, AVDT_CODEC_SIZE);
memcpy(cfg.protect_info, p_scb->p_cap->protect_info, AVDT_PROTECT_SIZE);
media_type = p_scb->p_cap->codec_info[BTA_AV_MEDIA_TYPE_IDX] >> 4;
APPL_TRACE_DEBUG("num_codec %d", p_scb->p_cap->num_codec);
APPL_TRACE_DEBUG("media type x%x, x%x", media_type, p_scb->media_type);
#if AVDT_MULTIPLEXING == TRUE
APPL_TRACE_DEBUG("mux x%x, x%x", cfg.mux_mask, p_scb->p_cap->mux_mask);
#endif
/* if codec present and we get a codec configuration */
if ((p_scb->p_cap->num_codec != 0) &&
(media_type == p_scb->media_type) &&
(p_scb->p_cos->getcfg(p_scb->hndl, p_scb->p_cap->codec_info[BTA_AV_CODEC_TYPE_IDX],
cfg.codec_info, &p_scb->sep_info_idx, p_info->seid,
&cfg.num_protect, cfg.protect_info) == 0))
{
#if AVDT_MULTIPLEXING == TRUE
cfg.mux_mask &= p_scb->p_cap->mux_mask;
APPL_TRACE_DEBUG("mux_mask used x%x", cfg.mux_mask);
#endif
/* save copy of codec type and configuration */
p_scb->codec_type = cfg.codec_info[BTA_AV_CODEC_TYPE_IDX];
memcpy(&p_scb->cfg, &cfg, sizeof(tAVDT_CFG));
uuid_int = p_scb->uuid_int;
APPL_TRACE_DEBUG(" initiator UUID = 0x%x ", uuid_int);
if (uuid_int == UUID_SERVCLASS_AUDIO_SOURCE)
bta_av_adjust_seps_idx(p_scb, bta_av_get_scb_handle(p_scb, AVDT_TSEP_SRC));
else if (uuid_int == UUID_SERVCLASS_AUDIO_SINK)
bta_av_adjust_seps_idx(p_scb, bta_av_get_scb_handle(p_scb, AVDT_TSEP_SNK));
/* use only the services peer supports */
cfg.psc_mask &= p_scb->p_cap->psc_mask;
p_scb->cur_psc_mask = cfg.psc_mask;
if ((uuid_int == UUID_SERVCLASS_AUDIO_SINK) &&
(p_scb->seps[p_scb->sep_idx].p_app_data_cback != NULL))
{
APPL_TRACE_DEBUG("%s Configure Decoder for Sink Connection.", __func__);
tBTA_AV_MEDIA av_sink_codec_info;
memcpy(av_sink_codec_info.avk_config.bd_addr,p_scb->peer_addr,sizeof(BD_ADDR));
av_sink_codec_info.avk_config.codec_info = p_scb->cfg.codec_info;
p_scb->seps[p_scb->sep_idx].p_app_data_cback(BTA_AV_MEDIA_SINK_CFG_EVT,
&av_sink_codec_info);
}
if ((uuid_int == UUID_SERVCLASS_AUDIO_SOURCE) &&
(cfg.codec_info[SBC_MAX_BITPOOL_OFFSET] > SBC_MAX_BITPOOL))
{
APPL_TRACE_WARNING("%s max bitpool length received for SBC is out of range."
"Clamping the codec bitpool configuration from %d to %d.", __func__,
cfg.codec_info[SBC_MAX_BITPOOL_OFFSET], SBC_MAX_BITPOOL);
cfg.codec_info[SBC_MAX_BITPOOL_OFFSET] = SBC_MAX_BITPOOL;
}
/* open the stream */
AVDT_OpenReq(p_scb->seps[p_scb->sep_idx].av_handle, p_scb->peer_addr,
p_scb->sep_info[p_scb->sep_info_idx].seid, &cfg);
if (!bta_av_is_rcfg_sst(p_scb))
{
/* free capabilities buffer */
osi_free_and_reset((void **)&p_scb->p_cap);
}
}
else
{
/* try the next stream, if any */
p_scb->sep_info_idx++;
bta_av_next_getcap(p_scb, p_data);
}
}
/*******************************************************************************
**
** Function bta_av_setconfig_rej
**
** Description Send AVDTP set config reject.
**
** Returns void
**
*******************************************************************************/
void bta_av_setconfig_rej (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
tBTA_AV_REJECT reject;
UINT8 avdt_handle = p_data->ci_setconfig.avdt_handle;
bta_av_adjust_seps_idx(p_scb, avdt_handle);
APPL_TRACE_DEBUG("bta_av_setconfig_rej: sep_idx: %d",p_scb->sep_idx);
AVDT_ConfigRsp(p_scb->avdt_handle, p_scb->avdt_label, AVDT_ERR_UNSUP_CFG, 0);
bdcpy(reject.bd_addr, p_data->str_msg.bd_addr);
reject.hndl = p_scb->hndl;
(*bta_av_cb.p_cback)(BTA_AV_REJECT_EVT, (tBTA_AV *) &reject);
}
/*******************************************************************************
**
** Function bta_av_discover_req
**
** Description Send an AVDTP discover request to the peer.
**
** Returns void
**
*******************************************************************************/
void bta_av_discover_req (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
UNUSED(p_data);
/* send avdtp discover request */
AVDT_DiscoverReq(p_scb->peer_addr, p_scb->sep_info, BTA_AV_NUM_SEPS, bta_av_dt_cback[p_scb->hdi]);
}
/*******************************************************************************
**
** Function bta_av_conn_failed
**
** Description AVDTP connection failed.
**
** Returns void
**
*******************************************************************************/
void bta_av_conn_failed (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
p_scb->open_status = BTA_AV_FAIL_STREAM;
bta_av_str_closed(p_scb, p_data);
}
/*******************************************************************************
**
** Function bta_av_do_start
**
** Description Start stream.
**
** Returns void
**
*******************************************************************************/
void bta_av_do_start (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
UINT8 policy = HCI_ENABLE_SNIFF_MODE;
UINT8 cur_role;
APPL_TRACE_DEBUG("bta_av_do_start sco_occupied:%d, role:x%x, started:%d", bta_av_cb.sco_occupied, p_scb->role, p_scb->started);
if (bta_av_cb.sco_occupied)
{
bta_av_start_failed(p_scb, p_data);
return;
}
/* disallow role switch during streaming, only if we are the master role
* i.e. allow role switch, if we are slave.
* It would not hurt us, if the peer device wants us to be master */
if ((BTM_GetRole (p_scb->peer_addr, &cur_role) == BTM_SUCCESS) &&
(cur_role == BTM_ROLE_MASTER) )
{
policy |= HCI_ENABLE_MASTER_SLAVE_SWITCH;
}
bta_sys_clear_policy(BTA_ID_AV, policy, p_scb->peer_addr);
if ((p_scb->started == FALSE) && ((p_scb->role & BTA_AV_ROLE_START_INT) == 0))
{
p_scb->role |= BTA_AV_ROLE_START_INT;
bta_sys_busy(BTA_ID_AV, bta_av_cb.audio_open_cnt, p_scb->peer_addr);
AVDT_StartReq(&p_scb->avdt_handle, 1);
}
else if (p_scb->started)
{
p_scb->role |= BTA_AV_ROLE_START_INT;
if ( p_scb->wait == 0 ) {
if (p_scb->role & BTA_AV_ROLE_SUSPEND) {
notify_start_failed(p_scb);
} else {
bta_av_start_ok(p_scb, NULL);
}
}
}
APPL_TRACE_DEBUG("started %d role:x%x", p_scb->started, p_scb->role);
}
/*******************************************************************************
**
** Function bta_av_str_stopped
**
** Description Stream stopped.
**
** Returns void
**
*******************************************************************************/
void bta_av_str_stopped (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
tBTA_AV_SUSPEND suspend_rsp;
UINT8 start = p_scb->started;
BOOLEAN sus_evt = TRUE;
BT_HDR *p_buf;
UINT8 policy = HCI_ENABLE_SNIFF_MODE;
APPL_TRACE_ERROR("bta_av_str_stopped:audio_open_cnt=%d, p_data %x",
bta_av_cb.audio_open_cnt, p_data);
bta_sys_idle(BTA_ID_AV, bta_av_cb.audio_open_cnt, p_scb->peer_addr);
if ((bta_av_cb.features & BTA_AV_FEAT_MASTER) == 0 || bta_av_cb.audio_open_cnt == 1)
policy |= HCI_ENABLE_MASTER_SLAVE_SWITCH;
bta_sys_set_policy(BTA_ID_AV, policy, p_scb->peer_addr);
if (p_scb->co_started)
{
vendor_get_interface()->send_command(
(vendor_opcode_t)BT_VND_OP_A2DP_OFFLOAD_STOP,
(void*)&p_scb->l2c_cid);
if (p_scb->offload_start_pending) {
tBTA_AV_STATUS status = BTA_AV_FAIL_STREAM;
(*bta_av_cb.p_cback)(BTA_AV_OFFLOAD_START_RSP_EVT, (tBTA_AV *)&status);
}
p_scb->offload_start_pending = FALSE;
bta_av_stream_chg(p_scb, FALSE);
p_scb->co_started = FALSE;
p_scb->p_cos->stop(p_scb->hndl, p_scb->codec_type);
L2CA_SetFlushTimeout(p_scb->peer_addr, L2CAP_DEFAULT_FLUSH_TO);
}
/* if q_info.a2d_list is not empty, drop it now */
if (BTA_AV_CHNL_AUDIO == p_scb->chnl) {
while (!list_is_empty(p_scb->a2d_list))
{
p_buf = (BT_HDR *)list_front(p_scb->a2d_list);
list_remove(p_scb->a2d_list, p_buf);
osi_free(p_buf);
}
/* drop the audio buffers queued in L2CAP */
if (p_data && p_data->api_stop.flush)
L2CA_FlushChannel (p_scb->l2c_cid, L2CAP_FLUSH_CHANS_ALL);
}
suspend_rsp.chnl = p_scb->chnl;
suspend_rsp.hndl = p_scb->hndl;
if (p_data && p_data->api_stop.suspend)
{
APPL_TRACE_DEBUG("suspending: %d, sup:%d", start, p_scb->suspend_sup);
if ((start) && (p_scb->suspend_sup))
{
sus_evt = FALSE;
p_scb->l2c_bufs = 0;
AVDT_SuspendReq(&p_scb->avdt_handle, 1);
}
/* send SUSPEND_EVT event only if not in reconfiguring state and sus_evt is TRUE*/
if ((sus_evt)&&(p_scb->state != BTA_AV_RCFG_SST))
{
suspend_rsp.status = BTA_AV_SUCCESS;
suspend_rsp.initiator = TRUE;
(*bta_av_cb.p_cback)(BTA_AV_SUSPEND_EVT, (tBTA_AV *) &suspend_rsp);
}
}
else
{
suspend_rsp.status = BTA_AV_SUCCESS;
suspend_rsp.initiator = TRUE;
APPL_TRACE_EVENT("bta_av_str_stopped status %d", suspend_rsp.status);
/* send STOP_EVT event only if not in reconfiguring state */
if (p_scb->state != BTA_AV_RCFG_SST)
{
(*bta_av_cb.p_cback)(BTA_AV_STOP_EVT, (tBTA_AV *) &suspend_rsp);
}
}
}
/*******************************************************************************
**
** Function bta_av_reconfig
**
** Description process the reconfigure request.
** save the parameter in control block and
** suspend, reconfigure or close the stream
**
** Returns void
**
*******************************************************************************/
void bta_av_reconfig (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
tAVDT_CFG *p_cfg;
tBTA_AV_API_STOP stop;
tBTA_AV_API_RCFG *p_rcfg = &p_data->api_reconfig;
APPL_TRACE_DEBUG("bta_av_reconfig r:%d, s:%d idx: %d (o:%d)",
p_scb->recfg_sup, p_scb->suspend_sup,
p_scb->rcfg_idx, p_scb->sep_info_idx);
p_scb->num_recfg = 0;
/* store the new configuration in control block */
if (p_scb->p_cap == NULL)
p_scb->p_cap = (tAVDT_CFG *)osi_malloc(sizeof(tAVDT_CFG));
p_cfg = p_scb->p_cap;
alarm_cancel(p_scb->avrc_ct_timer);
memcpy(p_cfg, &p_scb->cfg, sizeof(tAVDT_CFG));
p_cfg->num_protect = p_rcfg->num_protect;
memcpy(p_cfg->codec_info, p_rcfg->codec_info, AVDT_CODEC_SIZE);
memcpy(p_cfg->protect_info, p_rcfg->p_protect_info, p_rcfg->num_protect);
p_scb->rcfg_idx = p_rcfg->sep_info_idx;
p_scb->p_cap->psc_mask = p_scb->cur_psc_mask;
/* if the requested index differs from the current one, we can only close/open */
if ((p_scb->rcfg_idx == p_scb->sep_info_idx) &&
(p_rcfg->suspend)&& (p_scb->recfg_sup) && (p_scb->suspend_sup))
{
if(p_scb->started)
{
stop.flush = FALSE;
stop.suspend = TRUE;
bta_av_str_stopped(p_scb, (tBTA_AV_DATA *)&stop);
}
else
{
APPL_TRACE_DEBUG("Reconfig");
AVDT_ReconfigReq(p_scb->avdt_handle, p_scb->p_cap);
p_scb->p_cap->psc_mask = p_scb->cur_psc_mask;
}
}
else
{
/* close the stream */
APPL_TRACE_DEBUG("close/open num_protect: %d", p_cfg->num_protect);
if(p_scb->started)
{
bta_av_str_stopped(p_scb, NULL);
p_scb->started = FALSE;
/* drop the buffers queued in L2CAP */
L2CA_FlushChannel (p_scb->l2c_cid, L2CAP_FLUSH_CHANS_ALL);
AVDT_CloseReq(p_scb->avdt_handle);
}
}
}
/*******************************************************************************
**
** Function bta_av_data_path
**
** Description Handle stream data path.
**
** Returns void
**
*******************************************************************************/
void bta_av_data_path (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
BT_HDR *p_buf = NULL;
UINT32 data_len;
UINT32 timestamp;
BOOLEAN new_buf = FALSE;
UINT8 m_pt = 0x60 | p_scb->codec_type;
tAVDT_DATA_OPT_MASK opt;
UNUSED(p_data);
if (p_scb->cong)
{
return;
}
/*
APPL_TRACE_ERROR("q: %d", p_scb->l2c_bufs);
*/
//Always get the current number of bufs que'd up
p_scb->l2c_bufs = (UINT8)L2CA_FlushChannel (p_scb->l2c_cid, L2CAP_FLUSH_CHANS_GET);
if (!list_is_empty(p_scb->a2d_list)) {
p_buf = (BT_HDR *)list_front(p_scb->a2d_list);
list_remove(p_scb->a2d_list, p_buf);
/* use q_info.a2d data, read the timestamp */
timestamp = *(UINT32 *)(p_buf + 1);
}
else
{
new_buf = TRUE;
/* a2d_list empty, call co_data, dup data to other channels */
p_buf = (BT_HDR *)p_scb->p_cos->data(p_scb->codec_type, &data_len,
×tamp);
if (p_buf)
{
/* use the offset area for the time stamp */
*(UINT32 *)(p_buf + 1) = timestamp;
/* dup the data to other channels */
bta_av_dup_audio_buf(p_scb, p_buf);
}
}
if(p_buf)
{
if(p_scb->l2c_bufs < (BTA_AV_QUEUE_DATA_CHK_NUM))
{
/* there's a buffer, just queue it to L2CAP */
/* There's no need to increment it here, it is always read from L2CAP see above */
/* p_scb->l2c_bufs++; */
/*
APPL_TRACE_ERROR("qw: %d", p_scb->l2c_bufs);
*/
/* opt is a bit mask, it could have several options set */
opt = AVDT_DATA_OPT_NONE;
if (p_scb->no_rtp_hdr)
{
opt |= AVDT_DATA_OPT_NO_RTP;
}
AVDT_WriteReqOpt(p_scb->avdt_handle, p_buf, timestamp, m_pt, opt);
p_scb->cong = TRUE;
}
else
{
/* there's a buffer, but L2CAP does not seem to be moving data */
if(new_buf)
{
/* just got this buffer from co_data,
* put it in queue */
list_append(p_scb->a2d_list, p_buf);
}
else
{
/* just dequeue it from the a2d_list */
if (list_length(p_scb->a2d_list) < 3) {
/* put it back to the queue */
list_prepend(p_scb->a2d_list, p_buf);
}
else
{
/* too many buffers in a2d_list, drop it. */
bta_av_co_audio_drop(p_scb->hndl);
osi_free(p_buf);
}
}
}
}
}
/*******************************************************************************
**
** Function bta_av_start_ok
**
** Description Stream started.
**
** Returns void
**
*******************************************************************************/
void bta_av_start_ok (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
tBTA_AV_START start;
tBTA_AV_API_STOP stop;
BOOLEAN initiator = FALSE;
BOOLEAN suspend = FALSE;
UINT16 flush_to;
UINT8 new_role = p_scb->role;
BT_HDR hdr;
UINT8 policy = HCI_ENABLE_SNIFF_MODE;
UINT8 cur_role;
APPL_TRACE_DEBUG("bta_av_start_ok wait:x%x, role:x%x", p_scb->wait, p_scb->role);
p_scb->started = TRUE;
if (p_scb->sco_suspend)
{
p_scb->sco_suspend = FALSE;
}
if (new_role & BTA_AV_ROLE_START_INT)
initiator = TRUE;
/* for A2DP SINK we do not send get_caps */
if ((p_scb->avdt_handle == p_scb->seps[p_scb->sep_idx].av_handle)
&&(p_scb->seps[p_scb->sep_idx].tsep == AVDT_TSEP_SNK))
{
p_scb->wait &= ~(BTA_AV_WAIT_ACP_CAPS_ON);
APPL_TRACE_DEBUG(" Local SEP type is SNK new wait is 0x%x",p_scb->wait);
}
if (p_scb->wait & BTA_AV_WAIT_ROLE_SW_FAILED)
{
/* role switch has failed */
p_scb->wait &= ~BTA_AV_WAIT_ROLE_SW_FAILED;
p_data = (tBTA_AV_DATA *)&hdr;
hdr.offset = BTA_AV_RS_FAIL;
}
APPL_TRACE_DEBUG("wait:x%x", p_scb->wait);
if (p_data && (p_data->hdr.offset != BTA_AV_RS_NONE))
{
p_scb->wait &= ~BTA_AV_WAIT_ROLE_SW_BITS;
if (p_data->hdr.offset == BTA_AV_RS_FAIL)
{
bta_sys_idle(BTA_ID_AV, bta_av_cb.audio_open_cnt, p_scb->peer_addr);
start.chnl = p_scb->chnl;
start.status = BTA_AV_FAIL_ROLE;
start.hndl = p_scb->hndl;
start.initiator = initiator;
(*bta_av_cb.p_cback)(BTA_AV_START_EVT, (tBTA_AV *) &start);
return;
}
}
if (!bta_av_link_role_ok(p_scb, A2D_SET_ONE_BIT))
p_scb->q_tag = BTA_AV_Q_TAG_START;
else
{
/* The wait flag may be set here while we are already master on the link */
/* this could happen if a role switch complete event occurred during reconfig */
/* if we are now master on the link, there is no need to wait for the role switch, */
/* complete anymore so we can clear the wait for role switch flag */
p_scb->wait &= ~BTA_AV_WAIT_ROLE_SW_BITS;
}
if (p_scb->wait & (BTA_AV_WAIT_ROLE_SW_RES_OPEN|BTA_AV_WAIT_ROLE_SW_RES_START))
{
p_scb->wait |= BTA_AV_WAIT_ROLE_SW_STARTED;
p_scb->q_tag = BTA_AV_Q_TAG_START;
}
if (p_scb->wait)
{
APPL_TRACE_ERROR("wait:x%x q_tag:%d- not started", p_scb->wait, p_scb->q_tag);
/* Clear first bit of p_scb->wait and not to return from this point else
* HAL layer gets blocked. And if there is delay in Get Capability response as
* first bit of p_scb->wait is cleared hence it ensures bt_av_start_ok is not called
* again from bta_av_save_caps.
*/
p_scb->wait &= ~BTA_AV_WAIT_ACP_CAPS_ON;
}
/* tell role manager to check M/S role */
bta_sys_conn_open(BTA_ID_AV, p_scb->app_id, p_scb->peer_addr);
bta_sys_busy(BTA_ID_AV, bta_av_cb.audio_open_cnt, p_scb->peer_addr);
if(p_scb->media_type == AVDT_MEDIA_AUDIO)
{
/* in normal logic, conns should be bta_av_cb.audio_count - 1,
* However, bta_av_stream_chg is not called to increase bta_av_cb.audio_count yet.
* If the code were to be re-arranged for some reasons, this number may need to be changed
*/
p_scb->co_started = bta_av_cb.audio_open_cnt;
flush_to = p_bta_av_cfg->p_audio_flush_to[p_scb->co_started - 1];
}
else
{
flush_to = p_bta_av_cfg->video_flush_to;
}
L2CA_SetFlushTimeout(p_scb->peer_addr, flush_to );
/* clear the congestion flag */
p_scb->cong = FALSE;
if (new_role & BTA_AV_ROLE_START_INT)
{
new_role &= ~BTA_AV_ROLE_START_INT;
}
else if ((new_role & BTA_AV_ROLE_AD_ACP) && (new_role & BTA_AV_ROLE_SUSPEND_OPT))
{
suspend = TRUE;
}
if (!suspend)
{
p_scb->q_tag = BTA_AV_Q_TAG_STREAM;
bta_av_stream_chg(p_scb, TRUE);
}
{
/* If sink starts stream, disable sniff mode here */
if (!initiator)
{
/* If souce is the master role, disable role switch during streaming.
* Otherwise allow role switch, if source is slave.
* Because it would not hurt source, if the peer device wants source to be master */
if ((BTM_GetRole (p_scb->peer_addr, &cur_role) == BTM_SUCCESS) &&
(cur_role == BTM_ROLE_MASTER) )
{
policy |= HCI_ENABLE_MASTER_SLAVE_SWITCH;
}
bta_sys_clear_policy(BTA_ID_AV, policy, p_scb->peer_addr);
}
p_scb->role = new_role;
p_scb->role &= ~BTA_AV_ROLE_AD_ACP;
p_scb->role &= ~BTA_AV_ROLE_SUSPEND_OPT;
p_scb->no_rtp_hdr = FALSE;
p_scb->p_cos->start(p_scb->hndl, p_scb->codec_type, p_scb->cfg.codec_info, &p_scb->no_rtp_hdr);
p_scb->co_started = TRUE;
APPL_TRACE_DEBUG("bta_av_start_ok suspending: %d, role:x%x, init %d",
suspend, p_scb->role, initiator);
start.suspending = suspend;
start.initiator = initiator;
start.chnl = p_scb->chnl;
start.status = BTA_AV_SUCCESS;
start.hndl = p_scb->hndl;
(*bta_av_cb.p_cback)(BTA_AV_START_EVT, (tBTA_AV *) &start);
if(suspend)
{
p_scb->role |= BTA_AV_ROLE_SUSPEND;
p_scb->cong = TRUE; /* do not allow the media data to go through */
/* do not duplicate the media packets to this channel */
p_scb->p_cos->stop(p_scb->hndl, p_scb->codec_type);
p_scb->co_started = FALSE;
stop.flush = FALSE;
stop.suspend = TRUE;
bta_av_ssm_execute(p_scb, BTA_AV_AP_STOP_EVT, (tBTA_AV_DATA *)&stop);
}
}
}
/*******************************************************************************
**
** Function bta_av_start_failed
**
** Description Stream start failed.
**
** Returns void
**
*******************************************************************************/
void bta_av_start_failed (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
UNUSED(p_data);
if(p_scb->started == FALSE && p_scb->co_started == FALSE)
{
bta_sys_idle(BTA_ID_AV, bta_av_cb.audio_open_cnt, p_scb->peer_addr);
notify_start_failed(p_scb);
}
bta_sys_set_policy(BTA_ID_AV, (HCI_ENABLE_SNIFF_MODE|HCI_ENABLE_MASTER_SLAVE_SWITCH), p_scb->peer_addr);
p_scb->sco_suspend = FALSE;
}
/*******************************************************************************
**
** Function bta_av_str_closed
**
** Description Stream closed.
**
** Returns void
**
*******************************************************************************/
void bta_av_str_closed (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
tBTA_AV data;
tBTA_AV_EVT event;
UINT16 mtu;
UINT8 policy = HCI_ENABLE_SNIFF_MODE;
if ((bta_av_cb.features & BTA_AV_FEAT_MASTER) == 0 || bta_av_cb.audio_open_cnt == 1)
policy |= HCI_ENABLE_MASTER_SLAVE_SWITCH;
bta_sys_set_policy(BTA_ID_AV, policy, p_scb->peer_addr);
if (bta_av_cb.audio_open_cnt <= 1)
{
/* last connection - restore the allow switch flag */
L2CA_SetDesireRole(L2CAP_ROLE_ALLOW_SWITCH);
}
if (p_scb->open_status)
{
/* must be failure when opening the stream */
bdcpy(data.open.bd_addr, p_scb->peer_addr);
data.open.status = p_scb->open_status;
data.open.chnl = p_scb->chnl;
data.open.hndl = p_scb->hndl;
if (p_scb->seps[p_scb->sep_idx].tsep == AVDT_TSEP_SRC )
data.open.sep = AVDT_TSEP_SNK;
else if (p_scb->seps[p_scb->sep_idx].tsep == AVDT_TSEP_SNK )
data.open.sep = AVDT_TSEP_SRC;
event = BTA_AV_OPEN_EVT;
p_scb->open_status = BTA_AV_SUCCESS;
bta_sys_conn_close(BTA_ID_AV, p_scb->app_id, p_scb->peer_addr);
bta_av_cleanup(p_scb, p_data);
(*bta_av_cb.p_cback)(event, &data);
}
else
{
/* do stop if we were started */
if (p_scb->co_started)
{
bta_av_str_stopped(p_scb, NULL);
}
/* Update common mtu shared by remaining connectons */
mtu = bta_av_chk_mtu(p_scb, BTA_AV_MAX_A2DP_MTU);
{
p_scb->p_cos->close(p_scb->hndl, p_scb->codec_type, mtu);
data.close.chnl = p_scb->chnl;
data.close.hndl = p_scb->hndl;
event = BTA_AV_CLOSE_EVT;
bta_sys_conn_close(BTA_ID_AV, p_scb->app_id, p_scb->peer_addr);
bta_av_cleanup(p_scb, p_data);
(*bta_av_cb.p_cback)(event, &data);
}
}
}
/*******************************************************************************
**
** Function bta_av_clr_cong
**
** Description Clear stream congestion flag.
**
** Returns void
**
*******************************************************************************/
void bta_av_clr_cong (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
UNUSED(p_data);
if(p_scb->co_started)
p_scb->cong = FALSE;
}
/*******************************************************************************
**
** Function bta_av_suspend_cfm
**
** Description process the suspend response
**
** Returns void
**
*******************************************************************************/
void bta_av_suspend_cfm (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
tBTA_AV_SUSPEND suspend_rsp;
UINT8 err_code = p_data->str_msg.msg.hdr.err_code;
UINT8 policy = HCI_ENABLE_SNIFF_MODE;
APPL_TRACE_DEBUG ("bta_av_suspend_cfm:audio_open_cnt = %d, err_code = %d",
bta_av_cb.audio_open_cnt, err_code);
if (p_scb->started == FALSE)
{
/* handle the condition where there is a collision of SUSPEND req from either side
** Second SUSPEND req could be rejected. Do not treat this as a failure
*/
APPL_TRACE_WARNING("bta_av_suspend_cfm: already suspended, ignore, err_code %d",
err_code);
return;
}
suspend_rsp.status = BTA_AV_SUCCESS;
if (err_code && (err_code != AVDT_ERR_BAD_STATE))
{
/* Disable suspend feature only with explicit rejection(not with timeout) */
if (err_code != AVDT_ERR_TIMEOUT)
{
p_scb->suspend_sup = FALSE;
}
suspend_rsp.status = BTA_AV_FAIL;
APPL_TRACE_ERROR ("bta_av_suspend_cfm: suspend failed, closing connection");
/* SUSPEND failed. Close connection. */
bta_av_ssm_execute(p_scb, BTA_AV_API_CLOSE_EVT, NULL);
}
else
{
/* only set started to FALSE when suspend is successful */
p_scb->started = FALSE;
}
if (p_scb->role & BTA_AV_ROLE_SUSPEND)
{
p_scb->role &= ~BTA_AV_ROLE_SUSPEND;
p_scb->cong = FALSE;
}
bta_sys_idle(BTA_ID_AV, bta_av_cb.audio_open_cnt, p_scb->peer_addr);
if ((bta_av_cb.features & BTA_AV_FEAT_MASTER) == 0 || bta_av_cb.audio_open_cnt == 1)
policy |= HCI_ENABLE_MASTER_SLAVE_SWITCH;
bta_sys_set_policy(BTA_ID_AV, policy, p_scb->peer_addr);
/* in case that we received suspend_ind, we may need to call co_stop here */
if(p_scb->co_started)
{
vendor_get_interface()->send_command(
(vendor_opcode_t)BT_VND_OP_A2DP_OFFLOAD_STOP,
(void*)&p_scb->l2c_cid);
if (p_scb->offload_start_pending) {
tBTA_AV_STATUS status = BTA_AV_FAIL_STREAM;
(*bta_av_cb.p_cback)(BTA_AV_OFFLOAD_START_RSP_EVT, (tBTA_AV *)&status);
}
p_scb->offload_start_pending = FALSE;
bta_av_stream_chg(p_scb, FALSE);
{
p_scb->co_started = FALSE;
p_scb->p_cos->stop(p_scb->hndl, p_scb->codec_type);
}
L2CA_SetFlushTimeout(p_scb->peer_addr, L2CAP_DEFAULT_FLUSH_TO);
}
{
suspend_rsp.chnl = p_scb->chnl;
suspend_rsp.hndl = p_scb->hndl;
suspend_rsp.initiator = p_data->str_msg.initiator;
(*bta_av_cb.p_cback)(BTA_AV_SUSPEND_EVT, (tBTA_AV *) &suspend_rsp);
}
}
/*******************************************************************************
**
** Function bta_av_rcfg_str_ok
**
** Description report reconfigure successful
**
** Returns void
**
*******************************************************************************/
void bta_av_rcfg_str_ok (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
tBTA_AV_RECONFIG evt;
UNUSED(p_data);
p_scb->l2c_cid = AVDT_GetL2CapChannel(p_scb->avdt_handle);
APPL_TRACE_DEBUG("bta_av_rcfg_str_ok: l2c_cid: %d", p_scb->l2c_cid);
/* rc listen */
bta_av_st_rc_timer(p_scb, NULL);
osi_free_and_reset((void **)&p_scb->p_cap);
/* No need to keep the role bits once reconfig is done. */
p_scb->role &= ~BTA_AV_ROLE_AD_ACP;
p_scb->role &= ~BTA_AV_ROLE_SUSPEND_OPT;
p_scb->role &= ~BTA_AV_ROLE_START_INT;
{
/* reconfigure success */
evt.status = BTA_AV_SUCCESS;
evt.chnl = p_scb->chnl;
evt.hndl = p_scb->hndl;
(*bta_av_cb.p_cback)(BTA_AV_RECONFIG_EVT, (tBTA_AV *)&evt);
}
}
/*******************************************************************************
**
** Function bta_av_rcfg_failed
**
** Description process reconfigure failed
**
** Returns void
**
*******************************************************************************/
void bta_av_rcfg_failed (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
tBTA_AV_RECONFIG evt;
APPL_TRACE_DEBUG("bta_av_rcfg_failed num_recfg: %d, conn_lcb:0x%x",
p_scb->num_recfg, bta_av_cb.conn_lcb);
if(p_scb->num_recfg > BTA_AV_RECONFIG_RETRY)
{
bta_av_cco_close(p_scb, p_data);
/* report failure */
evt.status = BTA_AV_FAIL_STREAM;
evt.chnl = p_scb->chnl;
evt.hndl = p_scb->hndl;
(*bta_av_cb.p_cback)(BTA_AV_RECONFIG_EVT, (tBTA_AV *)&evt);
/* go to closing state */
bta_av_ssm_execute(p_scb, BTA_AV_API_CLOSE_EVT, NULL);
}
else
{
/* open failed. try again */
p_scb->num_recfg++;
if(bta_av_cb.conn_lcb)
{
AVDT_DisconnectReq(p_scb->peer_addr, bta_av_dt_cback[p_scb->hdi]);
}
else
{
bta_av_connect_req(p_scb, NULL);
}
}
}
/*******************************************************************************
**
** Function bta_av_rcfg_connect
**
** Description stream closed. reconnect the stream
**
** Returns void
**
*******************************************************************************/
void bta_av_rcfg_connect (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
UNUSED(p_data);
p_scb->cong = FALSE;
p_scb->num_recfg++;
APPL_TRACE_DEBUG("bta_av_rcfg_connect num_recfg: %d", p_scb->num_recfg);
if(p_scb->num_recfg > BTA_AV_RECONFIG_RETRY)
{
/* let bta_av_rcfg_failed report fail */
bta_av_rcfg_failed(p_scb, NULL);
}
else
AVDT_ConnectReq(p_scb->peer_addr, p_scb->sec_mask, bta_av_dt_cback[p_scb->hdi]);
}
/*******************************************************************************
**
** Function bta_av_rcfg_discntd
**
** Description AVDT disconnected. reconnect the stream
**
** Returns void
**
*******************************************************************************/
void bta_av_rcfg_discntd (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
tBTA_AV_RECONFIG evt;
UNUSED(p_data);
APPL_TRACE_DEBUG("bta_av_rcfg_discntd num_recfg: %d", p_scb->num_recfg);
p_scb->num_recfg++;
if(p_scb->num_recfg > BTA_AV_RECONFIG_RETRY)
{
/* report failure */
evt.status = BTA_AV_FAIL_STREAM;
evt.chnl = p_scb->chnl;
evt.hndl = p_scb->hndl;
(*bta_av_cb.p_cback)(BTA_AV_RECONFIG_EVT, (tBTA_AV *)&evt);
/* report close event & go to init state */
bta_av_ssm_execute(p_scb, BTA_AV_STR_DISC_FAIL_EVT, NULL);
}
else
AVDT_ConnectReq(p_scb->peer_addr, p_scb->sec_mask, bta_av_dt_cback[p_scb->hdi]);
}
/*******************************************************************************
**
** Function bta_av_suspend_cont
**
** Description received the suspend response.
** continue to reconfigure the stream
**
** Returns void
**
*******************************************************************************/
void bta_av_suspend_cont (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
UINT8 err_code = p_data->str_msg.msg.hdr.err_code;
tBTA_AV_RECONFIG evt;
p_scb->started = FALSE;
p_scb->cong = FALSE;
if (err_code)
{
if (AVDT_ERR_CONNECT == err_code)
{
/* report failure */
evt.status = BTA_AV_FAIL;
(*bta_av_cb.p_cback)(BTA_AV_RECONFIG_EVT, (tBTA_AV *)&evt);
bta_av_ssm_execute(p_scb, BTA_AV_STR_DISC_FAIL_EVT, NULL);
}
else
{
APPL_TRACE_ERROR("suspend rejected, try close");
/* Disable suspend feature only with explicit rejection(not with timeout) */
if (err_code != AVDT_ERR_TIMEOUT)
{
p_scb->suspend_sup = FALSE;
}
/* drop the buffers queued in L2CAP */
L2CA_FlushChannel (p_scb->l2c_cid, L2CAP_FLUSH_CHANS_ALL);
AVDT_CloseReq(p_scb->avdt_handle);
}
}
else
{
APPL_TRACE_DEBUG("bta_av_suspend_cont calling AVDT_ReconfigReq");
/* reconfig the stream */
AVDT_ReconfigReq(p_scb->avdt_handle, p_scb->p_cap);
p_scb->p_cap->psc_mask = p_scb->cur_psc_mask;
}
}
/*******************************************************************************
**
** Function bta_av_rcfg_cfm
**
** Description if reconfigure is successful, report the event
** otherwise, close the stream.
**
** Returns void
**
*******************************************************************************/
void bta_av_rcfg_cfm (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
UINT8 err_code = p_data->str_msg.msg.hdr.err_code;
/*
APPL_TRACE_DEBUG("bta_av_rcfg_cfm");
*/
if (err_code)
{
APPL_TRACE_ERROR("reconfig rejected, try close");
/* Disable reconfiguration feature only with explicit rejection(not with timeout) */
if (err_code != AVDT_ERR_TIMEOUT)
{
p_scb->recfg_sup = FALSE;
}
/* started flag is FALSE when reconfigure command is sent */
/* drop the buffers queued in L2CAP */
L2CA_FlushChannel (p_scb->l2c_cid, L2CAP_FLUSH_CHANS_ALL);
AVDT_CloseReq(p_scb->avdt_handle);
}
else
{
/* update the codec info after rcfg cfm */
memcpy(p_scb->cfg.codec_info,p_data->str_msg.msg.reconfig_cfm.p_cfg->codec_info,AVDT_CODEC_SIZE);
/* take the SSM back to OPEN state */
bta_av_ssm_execute(p_scb, BTA_AV_STR_OPEN_OK_EVT, NULL);
}
}
/*******************************************************************************
**
** Function bta_av_rcfg_open
**
** Description AVDT is connected. open the stream with the new configuration
**
** Returns void
**
*******************************************************************************/
void bta_av_rcfg_open (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
UNUSED(p_data);
APPL_TRACE_DEBUG("bta_av_rcfg_open, num_disc_snks = %d", p_scb->num_disc_snks);
if (p_scb->num_disc_snks == 0)
{
/* Need to update call-out module so that it will be ready for discover */
p_scb->p_cos->stop(p_scb->hndl, p_scb->codec_type);
/* send avdtp discover request */
AVDT_DiscoverReq(p_scb->peer_addr, p_scb->sep_info, BTA_AV_NUM_SEPS, bta_av_dt_cback[p_scb->hdi]);
}
else
{
p_scb->codec_type = p_scb->p_cap->codec_info[BTA_AV_CODEC_TYPE_IDX];
memcpy(p_scb->cfg.codec_info, p_scb->p_cap->codec_info, AVDT_CODEC_SIZE);
/* we may choose to use a different SEP at reconfig.
* adjust the sep_idx now */
bta_av_adjust_seps_idx(p_scb, bta_av_get_scb_handle(p_scb, AVDT_TSEP_SRC));
/* open the stream with the new config */
p_scb->sep_info_idx = p_scb->rcfg_idx;
AVDT_OpenReq(p_scb->avdt_handle, p_scb->peer_addr,
p_scb->sep_info[p_scb->sep_info_idx].seid, p_scb->p_cap);
}
}
/*******************************************************************************
**
** Function bta_av_security_rej
**
** Description Send an AVDTP security reject.
**
** Returns void
**
*******************************************************************************/
void bta_av_security_rej (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
UNUSED(p_data);
AVDT_SecurityRsp(p_scb->avdt_handle, p_scb->avdt_label, AVDT_ERR_BAD_STATE,
NULL, 0);
}
/*******************************************************************************
**
** Function bta_av_chk_2nd_start
**
** Description check if this is 2nd stream and if it needs to be started.
** This function needs to be kept very similar to bta_av_chk_start
**
** Returns void
**
*******************************************************************************/
void bta_av_chk_2nd_start (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
tBTA_AV_SCB *p_scbi;
int i;
BOOLEAN new_started = FALSE;
UNUSED(p_data);
if ((p_scb->chnl == BTA_AV_CHNL_AUDIO) && (bta_av_cb.audio_open_cnt >= 2))
{
/* more than one audio channel is connected */
if (!(p_scb->role & BTA_AV_ROLE_SUSPEND_OPT))
{
/* this channel does not need to be reconfigured.
* if there is other channel streaming, start the stream now */
for(i=0; i<BTA_AV_NUM_STRS; i++)
{
p_scbi = bta_av_cb.p_scb[i];
if(p_scbi && p_scbi->chnl == BTA_AV_CHNL_AUDIO && p_scbi->co_started)
{
if (!new_started)
{
/* start the new stream */
new_started = TRUE;
bta_av_ssm_execute(p_scb, BTA_AV_AP_START_EVT, NULL);
}
/* may need to update the flush timeout of this already started stream */
if (p_scbi->co_started != bta_av_cb.audio_open_cnt)
{
p_scbi->co_started = bta_av_cb.audio_open_cnt;
L2CA_SetFlushTimeout(p_scbi->peer_addr, p_bta_av_cfg->p_audio_flush_to[p_scbi->co_started - 1] );
}
}
}
}
}
}
/*******************************************************************************
**
** Function bta_av_open_rc
**
** Description Send a message to main SM to open RC channel.
**
** Returns void
**
*******************************************************************************/
void bta_av_open_rc (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
tBTA_AV_START start;
APPL_TRACE_DEBUG("bta_av_open_rc use_rc: %d, wait: x%x role:x%x", p_scb->use_rc, p_scb->wait, p_scb->role);
if ((p_scb->wait & BTA_AV_WAIT_ROLE_SW_BITS) && (p_scb->q_tag == BTA_AV_Q_TAG_START))
{
/* waiting for role switch for some reason & the timer expires */
if (!bta_av_link_role_ok(p_scb, A2D_SET_ONE_BIT))
{
APPL_TRACE_ERROR ("failed to start streaming for role management reasons!!");
alarm_cancel(p_scb->avrc_ct_timer);
start.chnl = p_scb->chnl;
start.status = BTA_AV_FAIL_ROLE;
start.initiator = TRUE;
start.hndl = p_scb->hndl;
p_scb->wait &= ~BTA_AV_WAIT_ROLE_SW_BITS;
bta_av_cb.rs_idx = 0;
(*bta_av_cb.p_cback)(BTA_AV_START_EVT, (tBTA_AV *) &start);
}
else
{
/* role switch is done. continue to start streaming */
bta_av_cb.rs_idx = 0;
p_data->hdr.offset = BTA_AV_RS_OK;
bta_av_start_ok (p_scb, p_data);
}
return;
}
if(p_scb->use_rc == TRUE || (p_scb->role & BTA_AV_ROLE_AD_ACP) )
{
if(bta_av_cb.disc)
{
/* AVRC discover db is in use */
if(p_scb->rc_handle == BTA_AV_RC_HANDLE_NONE)
{
/* AVRC channel is not connected. delay a little bit */
if ((p_scb->wait & BTA_AV_WAIT_ROLE_SW_BITS) == 0) {
bta_sys_start_timer(p_scb->avrc_ct_timer,
BTA_AV_RC_DISC_TIME_VAL,
BTA_AV_AVRC_TIMER_EVT, p_scb->hndl);
} else {
p_scb->wait |= BTA_AV_WAIT_CHECK_RC;
}
}
}
else
{
/* use main SM for AVRC SDP activities */
bta_av_rc_disc((UINT8)(p_scb->hdi + 1));
}
}
else
{
if(BTA_AV_RC_HANDLE_NONE != p_scb->rc_handle)
{
/* the open API said that this handle does not want a RC connection.
* disconnect it now */
AVRC_Close(p_scb->rc_handle);
}
}
}
/*******************************************************************************
**
** Function bta_av_open_at_inc
**
** Description This function is called if API open is called by application
** while state-machine is at incoming state.
**
** Returns void
**
*******************************************************************************/
void bta_av_open_at_inc (tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
memcpy (&(p_scb->open_api), &(p_data->api_open), sizeof(tBTA_AV_API_OPEN));
if (p_scb->coll_mask & BTA_AV_COLL_INC_TMR)
{
p_scb->coll_mask |= BTA_AV_COLL_API_CALLED;
/* API open will be handled at timeout if SNK did not start signalling. */
/* API open will be ignored if SNK starts signalling. */
}
else
{
/* SNK did not start signalling, API was called N seconds timeout. */
/* We need to switch to INIT state and start opening connection. */
p_scb->coll_mask = 0;
bta_av_set_scb_sst_init(p_scb);
tBTA_AV_API_OPEN *p_buf =
(tBTA_AV_API_OPEN *)osi_malloc(sizeof(tBTA_AV_API_OPEN));
memcpy(p_buf, &(p_scb->open_api), sizeof(tBTA_AV_API_OPEN));
p_scb->skip_sdp = TRUE;
bta_sys_sendmsg(p_buf);
}
}
/*******************************************************************************
**
** Function bta_av_offload_req
**
** Description This function is called if application requests offload of
** a2dp audio.
**
** Returns void
**
*******************************************************************************/
void bta_av_offload_req(tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
tBTA_AV_STATUS status = BTA_AV_FAIL_RESOURCES;
UINT16 mtu = bta_av_chk_mtu(p_scb, p_scb->stream_mtu);
APPL_TRACE_DEBUG("%s stream %s, audio channels open %d", __func__,
p_scb->started ? "STARTED" : "STOPPED", bta_av_cb.audio_open_cnt);
/* Check if stream has already been started. */
/* Support offload if only one audio source stream is open. */
if (p_scb->started != TRUE) {
status = BTA_AV_FAIL_STREAM;
} else if (bta_av_cb.audio_open_cnt == 1 &&
p_scb->seps[p_scb->sep_idx].tsep == AVDT_TSEP_SRC &&
p_scb->chnl == BTA_AV_CHNL_AUDIO) {
bt_vendor_op_a2dp_offload_t a2dp_offload_start;
if (L2CA_GetConnectionConfig(p_scb->l2c_cid, &a2dp_offload_start.acl_data_size,
&a2dp_offload_start.remote_cid, &a2dp_offload_start.lm_handle)) {
APPL_TRACE_DEBUG("%s l2cmtu %d lcid 0x%02X rcid 0x%02X lm_handle 0x%02X", __func__,
a2dp_offload_start.acl_data_size, p_scb->l2c_cid,
a2dp_offload_start.remote_cid, a2dp_offload_start.lm_handle);
a2dp_offload_start.bta_av_handle = p_scb->hndl;
a2dp_offload_start.xmit_quota = BTA_AV_A2DP_OFFLOAD_XMIT_QUOTA;
a2dp_offload_start.stream_mtu = (mtu < p_scb->stream_mtu) ? mtu : p_scb->stream_mtu;
a2dp_offload_start.local_cid = p_scb->l2c_cid;
a2dp_offload_start.is_flushable = TRUE;
a2dp_offload_start.stream_source = ((UINT32)(p_scb->cfg.codec_info[1] | p_scb->cfg.codec_info[2]));
memcpy(a2dp_offload_start.codec_info, p_scb->cfg.codec_info,
sizeof(a2dp_offload_start.codec_info));
if (!vendor_get_interface()->send_command(
(vendor_opcode_t)BT_VND_OP_A2DP_OFFLOAD_START,
&a2dp_offload_start)) {
status = BTA_AV_SUCCESS;
p_scb->offload_start_pending = TRUE;
}
}
}
if (status != BTA_AV_SUCCESS)
(*bta_av_cb.p_cback)(BTA_AV_OFFLOAD_START_RSP_EVT, (tBTA_AV *)&status);
}
/*******************************************************************************
**
** Function bta_av_offload_rsp
**
** Description This function is called when the vendor lib responds to
** BT_VND_OP_A2DP_OFFLOAD_START.
**
** Returns void
**
*******************************************************************************/
void bta_av_offload_rsp(tBTA_AV_SCB *p_scb, tBTA_AV_DATA *p_data)
{
tBTA_AV_STATUS status = p_data->api_status_rsp.status;
APPL_TRACE_DEBUG("%s stream %s status %s", __func__,
p_scb->started ? "STARTED" : "STOPPED",
status ? "FAIL" : "SUCCESS");
/* Check if stream has already been started. */
if (status == BTA_AV_SUCCESS && p_scb->started != TRUE) {
status = BTA_AV_FAIL_STREAM;
}
p_scb->offload_start_pending = FALSE;
(*bta_av_cb.p_cback)(BTA_AV_OFFLOAD_START_RSP_EVT, (tBTA_AV *)&status);
}
#endif /* BTA_AV_INCLUDED */