bta/av/bta_av_aact.cc

   1 /******************************************************************************
   2  *
   3  *  Copyright 2004-2012 Broadcom Corporation
   4  *
   5  *  Licensed under the Apache License, Version 2.0 (the "License");
   6  *  you may not use this file except in compliance with the License.
   7  *  You may obtain a copy of the License at:
   8  *
   9  *  http://www.apache.org/licenses/LICENSE-2.0
  10  *
  11  *  Unless required by applicable law or agreed to in writing, software
  12  *  distributed under the License is distributed on an "AS IS" BASIS,
  13  *  WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  14  *  See the License for the specific language governing permissions and
  15  *  limitations under the License.
  16  *
  17  ******************************************************************************/
  18
  19 /******************************************************************************
  20  *
  21  *  This file contains action functions for advanced audio/video stream
  22  *  state machine. these functions are shared by both audio and video
  23  *  streams.
  24  *
  25  ******************************************************************************/
  26
  27 #define LOG_TAG "bt_bta_av"
  28
  29 #include <base/strings/stringprintf.h>
  30 #include <cstdint>
  31 #include <cstring>
  32 #include <vector>
  33
  34 #include "bt_target.h"  // Must be first to define build configuration
  35
  36 #include "bta/av/bta_av_int.h"
  37 #include "bta/include/bta_ar_api.h"
  38 #include "bta/include/bta_av_co.h"
  39 #include "btif/avrcp/avrcp_service.h"
  40 #include "btif/include/btif_av_co.h"
  41 #include "btif/include/btif_config.h"
  42 #include "btif/include/btif_storage.h"
  43 #include "device/include/interop.h"
  44 #include "main/shim/dumpsys.h"
  45 #include "osi/include/log.h"
  46 #include "osi/include/osi.h"
  47 #include "osi/include/properties.h"
  48 #include "stack/include/a2dp_sbc.h"
  49 #include "stack/include/acl_api.h"
  50 #include "stack/include/btm_api.h"
  51 #include "stack/include/btm_client_interface.h"
  52 #include "stack/include/l2c_api.h"
  53 #include "types/hci_role.h"
  54
  55 namespace {
  56
  57 constexpr char kBtmLogTag[] = "A2DP";
  58
  59 }
  60
  61 /*****************************************************************************
  62  *  Constants
  63  ****************************************************************************/
  64
  65 /* the delay time in milliseconds to start service discovery on AVRCP */
  66 #ifndef BTA_AV_RC_DISC_TIME_VAL
  67 #define BTA_AV_RC_DISC_TIME_VAL 3500
  68 #endif
  69
  70 /* the timer in milliseconds to guard against link busy and AVDT_CloseReq failed
  71  * to be sent */
  72 #ifndef BTA_AV_CLOSE_REQ_TIME_VAL
  73 #define BTA_AV_CLOSE_REQ_TIME_VAL 4000
  74 #endif
  75
  76 /* number to retry on reconfigure failure - some headsets requirs this number to
  77  * be more than 1 */
  78 #ifndef BTA_AV_RECONFIG_RETRY
  79 #define BTA_AV_RECONFIG_RETRY 6
  80 #endif
  81
  82 /* ACL quota we are letting FW use for A2DP Offload Tx. */
  83 #define BTA_AV_A2DP_OFFLOAD_XMIT_QUOTA 4
  84
  85 static void bta_av_offload_codec_builder(tBTA_AV_SCB* p_scb,
  86                                          tBT_A2DP_OFFLOAD* p_a2dp_offload);
  87
  88 /* state machine states */
  89 enum {
  90   BTA_AV_INIT_SST,
  91   BTA_AV_INCOMING_SST,
  92   BTA_AV_OPENING_SST,
  93   BTA_AV_OPEN_SST,
  94   BTA_AV_RCFG_SST,
  95   BTA_AV_CLOSING_SST
  96 };
  97
  98 /* the call out functions for audio stream */
  99 const tBTA_AV_CO_FUNCTS bta_av_a2dp_cos = {bta_av_co_audio_init,
 100                                            bta_av_co_audio_disc_res,
 101                                            bta_av_co_audio_getconfig,
 102                                            bta_av_co_audio_setconfig,
 103                                            bta_av_co_audio_open,
 104                                            bta_av_co_audio_close,
 105                                            bta_av_co_audio_start,
 106                                            bta_av_co_audio_stop,
 107                                            bta_av_co_audio_source_data_path,
 108                                            bta_av_co_audio_delay,
 109                                            bta_av_co_audio_update_mtu,
 110                                            bta_av_co_get_scmst_info};
 111
 112 /* these tables translate AVDT events to SSM events */
 113 static const uint16_t bta_av_stream_evt_ok[] = {
 114     BTA_AV_STR_DISC_OK_EVT,      /* AVDT_DISCOVER_CFM_EVT */
 115     BTA_AV_STR_GETCAP_OK_EVT,    /* AVDT_GETCAP_CFM_EVT */
 116     BTA_AV_STR_OPEN_OK_EVT,      /* AVDT_OPEN_CFM_EVT */
 117     BTA_AV_STR_OPEN_OK_EVT,      /* AVDT_OPEN_IND_EVT */
 118     BTA_AV_STR_CONFIG_IND_EVT,   /* AVDT_CONFIG_IND_EVT */
 119     BTA_AV_STR_START_OK_EVT,     /* AVDT_START_CFM_EVT */
 120     BTA_AV_STR_START_OK_EVT,     /* AVDT_START_IND_EVT */
 121     BTA_AV_STR_SUSPEND_CFM_EVT,  /* AVDT_SUSPEND_CFM_EVT */
 122     BTA_AV_STR_SUSPEND_CFM_EVT,  /* AVDT_SUSPEND_IND_EVT */
 123     BTA_AV_STR_CLOSE_EVT,        /* AVDT_CLOSE_CFM_EVT */
 124     BTA_AV_STR_CLOSE_EVT,        /* AVDT_CLOSE_IND_EVT */
 125     BTA_AV_STR_RECONFIG_CFM_EVT, /* AVDT_RECONFIG_CFM_EVT */
 126     0,                           /* AVDT_RECONFIG_IND_EVT */
 127     BTA_AV_STR_SECURITY_CFM_EVT, /* AVDT_SECURITY_CFM_EVT */
 128     BTA_AV_STR_SECURITY_IND_EVT, /* AVDT_SECURITY_IND_EVT */
 129     BTA_AV_STR_WRITE_CFM_EVT,    /* AVDT_WRITE_CFM_EVT */
 130     BTA_AV_AVDT_CONNECT_EVT,     /* AVDT_CONNECT_IND_EVT */
 131     BTA_AV_AVDT_DISCONNECT_EVT,  /* AVDT_DISCONNECT_IND_EVT */
 132     BTA_AV_AVDT_RPT_CONN_EVT, /* AVDT_REPORT_CONN_EVT */
 133     BTA_AV_AVDT_RPT_CONN_EVT, /* AVDT_REPORT_DISCONN_EVT */
 134     BTA_AV_AVDT_DELAY_RPT_EVT, /* AVDT_DELAY_REPORT_EVT */
 135     BTA_AV_AVDT_DELAY_RPT_CFM_EVT, /* AVDT_DELAY_REPORT_CFM_EVT */
 136 };
 137
 138 static const uint16_t bta_av_stream_evt_fail[] = {
 139     BTA_AV_STR_DISC_FAIL_EVT,    /* AVDT_DISCOVER_CFM_EVT */
 140     BTA_AV_STR_GETCAP_FAIL_EVT,  /* AVDT_GETCAP_CFM_EVT */
 141     BTA_AV_STR_OPEN_FAIL_EVT,    /* AVDT_OPEN_CFM_EVT */
 142     BTA_AV_STR_OPEN_OK_EVT,      /* AVDT_OPEN_IND_EVT */
 143     BTA_AV_STR_CONFIG_IND_EVT,   /* AVDT_CONFIG_IND_EVT */
 144     BTA_AV_STR_START_FAIL_EVT,   /* AVDT_START_CFM_EVT */
 145     BTA_AV_STR_START_OK_EVT,     /* AVDT_START_IND_EVT */
 146     BTA_AV_STR_SUSPEND_CFM_EVT,  /* AVDT_SUSPEND_CFM_EVT */
 147     BTA_AV_STR_SUSPEND_CFM_EVT,  /* AVDT_SUSPEND_IND_EVT */
 148     BTA_AV_STR_CLOSE_EVT,        /* AVDT_CLOSE_CFM_EVT */
 149     BTA_AV_STR_CLOSE_EVT,        /* AVDT_CLOSE_IND_EVT */
 150     BTA_AV_STR_RECONFIG_CFM_EVT, /* AVDT_RECONFIG_CFM_EVT */
 151     0,                           /* AVDT_RECONFIG_IND_EVT */
 152     BTA_AV_STR_SECURITY_CFM_EVT, /* AVDT_SECURITY_CFM_EVT */
 153     BTA_AV_STR_SECURITY_IND_EVT, /* AVDT_SECURITY_IND_EVT */
 154     BTA_AV_STR_WRITE_CFM_EVT,    /* AVDT_WRITE_CFM_EVT */
 155     BTA_AV_AVDT_CONNECT_EVT,     /* AVDT_CONNECT_IND_EVT */
 156     BTA_AV_AVDT_DISCONNECT_EVT,  /* AVDT_DISCONNECT_IND_EVT */
 157     BTA_AV_AVDT_RPT_CONN_EVT, /* AVDT_REPORT_CONN_EVT */
 158     BTA_AV_AVDT_RPT_CONN_EVT, /* AVDT_REPORT_DISCONN_EVT */
 159     BTA_AV_AVDT_DELAY_RPT_EVT, /* AVDT_DELAY_REPORT_EVT */
 160     BTA_AV_AVDT_DELAY_RPT_CFM_EVT, /* AVDT_DELAY_REPORT_CFM_EVT */
 161 };
 162
 163 /***********************************************
 164  *
 165  * Function         bta_get_scb_handle
 166  *
 167  * Description      gives the registered AVDT handle.by checking with sep_type.
 168  *
 169  *
 170  * Returns          void
 171  **********************************************/
 172 static uint8_t bta_av_get_scb_handle(tBTA_AV_SCB* p_scb, uint8_t local_sep) {
 173   for (int i = 0; i < BTAV_A2DP_CODEC_INDEX_MAX; i++) {
 174     if ((p_scb->seps[i].tsep == local_sep) &&
 175         A2DP_CodecTypeEquals(p_scb->seps[i].codec_info,
 176                              p_scb->cfg.codec_info)) {
 177       return (p_scb->seps[i].av_handle);
 178     }
 179   }
 180   APPL_TRACE_DEBUG("%s: local sep_type %d not found", __func__, local_sep)
 181   return 0; /* return invalid handle */
 182 }
 183
 184 /***********************************************
 185  *
 186  * Function         bta_av_get_scb_sep_type
 187  *
 188  * Description      gives the sep type by cross-checking with AVDT handle
 189  *
 190  *
 191  * Returns          void
 192  **********************************************/
 193 static uint8_t bta_av_get_scb_sep_type(tBTA_AV_SCB* p_scb,
 194                                        uint8_t tavdt_handle) {
 195   for (int i = 0; i < BTAV_A2DP_CODEC_INDEX_MAX; i++) {
 196     if (p_scb->seps[i].av_handle == tavdt_handle) return (p_scb->seps[i].tsep);
 197   }
 198   APPL_TRACE_DEBUG("%s: avdt_handle %d not found", __func__, tavdt_handle)
 199   return AVDT_TSEP_INVALID;
 200 }
 201
 202 /*******************************************************************************
 203  *
 204  * Function         bta_av_save_addr
 205  *
 206  * Description      copy the bd_addr and maybe reset the supported flags
 207  *
 208  *
 209  * Returns          void
 210  *
 211  ******************************************************************************/
 212 static void bta_av_save_addr(tBTA_AV_SCB* p_scb, const RawAddress& bd_addr) {
 213   APPL_TRACE_DEBUG("%s: peer=%s recfg_sup:%d, suspend_sup:%d", __func__,
 214                    bd_addr.ToString().c_str(), p_scb->recfg_sup,
 215                    p_scb->suspend_sup);
 216   if (p_scb->PeerAddress() != bd_addr) {
 217     LOG_INFO("%s: reset flags old_addr=%s new_addr=%s", __func__,
 218              p_scb->PeerAddress().ToString().c_str(),
 219              bd_addr.ToString().c_str());
 220     /* a new addr, reset the supported flags */
 221     p_scb->recfg_sup = true;
 222     p_scb->suspend_sup = true;
 223   }
 224
 225   /* do this copy anyway, just in case the first addr matches
 226    * the control block one by accident */
 227   p_scb->OnConnected(bd_addr);
 228 }
 229
 230 /*******************************************************************************
 231  *
 232  * Function         notify_start_failed
 233  *
 234  * Description      notify up-layer AV start failed
 235  *
 236  *
 237  * Returns          void
 238  *
 239  ******************************************************************************/
 240 static void notify_start_failed(tBTA_AV_SCB* p_scb) {
 241   LOG_ERROR("%s: peer %s role:0x%x bta_channel:%d bta_handle:0x%x", __func__,
 242             p_scb->PeerAddress().ToString().c_str(), p_scb->role, p_scb->chnl,
 243             p_scb->hndl);
 244   tBTA_AV_START start;
 245   /* if start failed, clear role */
 246   p_scb->role &= ~BTA_AV_ROLE_START_INT;
 247   start.chnl = p_scb->chnl;
 248   start.status = BTA_AV_FAIL;
 249   start.initiator = true;
 250   start.hndl = p_scb->hndl;
 251
 252   tBTA_AV bta_av_data;
 253   bta_av_data.start = start;
 254   (*bta_av_cb.p_cback)(BTA_AV_START_EVT, &bta_av_data);
 255 }
 256
 257 /*******************************************************************************
 258  *
 259  * Function         bta_av_st_rc_timer
 260  *
 261  * Description      start the AVRC timer if no RC connection & CT is supported &
 262  *                  RC is used or
 263  *                  as ACP (we do not really know if we want AVRC)
 264  *
 265  * Returns          void
 266  *
 267  ******************************************************************************/
 268 void bta_av_st_rc_timer(tBTA_AV_SCB* p_scb, UNUSED_ATTR tBTA_AV_DATA* p_data) {
 269   APPL_TRACE_DEBUG("%s: rc_handle:%d, use_rc: %d", __func__, p_scb->rc_handle,
 270                    p_scb->use_rc);
 271   /* for outgoing RC connection as INT/CT */
 272   if ((p_scb->rc_handle == BTA_AV_RC_HANDLE_NONE) &&
 273       /* (bta_av_cb.features & BTA_AV_FEAT_RCCT) && */
 274       (p_scb->use_rc || (p_scb->role & BTA_AV_ROLE_AD_ACP))) {
 275     if ((p_scb->wait & BTA_AV_WAIT_ROLE_SW_BITS) == 0) {
 276       bta_sys_start_timer(p_scb->avrc_ct_timer, BTA_AV_RC_DISC_TIME_VAL,
 277                           BTA_AV_AVRC_TIMER_EVT, p_scb->hndl);
 278     } else {
 279       p_scb->wait |= BTA_AV_WAIT_CHECK_RC;
 280     }
 281   }
 282 }
 283
 284 /*******************************************************************************
 285  *
 286  * Function         bta_av_next_getcap
 287  *
 288  * Description      The function gets the capabilities of the next available
 289  *                  stream found in the discovery results.
 290  *
 291  * Returns          true if we sent request to AVDT, false otherwise.
 292  *
 293  ******************************************************************************/
 294 static bool bta_av_next_getcap(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
 295   int i;
 296   bool sent_cmd = false;
 297   uint16_t uuid_int = p_scb->uuid_int;
 298   uint8_t sep_requested = 0;
 299
 300   if (uuid_int == UUID_SERVCLASS_AUDIO_SOURCE)
 301     sep_requested = AVDT_TSEP_SNK;
 302   else if (uuid_int == UUID_SERVCLASS_AUDIO_SINK)
 303     sep_requested = AVDT_TSEP_SRC;
 304
 305   for (i = p_scb->sep_info_idx; i < p_scb->num_seps; i++) {
 306     /* steam not in use, is a sink, and is the right media type (audio/video) */
 307     if ((!p_scb->sep_info[i].in_use) &&
 308         (p_scb->sep_info[i].tsep == sep_requested) &&
 309         (p_scb->sep_info[i].media_type == p_scb->media_type)) {
 310       p_scb->sep_info_idx = i;
 311
 312       /* we got a stream; get its capabilities */
 313       bool get_all_cap = (p_scb->AvdtpVersion() >= AVDT_VERSION_1_3) &&
 314                          (A2DP_GetAvdtpVersion() >= AVDT_VERSION_1_3);
 315       AVDT_GetCapReq(p_scb->PeerAddress(), p_scb->hdi, p_scb->sep_info[i].seid,
 316                      &p_scb->peer_cap, &bta_av_proc_stream_evt, get_all_cap);
 317       sent_cmd = true;
 318       break;
 319     }
 320   }
 321
 322   /* if no streams available then stream open fails */
 323   if (!sent_cmd) {
 324     APPL_TRACE_ERROR("%s: BTA_AV_STR_GETCAP_FAIL_EVT: peer_addr=%s", __func__,
 325                      p_scb->PeerAddress().ToString().c_str());
 326     bta_av_ssm_execute(p_scb, BTA_AV_STR_GETCAP_FAIL_EVT, p_data);
 327   }
 328
 329   return sent_cmd;
 330 }
 331
 332 /*******************************************************************************
 333  *
 334  * Function         bta_av_proc_stream_evt
 335  *
 336  * Description      Utility function to compose stream events.
 337  *
 338  * Returns          void
 339  *
 340  ******************************************************************************/
 341 void bta_av_proc_stream_evt(uint8_t handle, const RawAddress& bd_addr,
 342                             uint8_t event, tAVDT_CTRL* p_data,
 343                             uint8_t scb_index) {
 344   CHECK_LT(scb_index, BTA_AV_NUM_STRS);
 345   tBTA_AV_SCB* p_scb = bta_av_cb.p_scb[scb_index];
 346   uint16_t sec_len = 0;
 347
 348   APPL_TRACE_EVENT(
 349       "%s: peer_address: %s avdt_handle: %d event=0x%x scb_index=%d p_scb=%p",
 350       __func__, bd_addr.ToString().c_str(), handle, event, scb_index, p_scb);
 351
 352   if (p_data) {
 353     if (event == AVDT_SECURITY_IND_EVT) {
 354       sec_len = (p_data->security_ind.len < BTA_AV_SECURITY_MAX_LEN)
 355                     ? p_data->security_ind.len
 356                     : BTA_AV_SECURITY_MAX_LEN;
 357     } else if (event == AVDT_SECURITY_CFM_EVT && p_data->hdr.err_code == 0) {
 358       sec_len = (p_data->security_cfm.len < BTA_AV_SECURITY_MAX_LEN)
 359                     ? p_data->security_cfm.len
 360                     : BTA_AV_SECURITY_MAX_LEN;
 361     }
 362   }
 363
 364   if (p_scb) {
 365     tBTA_AV_STR_MSG* p_msg =
 366         (tBTA_AV_STR_MSG*)osi_malloc(sizeof(tBTA_AV_STR_MSG) + sec_len);
 367
 368     /* copy event data, bd addr, and handle to event message buffer */
 369     p_msg->hdr.offset = 0;
 370
 371     p_msg->bd_addr = bd_addr;
 372     p_msg->scb_index = scb_index;
 373     APPL_TRACE_EVENT("%s: stream event bd_addr: %s scb_index: %u", __func__,
 374                      p_msg->bd_addr.ToString().c_str(), scb_index);
 375
 376     if (p_data != NULL) {
 377       memcpy(&p_msg->msg, p_data, sizeof(tAVDT_CTRL));
 378       /* copy config params to event message buffer */
 379       switch (event) {
 380         case AVDT_CONFIG_IND_EVT:
 381           p_msg->cfg = *p_data->config_ind.p_cfg;
 382           break;
 383
 384         case AVDT_SECURITY_IND_EVT:
 385           p_msg->msg.security_ind.p_data = (uint8_t*)(p_msg + 1);
 386           memcpy(p_msg->msg.security_ind.p_data, p_data->security_ind.p_data,
 387                  sec_len);
 388           break;
 389
 390         case AVDT_SECURITY_CFM_EVT:
 391           p_msg->msg.security_cfm.p_data = (uint8_t*)(p_msg + 1);
 392           if (p_data->hdr.err_code == 0) {
 393             memcpy(p_msg->msg.security_cfm.p_data, p_data->security_cfm.p_data,
 394                    sec_len);
 395           }
 396           break;
 397
 398         case AVDT_SUSPEND_IND_EVT:
 399           p_msg->msg.hdr.err_code = 0;
 400           break;
 401
 402         case AVDT_CONNECT_IND_EVT:
 403           p_scb->recfg_sup = true;
 404           p_scb->suspend_sup = true;
 405           break;
 406
 407         default:
 408           break;
 409       }
 410     } else {
 411       p_msg->msg.hdr.err_code = 0;
 412     }
 413
 414     /* look up application event */
 415     if ((p_data == NULL) || (p_data->hdr.err_code == 0)) {
 416       p_msg->hdr.event = bta_av_stream_evt_ok[event];
 417     } else {
 418       p_msg->hdr.event = bta_av_stream_evt_fail[event];
 419     }
 420
 421     p_msg->initiator = false;
 422     if (event == AVDT_SUSPEND_CFM_EVT) p_msg->initiator = true;
 423
 424     APPL_TRACE_VERBOSE("%s: bta_handle:0x%x avdt_handle:%d", __func__,
 425                        p_scb->hndl, handle);
 426     p_msg->hdr.layer_specific = p_scb->hndl;
 427     p_msg->handle = handle;
 428     p_msg->avdt_event = event;
 429     bta_sys_sendmsg(p_msg);
 430   }
 431
 432   if (p_data) {
 433     bta_av_conn_cback(handle, bd_addr, event, p_data, scb_index);
 434   } else {
 435     APPL_TRACE_ERROR("%s: p_data is null", __func__);
 436   }
 437 }
 438
 439 /*******************************************************************************
 440  *
 441  * Function         bta_av_sink_data_cback
 442  *
 443  * Description      This is the AVDTP callback function for sink stream events.
 444  *
 445  * Returns          void
 446  *
 447  ******************************************************************************/
 448 void bta_av_sink_data_cback(uint8_t handle, BT_HDR* p_pkt, uint32_t time_stamp,
 449                             uint8_t m_pt) {
 450   int index = 0;
 451   tBTA_AV_SCB* p_scb;
 452   APPL_TRACE_DEBUG(
 453       "%s: avdt_handle: %d pkt_len=0x%x  offset = 0x%x "
 454       "number of frames 0x%x sequence number 0x%x",
 455       __func__, handle, p_pkt->len, p_pkt->offset,
 456       *((uint8_t*)(p_pkt + 1) + p_pkt->offset), p_pkt->layer_specific);
 457   /* Get SCB and correct sep type */
 458   for (index = 0; index < BTA_AV_NUM_STRS; index++) {
 459     p_scb = bta_av_cb.p_scb[index];
 460     if ((p_scb->avdt_handle == handle) &&
 461         (p_scb->seps[p_scb->sep_idx].tsep == AVDT_TSEP_SNK)) {
 462       break;
 463     }
 464   }
 465   if (index == BTA_AV_NUM_STRS) {
 466     /* cannot find correct handler */
 467     osi_free(p_pkt);
 468     return;
 469   }
 470   p_pkt->event = BTA_AV_SINK_MEDIA_DATA_EVT;
 471   p_scb->seps[p_scb->sep_idx].p_app_sink_data_cback(
 472       p_scb->PeerAddress(), BTA_AV_SINK_MEDIA_DATA_EVT, (tBTA_AV_MEDIA*)p_pkt);
 473   /* Free the buffer: a copy of the packet has been delivered */
 474   osi_free(p_pkt);
 475 }
 476
 477 /*******************************************************************************
 478  *
 479  * Function         bta_av_a2dp_sdp_cback
 480  *
 481  * Description      A2DP service discovery callback.
 482  *
 483  * Returns          void
 484  *
 485  ******************************************************************************/
 486 static void bta_av_a2dp_sdp_cback(bool found, tA2DP_Service* p_service,
 487                                   const RawAddress& peer_address) {
 488   APPL_TRACE_DEBUG("%s: peer %s : found=%s", __func__,
 489                    peer_address.ToString().c_str(), (found) ? "true" : "false");
 490
 491   tBTA_AV_SCB* p_scb = NULL;
 492   if (peer_address != RawAddress::kEmpty) {
 493     p_scb = bta_av_addr_to_scb(peer_address);
 494   }
 495   if (p_scb == NULL) {
 496     p_scb = bta_av_hndl_to_scb(bta_av_cb.handle);
 497   }
 498   if (p_scb == NULL) {
 499     APPL_TRACE_ERROR("%s: no scb found for SDP handle(0x%x)", __func__,
 500                      bta_av_cb.handle);
 501     return;
 502   }
 503   if (bta_av_cb.handle != p_scb->hndl) {
 504     APPL_TRACE_WARNING("%s: SDP bta_handle expected=0x%x processing=0x%x",
 505                        __func__, bta_av_cb.handle, p_scb->hndl);
 506   }
 507
 508   if (!found) {
 509     APPL_TRACE_ERROR("%s: peer %s A2DP service discovery failed", __func__,
 510                      p_scb->PeerAddress().ToString().c_str());
 511   }
 512   APPL_TRACE_DEBUG("%s: peer %s found=%s", __func__,
 513                    p_scb->PeerAddress().ToString().c_str(),
 514                    (found) ? "true" : "false");
 515
 516   tBTA_AV_SDP_RES* p_msg =
 517       (tBTA_AV_SDP_RES*)osi_malloc(sizeof(tBTA_AV_SDP_RES));
 518   if (found) {
 519     p_msg->hdr.event = BTA_AV_SDP_DISC_OK_EVT;
 520   } else {
 521     p_msg->hdr.event = BTA_AV_SDP_DISC_FAIL_EVT;
 522     APPL_TRACE_ERROR("%s: BTA_AV_SDP_DISC_FAIL_EVT: peer_addr=%s", __func__,
 523                      p_scb->PeerAddress().ToString().c_str());
 524   }
 525   if (found && (p_service != NULL)) {
 526     p_scb->SetAvdtpVersion(p_service->avdt_version);
 527     if (p_service->avdt_version != 0) {
 528       if (btif_config_set_bin(p_scb->PeerAddress().ToString(),
 529                               AVDTP_VERSION_CONFIG_KEY,
 530                               (const uint8_t*)&p_service->avdt_version,
 531                               sizeof(p_service->avdt_version))) {
 532         btif_config_save();
 533       } else {
 534         APPL_TRACE_WARNING("%s: Failed to store peer AVDTP version for %s",
 535                            __func__, p_scb->PeerAddress().ToString().c_str());
 536       }
 537     }
 538   } else {
 539     p_scb->SetAvdtpVersion(0);
 540   }
 541   p_msg->hdr.layer_specific = p_scb->hndl;
 542
 543   bta_sys_sendmsg(p_msg);
 544 }
 545
 546 /*******************************************************************************
 547  *
 548  * Function         bta_av_adjust_seps_idx
 549  *
 550  * Description      adjust the sep_idx
 551  *
 552  * Returns
 553  *
 554  ******************************************************************************/
 555 static void bta_av_adjust_seps_idx(tBTA_AV_SCB* p_scb, uint8_t avdt_handle) {
 556   APPL_TRACE_DEBUG("%s: codec: %s", __func__,
 557                    A2DP_CodecName(p_scb->cfg.codec_info));
 558   for (int i = 0; i < BTAV_A2DP_CODEC_INDEX_MAX; i++) {
 559     APPL_TRACE_DEBUG("%s: avdt_handle: %d codec: %s", __func__,
 560                      p_scb->seps[i].av_handle,
 561                      A2DP_CodecName(p_scb->seps[i].codec_info));
 562     if (p_scb->seps[i].av_handle && (p_scb->seps[i].av_handle == avdt_handle) &&
 563         A2DP_CodecTypeEquals(p_scb->seps[i].codec_info,
 564                              p_scb->cfg.codec_info)) {
 565       p_scb->sep_idx = i;
 566       p_scb->avdt_handle = p_scb->seps[i].av_handle;
 567       break;
 568     }
 569   }
 570 }
 571
 572 /*******************************************************************************
 573  *
 574  * Function         bta_av_switch_role
 575  *
 576  * Description      Switch role was not started and a timer was started.
 577  *                  another attempt to switch role now - still opening.
 578  *
 579  * Returns          void
 580  *
 581  ******************************************************************************/
 582 void bta_av_switch_role(tBTA_AV_SCB* p_scb, UNUSED_ATTR tBTA_AV_DATA* p_data) {
 583   tBTA_AV_RS_RES switch_res = BTA_AV_RS_NONE;
 584   tBTA_AV_API_OPEN* p_buf = &p_scb->q_info.open;
 585
 586   APPL_TRACE_DEBUG("%s: peer %s wait:0x%x", __func__,
 587                    p_scb->PeerAddress().ToString().c_str(), p_scb->wait);
 588   if (p_scb->wait & BTA_AV_WAIT_ROLE_SW_RES_START)
 589     p_scb->wait |= BTA_AV_WAIT_ROLE_SW_RETRY;
 590
 591   /* clear the masks set when the timer is started */
 592   p_scb->wait &=
 593       ~(BTA_AV_WAIT_ROLE_SW_RES_OPEN | BTA_AV_WAIT_ROLE_SW_RES_START);
 594
 595   if (p_scb->q_tag == BTA_AV_Q_TAG_OPEN) {
 596     if (bta_av_switch_if_needed(p_scb) ||
 597         !bta_av_link_role_ok(p_scb, A2DP_SET_MULTL_BIT)) {
 598       p_scb->wait |= BTA_AV_WAIT_ROLE_SW_RES_OPEN;
 599     } else {
 600       /* this should not happen in theory. Just in case...
 601        * continue to do_disc_a2dp */
 602       switch_res = BTA_AV_RS_DONE;
 603     }
 604   } else {
 605     /* report failure on OPEN */
 606     APPL_TRACE_ERROR("%s: peer %s role switch failed (wait=0x%x)", __func__,
 607                      p_scb->PeerAddress().ToString().c_str(), p_scb->wait);
 608     switch_res = BTA_AV_RS_FAIL;
 609   }
 610
 611   if (switch_res != BTA_AV_RS_NONE) {
 612     if (bta_av_cb.rs_idx == (p_scb->hdi + 1)) {
 613       bta_av_cb.rs_idx = 0;
 614     }
 615     p_scb->wait &= ~BTA_AV_WAIT_ROLE_SW_RETRY;
 616     p_scb->q_tag = 0;
 617     p_buf->switch_res = switch_res;
 618     bta_av_do_disc_a2dp(p_scb, (tBTA_AV_DATA*)p_buf);
 619   }
 620 }
 621
 622 /*******************************************************************************
 623  *
 624  * Function         bta_av_role_res
 625  *
 626  * Description      Handle the role changed event
 627  *
 628  *
 629  * Returns          void
 630  *
 631  ******************************************************************************/
 632 void bta_av_role_res(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
 633   bool initiator = false;
 634
 635   APPL_TRACE_DEBUG("%s: peer %s q_tag:%d, wait:0x%x, role:0x%x", __func__,
 636                    p_scb->PeerAddress().ToString().c_str(), p_scb->q_tag,
 637                    p_scb->wait, p_scb->role);
 638   if (p_scb->role & BTA_AV_ROLE_START_INT) initiator = true;
 639
 640   if (p_scb->q_tag == BTA_AV_Q_TAG_START) {
 641     if (p_scb->wait & BTA_AV_WAIT_ROLE_SW_STARTED) {
 642       p_scb->wait &= ~BTA_AV_WAIT_ROLE_SW_BITS;
 643       if (p_data->role_res.hci_status != HCI_SUCCESS) {
 644         p_scb->role &= ~BTA_AV_ROLE_START_INT;
 645         bta_sys_idle(BTA_ID_AV, bta_av_cb.audio_open_cnt, p_scb->PeerAddress());
 646         /* start failed because of role switch. */
 647         tBTA_AV_START start;
 648         start.chnl = p_scb->chnl;
 649         start.status = BTA_AV_FAIL_ROLE;
 650         start.hndl = p_scb->hndl;
 651         start.initiator = initiator;
 652         tBTA_AV bta_av_data;
 653         bta_av_data.start = start;
 654         (*bta_av_cb.p_cback)(BTA_AV_START_EVT, &bta_av_data);
 655       } else {
 656         bta_av_start_ok(p_scb, p_data);
 657       }
 658     } else if (p_scb->wait & BTA_AV_WAIT_ROLE_SW_RES_START)
 659       p_scb->wait |= BTA_AV_WAIT_ROLE_SW_FAILED;
 660   } else if (p_scb->q_tag == BTA_AV_Q_TAG_OPEN) {
 661     if (p_scb->wait & BTA_AV_WAIT_ROLE_SW_RES_OPEN) {
 662       p_scb->role &= ~BTA_AV_ROLE_START_INT;
 663       p_scb->wait &= ~BTA_AV_WAIT_ROLE_SW_BITS;
 664
 665       if (p_data->role_res.hci_status != HCI_SUCCESS) {
 666         /* Open failed because of role switch. */
 667         tBTA_AV_OPEN av_open;
 668         av_open.bd_addr = p_scb->PeerAddress();
 669         av_open.chnl = p_scb->chnl;
 670         av_open.hndl = p_scb->hndl;
 671         av_open.status = BTA_AV_FAIL_ROLE;
 672         if (p_scb->seps[p_scb->sep_idx].tsep == AVDT_TSEP_SRC) {
 673           av_open.sep = AVDT_TSEP_SNK;
 674         } else if (p_scb->seps[p_scb->sep_idx].tsep == AVDT_TSEP_SNK) {
 675           av_open.sep = AVDT_TSEP_SRC;
 676         }
 677         tBTA_AV bta_av_data;
 678         bta_av_data.open = av_open;
 679         (*bta_av_cb.p_cback)(BTA_AV_OPEN_EVT, &bta_av_data);
 680       } else {
 681         /* Continue av open process */
 682         p_scb->q_info.open.switch_res = BTA_AV_RS_DONE;
 683         bta_av_do_disc_a2dp(p_scb, (tBTA_AV_DATA*)&(p_scb->q_info.open));
 684       }
 685     } else {
 686       APPL_TRACE_WARNING(
 687           "%s: peer %s unexpected role switch event: q_tag = %d wait = 0x%x",
 688           __func__, p_scb->PeerAddress().ToString().c_str(), p_scb->q_tag,
 689           p_scb->wait);
 690     }
 691   }
 692
 693   APPL_TRACE_DEBUG("%s: peer %s wait:0x%x, role:0x%x", __func__,
 694                    p_scb->PeerAddress().ToString().c_str(), p_scb->wait,
 695                    p_scb->role);
 696 }
 697
 698 /*******************************************************************************
 699  *
 700  * Function         bta_av_delay_co
 701  *
 702  * Description      Call the delay call-out function to report the delay report
 703  *                  from SNK
 704  *
 705  * Returns          void
 706  *
 707  ******************************************************************************/
 708 void bta_av_delay_co(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
 709   APPL_TRACE_DEBUG("%s: peer %s bta_handle:0x%x delay:%d", __func__,
 710                    p_scb->PeerAddress().ToString().c_str(), p_scb->hndl,
 711                    p_data->str_msg.msg.delay_rpt_cmd.delay);
 712   p_scb->p_cos->delay(p_scb->hndl, p_scb->PeerAddress(),
 713                       p_data->str_msg.msg.delay_rpt_cmd.delay);
 714 }
 715
 716 /*******************************************************************************
 717  *
 718  * Function         bta_av_do_disc_a2dp
 719  *
 720  * Description      Do service discovery for A2DP.
 721  *
 722  * Returns          void
 723  *
 724  ******************************************************************************/
 725 void bta_av_do_disc_a2dp(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
 726   bool ok_continue = false;
 727   tA2DP_SDP_DB_PARAMS db_params;
 728   uint16_t attr_list[] = {ATTR_ID_SERVICE_CLASS_ID_LIST,
 729                           ATTR_ID_PROTOCOL_DESC_LIST,
 730                           ATTR_ID_BT_PROFILE_DESC_LIST};
 731   uint16_t sdp_uuid = 0; /* UUID for which SDP has to be done */
 732
 733   APPL_TRACE_DEBUG("%s: peer_addr: %s use_rc: %d switch_res:%d, oc:%d",
 734                    __func__, p_data->api_open.bd_addr.ToString().c_str(),
 735                    p_data->api_open.use_rc, p_data->api_open.switch_res,
 736                    bta_av_cb.audio_open_cnt);
 737
 738   memcpy(&(p_scb->open_api), &(p_data->api_open), sizeof(tBTA_AV_API_OPEN));
 739
 740   switch (p_data->api_open.switch_res) {
 741     case BTA_AV_RS_NONE:
 742       if (bta_av_switch_if_needed(p_scb) ||
 743           !bta_av_link_role_ok(p_scb, A2DP_SET_MULTL_BIT)) {
 744         /* waiting for role switch result. save the api to control block */
 745         memcpy(&p_scb->q_info.open, &p_data->api_open,
 746                sizeof(tBTA_AV_API_OPEN));
 747         p_scb->wait |= BTA_AV_WAIT_ROLE_SW_RES_OPEN;
 748         p_scb->q_tag = BTA_AV_Q_TAG_OPEN;
 749       } else {
 750         ok_continue = true;
 751       }
 752       break;
 753
 754     case BTA_AV_RS_FAIL:
 755       /* report a new failure event  */
 756       p_scb->open_status = BTA_AV_FAIL_ROLE;
 757       APPL_TRACE_ERROR("%s: BTA_AV_SDP_DISC_FAIL_EVT: peer_addr=%s", __func__,
 758                        p_scb->PeerAddress().ToString().c_str());
 759       bta_av_ssm_execute(p_scb, BTA_AV_SDP_DISC_FAIL_EVT, NULL);
 760       break;
 761
 762     case BTA_AV_RS_OK:
 763       p_data = (tBTA_AV_DATA*)&p_scb->q_info.open;
 764       /* continue to open if link role is ok */
 765       if (bta_av_link_role_ok(p_scb, A2DP_SET_MULTL_BIT)) {
 766         ok_continue = true;
 767       } else {
 768         p_scb->wait |= BTA_AV_WAIT_ROLE_SW_RES_OPEN;
 769       }
 770       break;
 771
 772     case BTA_AV_RS_DONE:
 773       ok_continue = true;
 774       break;
 775   }
 776
 777   APPL_TRACE_DEBUG("%s: ok_continue: %d wait:0x%x, q_tag: %d", __func__,
 778                    ok_continue, p_scb->wait, p_scb->q_tag);
 779   if (!ok_continue) return;
 780
 781   /* clear the role switch bits */
 782   p_scb->wait &= ~BTA_AV_WAIT_ROLE_SW_BITS;
 783
 784   if (p_scb->wait & BTA_AV_WAIT_CHECK_RC) {
 785     p_scb->wait &= ~BTA_AV_WAIT_CHECK_RC;
 786     bta_sys_start_timer(p_scb->avrc_ct_timer, BTA_AV_RC_DISC_TIME_VAL,
 787                         BTA_AV_AVRC_TIMER_EVT, p_scb->hndl);
 788   }
 789
 790   /* store peer addr other parameters */
 791   bta_av_save_addr(p_scb, p_data->api_open.bd_addr);
 792   p_scb->use_rc = p_data->api_open.use_rc;
 793
 794   bta_sys_app_open(BTA_ID_AV, p_scb->app_id, p_scb->PeerAddress());
 795
 796   /* set up parameters */
 797   db_params.db_len = BTA_AV_DISC_BUF_SIZE;
 798   db_params.num_attr = 3;
 799   db_params.p_attrs = attr_list;
 800   p_scb->uuid_int = p_data->api_open.uuid;
 801   p_scb->sdp_discovery_started = true;
 802   if (p_scb->uuid_int == UUID_SERVCLASS_AUDIO_SINK)
 803     sdp_uuid = UUID_SERVCLASS_AUDIO_SOURCE;
 804   else if (p_scb->uuid_int == UUID_SERVCLASS_AUDIO_SOURCE)
 805     sdp_uuid = UUID_SERVCLASS_AUDIO_SINK;
 806
 807   APPL_TRACE_DEBUG(
 808       "%s: Initiate SDP discovery for peer %s : uuid_int=0x%x "
 809       "sdp_uuid=0x%x",
 810       __func__, p_scb->PeerAddress().ToString().c_str(), p_scb->uuid_int,
 811       sdp_uuid);
 812   tA2DP_STATUS find_service_status = A2DP_FindService(
 813       sdp_uuid, p_scb->PeerAddress(), &db_params, bta_av_a2dp_sdp_cback);
 814   if (find_service_status != A2DP_SUCCESS) {
 815     APPL_TRACE_ERROR(
 816         "%s: A2DP_FindService() failed for peer %s uuid_int=0x%x "
 817         "sdp_uuid=0x%x : status=%d",
 818         __func__, p_scb->PeerAddress().ToString().c_str(), p_scb->uuid_int,
 819         sdp_uuid, find_service_status);
 820     bta_av_a2dp_sdp_cback(false, nullptr, p_scb->PeerAddress());
 821   } else {
 822     /* only one A2DP find service is active at a time */
 823     bta_av_cb.handle = p_scb->hndl;
 824   }
 825 }
 826
 827 /*******************************************************************************
 828  *
 829  * Function         bta_av_cleanup
 830  *
 831  * Description      cleanup AV stream control block.
 832  *
 833  * Returns          void
 834  *
 835  ******************************************************************************/
 836 void bta_av_cleanup(tBTA_AV_SCB* p_scb, UNUSED_ATTR tBTA_AV_DATA* p_data) {
 837   tBTA_AV_CONN_CHG msg;
 838   uint8_t role = BTA_AV_ROLE_AD_INT;
 839
 840   LOG_INFO("%s peer %s", __func__, p_scb->PeerAddress().ToString().c_str());
 841
 842   /* free any buffers */
 843   p_scb->sdp_discovery_started = false;
 844   p_scb->SetAvdtpVersion(0);
 845
 846   /* initialize some control block variables */
 847   p_scb->open_status = BTA_AV_SUCCESS;
 848
 849   /* if de-registering shut everything down */
 850   msg.hdr.layer_specific = p_scb->hndl;
 851   p_scb->started = false;
 852   p_scb->use_rtp_header_marker_bit = false;
 853   p_scb->cong = false;
 854   p_scb->role = role;
 855   p_scb->cur_psc_mask = 0;
 856   p_scb->wait = 0;
 857   p_scb->num_disc_snks = 0;
 858   p_scb->coll_mask = 0;
 859   alarm_cancel(p_scb->avrc_ct_timer);
 860   alarm_cancel(p_scb->link_signalling_timer);
 861   alarm_cancel(p_scb->accept_signalling_timer);
 862
 863   /* TODO(eisenbach): RE-IMPLEMENT USING VSC OR HAL EXTENSION
 864     vendor_get_interface()->send_command(
 865         (vendor_opcode_t)BT_VND_OP_A2DP_OFFLOAD_STOP, (void*)&p_scb->l2c_cid);
 866     if (p_scb->offload_start_pending) {
 867       tBTA_AV_STATUS status = BTA_AV_FAIL_STREAM;
 868       tBTA_AV bta_av_data;
 869       bta_av_data.status = status;
 870       (*bta_av_cb.p_cback)(BTA_AV_OFFLOAD_START_RSP_EVT, &bta_av_data);
 871     }
 872   */
 873
 874   if (p_scb->deregistering) {
 875     /* remove stream */
 876     for (int i = 0; i < BTAV_A2DP_CODEC_INDEX_MAX; i++) {
 877       if (p_scb->seps[i].av_handle) AVDT_RemoveStream(p_scb->seps[i].av_handle);
 878       p_scb->seps[i].av_handle = 0;
 879     }
 880
 881     bta_av_dereg_comp((tBTA_AV_DATA*)&msg);
 882   } else {
 883     /* report stream closed to main SM */
 884     msg.is_up = false;
 885     msg.peer_addr = p_scb->PeerAddress();
 886     bta_av_conn_chg((tBTA_AV_DATA*)&msg);
 887   }
 888 }
 889
 890 /*******************************************************************************
 891  *
 892  * Function         bta_av_free_sdb
 893  *
 894  * Description      Free service discovery db buffer.
 895  *
 896  * Returns          void
 897  *
 898  ******************************************************************************/
 899 void bta_av_free_sdb(tBTA_AV_SCB* p_scb, UNUSED_ATTR tBTA_AV_DATA* p_data) {
 900   p_scb->sdp_discovery_started = false;
 901 }
 902
 903 /*******************************************************************************
 904  *
 905  * Function         bta_av_config_ind
 906  *
 907  * Description      Handle a stream configuration indication from the peer.
 908  *
 909  * Returns          void
 910  *
 911  ******************************************************************************/
 912 void bta_av_config_ind(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
 913   tBTA_AV_CI_SETCONFIG setconfig{};
 914   tAVDT_SEP_INFO* p_info;
 915   const AvdtpSepConfig* p_evt_cfg = &p_data->str_msg.cfg;
 916   uint8_t psc_mask = (p_evt_cfg->psc_mask | p_scb->cfg.psc_mask);
 917   uint8_t
 918       local_sep; /* sep type of local handle on which connection was received */
 919   tBTA_AV_STR_MSG* p_msg = (tBTA_AV_STR_MSG*)p_data;
 920
 921   local_sep = bta_av_get_scb_sep_type(p_scb, p_msg->handle);
 922   p_scb->avdt_label = p_data->str_msg.msg.hdr.label;
 923
 924   APPL_TRACE_DEBUG("%s: peer %s bta_handle:0x%x local_sep:%d", __func__,
 925                    p_scb->PeerAddress().ToString().c_str(), p_scb->hndl,
 926                    local_sep);
 927   APPL_TRACE_DEBUG("%s: codec: %s", __func__,
 928                    A2DP_CodecInfoString(p_evt_cfg->codec_info).c_str());
 929
 930   memcpy(p_scb->cfg.codec_info, p_evt_cfg->codec_info, AVDT_CODEC_SIZE);
 931   bta_av_save_addr(p_scb, p_data->str_msg.bd_addr);
 932
 933   /* Clear collision mask */
 934   p_scb->coll_mask = 0;
 935   alarm_cancel(p_scb->accept_signalling_timer);
 936
 937   /* if no codec parameters in configuration, fail */
 938   if ((p_evt_cfg->num_codec == 0) ||
 939       /* or the peer requests for a service we do not support */
 940       ((psc_mask != p_scb->cfg.psc_mask) &&
 941        (psc_mask != (p_scb->cfg.psc_mask & ~AVDT_PSC_DELAY_RPT)))) {
 942     setconfig.hndl = p_scb->hndl; /* we may not need this */
 943     setconfig.err_code = AVDT_ERR_UNSUP_CFG;
 944     bta_av_ssm_execute(p_scb, BTA_AV_CI_SETCONFIG_FAIL_EVT,
 945                        (tBTA_AV_DATA*)&setconfig);
 946   } else {
 947     p_info = &p_scb->sep_info[0];
 948     p_info->in_use = 0;
 949     p_info->media_type = p_scb->media_type;
 950     p_info->seid = p_data->str_msg.msg.config_ind.int_seid;
 951
 952     /* Sep type of Peer will be oppsite role to our local sep */
 953     if (local_sep == AVDT_TSEP_SRC)
 954       p_info->tsep = AVDT_TSEP_SNK;
 955     else if (local_sep == AVDT_TSEP_SNK)
 956       p_info->tsep = AVDT_TSEP_SRC;
 957
 958     p_scb->role |= BTA_AV_ROLE_AD_ACP;
 959     p_scb->cur_psc_mask = p_evt_cfg->psc_mask;
 960     if (bta_av_cb.features & BTA_AV_FEAT_RCTG)
 961       p_scb->use_rc = true;
 962     else
 963       p_scb->use_rc = false;
 964
 965     p_scb->num_seps = 1;
 966     p_scb->sep_info_idx = 0;
 967     APPL_TRACE_DEBUG("%s: SEID: %d use_rc: %d cur_psc_mask:0x%x", __func__,
 968                      p_info->seid, p_scb->use_rc, p_scb->cur_psc_mask);
 969     /*  in case of A2DP SINK this is the first time peer data is being sent to
 970      * co functions */
 971     if (local_sep == AVDT_TSEP_SNK) {
 972       p_scb->p_cos->setcfg(p_scb->hndl, p_scb->PeerAddress(),
 973                            p_evt_cfg->codec_info, p_info->seid,
 974                            p_evt_cfg->num_protect, p_evt_cfg->protect_info,
 975                            AVDT_TSEP_SNK, p_msg->handle);
 976     } else {
 977       p_scb->p_cos->setcfg(p_scb->hndl, p_scb->PeerAddress(),
 978                            p_evt_cfg->codec_info, p_info->seid,
 979                            p_evt_cfg->num_protect, p_evt_cfg->protect_info,
 980                            AVDT_TSEP_SRC, p_msg->handle);
 981     }
 982   }
 983 }
 984
 985 /*******************************************************************************
 986  *
 987  * Function         bta_av_disconnect_req
 988  *
 989  * Description      Disconnect AVDTP connection.
 990  *
 991  * Returns          void
 992  *
 993  ******************************************************************************/
 994 void bta_av_disconnect_req(tBTA_AV_SCB* p_scb,
 995                            UNUSED_ATTR tBTA_AV_DATA* p_data) {
 996   tBTA_AV_RCB* p_rcb;
 997
 998   APPL_TRACE_API("%s: conn_lcb: 0x%x peer_addr: %s", __func__,
 999                  bta_av_cb.conn_lcb, p_scb->PeerAddress().ToString().c_str());
1000
1001   alarm_cancel(p_scb->link_signalling_timer);
1002   alarm_cancel(p_scb->accept_signalling_timer);
1003   alarm_cancel(p_scb->avrc_ct_timer);
1004
1005   // conn_lcb is the index bitmask of all used LCBs, and since LCB and SCB use
1006   // the same index, it should be safe to use SCB index here.
1007   if ((bta_av_cb.conn_lcb & (1 << p_scb->hdi)) != 0) {
1008     p_rcb = bta_av_get_rcb_by_shdl((uint8_t)(p_scb->hdi + 1));
1009     if (p_rcb) bta_av_del_rc(p_rcb);
1010     AVDT_DisconnectReq(p_scb->PeerAddress(), &bta_av_proc_stream_evt);
1011   } else {
1012     APPL_TRACE_WARNING("%s: conn_lcb=0x%x bta_handle=0x%x (hdi=%u) no link",
1013                        __func__, bta_av_cb.conn_lcb, p_scb->hndl, p_scb->hdi);
1014     bta_av_ssm_execute(p_scb, BTA_AV_AVDT_DISCONNECT_EVT, NULL);
1015   }
1016 }
1017
1018 /*******************************************************************************
1019  *
1020  * Function         bta_av_security_req
1021  *
1022  * Description      Send an AVDTP security request.
1023  *
1024  * Returns          void
1025  *
1026  ******************************************************************************/
1027 void bta_av_security_req(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
1028   if (bta_av_cb.features & BTA_AV_FEAT_PROTECT) {
1029     AVDT_SecurityReq(p_scb->avdt_handle, p_data->api_protect_req.p_data,
1030                      p_data->api_protect_req.len);
1031   }
1032 }
1033
1034 /*******************************************************************************
1035  *
1036  * Function         bta_av_security_rsp
1037  *
1038  * Description      Send an AVDTP security response.
1039  *
1040  * Returns          void
1041  *
1042  ******************************************************************************/
1043 void bta_av_security_rsp(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
1044   if (bta_av_cb.features & BTA_AV_FEAT_PROTECT) {
1045     AVDT_SecurityRsp(p_scb->avdt_handle, p_scb->avdt_label,
1046                      p_data->api_protect_rsp.error_code,
1047                      p_data->api_protect_rsp.p_data,
1048                      p_data->api_protect_rsp.len);
1049   } else {
1050     AVDT_SecurityRsp(p_scb->avdt_handle, p_scb->avdt_label, AVDT_ERR_NSC, NULL,
1051                      0);
1052   }
1053 }
1054
1055 /*******************************************************************************
1056  *
1057  * Function         bta_av_setconfig_rsp
1058  *
1059  * Description      setconfig is OK
1060  *
1061  * Returns          void
1062  *
1063  ******************************************************************************/
1064 void bta_av_setconfig_rsp(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
1065   uint8_t num = p_data->ci_setconfig.num_seid + 1;
1066   uint8_t avdt_handle = p_data->ci_setconfig.avdt_handle;
1067   uint8_t* p_seid = p_data->ci_setconfig.p_seid;
1068   int i;
1069   uint8_t local_sep;
1070
1071   /* we like this codec_type. find the sep_idx */
1072   local_sep = bta_av_get_scb_sep_type(p_scb, avdt_handle);
1073   bta_av_adjust_seps_idx(p_scb, avdt_handle);
1074   LOG_INFO(
1075       "%s: peer %s bta_handle=0x%x avdt_handle=%d sep_idx=%d cur_psc_mask:0x%x",
1076       __func__, p_scb->PeerAddress().ToString().c_str(), p_scb->hndl,
1077       p_scb->avdt_handle, p_scb->sep_idx, p_scb->cur_psc_mask);
1078
1079   if ((AVDT_TSEP_SNK == local_sep) &&
1080       (p_data->ci_setconfig.err_code == AVDT_SUCCESS) &&
1081       (p_scb->seps[p_scb->sep_idx].p_app_sink_data_cback != NULL)) {
1082     tBTA_AV_MEDIA av_sink_codec_info;
1083     av_sink_codec_info.avk_config.bd_addr = p_scb->PeerAddress();
1084     av_sink_codec_info.avk_config.codec_info = p_scb->cfg.codec_info;
1085     p_scb->seps[p_scb->sep_idx].p_app_sink_data_cback(
1086         p_scb->PeerAddress(), BTA_AV_SINK_MEDIA_CFG_EVT, &av_sink_codec_info);
1087   }
1088
1089   AVDT_ConfigRsp(p_scb->avdt_handle, p_scb->avdt_label,
1090                  p_data->ci_setconfig.err_code, p_data->ci_setconfig.category);
1091
1092   alarm_cancel(p_scb->link_signalling_timer);
1093
1094   if (p_data->ci_setconfig.err_code == AVDT_SUCCESS) {
1095     p_scb->wait = BTA_AV_WAIT_ACP_CAPS_ON;
1096     if (p_data->ci_setconfig.recfg_needed)
1097       p_scb->role |= BTA_AV_ROLE_SUSPEND_OPT;
1098     APPL_TRACE_DEBUG("%s: recfg_needed:%d role:0x%x num:%d", __func__,
1099                      p_data->ci_setconfig.recfg_needed, p_scb->role, num);
1100     /* callout module tells BTA the number of "good" SEPs and their SEIDs.
1101      * getcap on these SEID */
1102     p_scb->num_seps = num;
1103
1104     if (p_scb->cur_psc_mask & AVDT_PSC_DELAY_RPT)
1105       p_scb->SetAvdtpVersion(AVDT_VERSION_1_3);
1106
1107     if (A2DP_GetCodecType(p_scb->cfg.codec_info) == A2DP_MEDIA_CT_SBC ||
1108         num > 1) {
1109       /* if SBC is used by the SNK as INT, discover req is not sent in
1110        * bta_av_config_ind.
1111        * call disc_res now */
1112       /* this is called in A2DP SRC path only, In case of SINK we don't need it
1113        */
1114       if (local_sep == AVDT_TSEP_SRC)
1115         p_scb->p_cos->disc_res(p_scb->hndl, p_scb->PeerAddress(), num, num, 0,
1116                                UUID_SERVCLASS_AUDIO_SOURCE);
1117     } else {
1118       /* we do not know the peer device and it is using non-SBC codec
1119        * we need to know all the SEPs on SNK */
1120       if (p_scb->uuid_int == 0) p_scb->uuid_int = p_scb->open_api.uuid;
1121       bta_av_discover_req(p_scb, NULL);
1122       return;
1123     }
1124
1125     for (i = 1; i < num; i++) {
1126       APPL_TRACE_DEBUG("%s: sep_info[%d] SEID: %d", __func__, i, p_seid[i - 1]);
1127       /* initialize the sep_info[] to get capabilities */
1128       p_scb->sep_info[i].in_use = false;
1129       p_scb->sep_info[i].tsep = AVDT_TSEP_SNK;
1130       p_scb->sep_info[i].media_type = p_scb->media_type;
1131       p_scb->sep_info[i].seid = p_seid[i - 1];
1132     }
1133
1134     /* only in case of local sep as SRC we need to look for other SEPs, In case
1135      * of SINK we don't */
1136     if (local_sep == AVDT_TSEP_SRC) {
1137       /* Make sure UUID has been initialized... */
1138       if (p_scb->uuid_int == 0) p_scb->uuid_int = p_scb->open_api.uuid;
1139       bta_av_next_getcap(p_scb, p_data);
1140     }
1141   }
1142 }
1143
1144 /*******************************************************************************
1145  *
1146  * Function         bta_av_str_opened
1147  *
1148  * Description      Stream opened OK (incoming/outgoing).
1149  *
1150  * Returns          void
1151  *
1152  ******************************************************************************/
1153 void bta_av_str_opened(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
1154   tBTA_AV_CONN_CHG msg;
1155   char remote_name[BTM_MAX_REM_BD_NAME_LEN] = "";
1156   uint8_t* p;
1157
1158   APPL_TRACE_DEBUG("%s: peer %s bta_handle: 0x%x", __func__,
1159                    p_scb->PeerAddress().ToString().c_str(), p_scb->hndl);
1160
1161   msg.hdr.layer_specific = p_scb->hndl;
1162   msg.is_up = true;
1163   msg.peer_addr = p_scb->PeerAddress();
1164   p_scb->l2c_cid = AVDT_GetL2CapChannel(p_scb->avdt_handle);
1165   bta_av_conn_chg((tBTA_AV_DATA*)&msg);
1166   /* set the congestion flag, so AV would not send media packets by accident */
1167   p_scb->cong = true;
1168   // Don't use AVDTP SUSPEND for restrict listed devices
1169   btif_storage_get_stored_remote_name(p_scb->PeerAddress(), remote_name);
1170   if (interop_match_name(INTEROP_DISABLE_AVDTP_SUSPEND, remote_name) ||
1171       interop_match_addr(INTEROP_DISABLE_AVDTP_SUSPEND,
1172                          &p_scb->PeerAddress())) {
1173     LOG_INFO("%s: disable AVDTP SUSPEND: interop matched name %s address %s",
1174              __func__, remote_name, p_scb->PeerAddress().ToString().c_str());
1175     p_scb->suspend_sup = false;
1176   }
1177
1178   p_scb->stream_mtu =
1179       p_data->str_msg.msg.open_ind.peer_mtu - AVDT_MEDIA_HDR_SIZE;
1180   APPL_TRACE_DEBUG("%s: l2c_cid: 0x%x stream_mtu: %d", __func__, p_scb->l2c_cid,
1181                    p_scb->stream_mtu);
1182
1183   /* Set the media channel as high priority */
1184   L2CA_SetTxPriority(p_scb->l2c_cid, L2CAP_CHNL_PRIORITY_HIGH);
1185   L2CA_SetChnlFlushability(p_scb->l2c_cid, true);
1186
1187   bta_sys_conn_open(BTA_ID_AV, p_scb->app_id, p_scb->PeerAddress());
1188   memset(&p_scb->q_info, 0, sizeof(tBTA_AV_Q_INFO));
1189
1190   p_scb->l2c_bufs = 0;
1191   p_scb->p_cos->open(p_scb->hndl, p_scb->PeerAddress(), p_scb->stream_mtu);
1192
1193   {
1194     /* TODO check if other audio channel is open.
1195      * If yes, check if reconfig is needed
1196      * Rigt now we do not do this kind of checking.
1197      * BTA-AV is INT for 2nd audio connection.
1198      * The application needs to make sure the current codec_info is proper.
1199      * If one audio connection is open and another SNK attempts to connect to
1200      * AV,
1201      * the connection will be rejected.
1202      */
1203     /* check if other audio channel is started. If yes, start */
1204     tBTA_AV_OPEN open;
1205     open.bd_addr = p_scb->PeerAddress();
1206     open.chnl = p_scb->chnl;
1207     open.hndl = p_scb->hndl;
1208     open.status = BTA_AV_SUCCESS;
1209     open.edr = 0;
1210     p = BTM_ReadRemoteFeatures(p_scb->PeerAddress());
1211     if (p != NULL) {
1212       if (HCI_EDR_ACL_2MPS_SUPPORTED(p)) open.edr |= BTA_AV_EDR_2MBPS;
1213       if (HCI_EDR_ACL_3MPS_SUPPORTED(p)) {
1214         if (!interop_match_addr(INTEROP_2MBPS_LINK_ONLY,
1215                                 &p_scb->PeerAddress())) {
1216           open.edr |= BTA_AV_EDR_3MBPS;
1217         }
1218       }
1219     }
1220     bta_ar_avdt_conn(BTA_ID_AV, open.bd_addr, p_scb->hdi);
1221     if (p_scb->seps[p_scb->sep_idx].tsep == AVDT_TSEP_SRC) {
1222       open.starting = false;
1223       open.sep = AVDT_TSEP_SNK;
1224     } else if (p_scb->seps[p_scb->sep_idx].tsep == AVDT_TSEP_SNK) {
1225       open.starting = bta_av_chk_start(p_scb);
1226       open.sep = AVDT_TSEP_SRC;
1227     }
1228
1229     tBTA_AV bta_av_data;
1230     bta_av_data.open = open;
1231     (*bta_av_cb.p_cback)(BTA_AV_OPEN_EVT, &bta_av_data);
1232     if (open.starting) {
1233       bta_av_ssm_execute(p_scb, BTA_AV_AP_START_EVT, NULL);
1234     }
1235   }
1236
1237   // This code is used to pass PTS TC for AVDTP ABORT
1238   char value[PROPERTY_VALUE_MAX] = {0};
1239   if ((osi_property_get("bluetooth.pts.force_a2dp_abort", value, "false")) &&
1240       (!strcmp(value, "true"))) {
1241     APPL_TRACE_ERROR("%s: Calling AVDT_AbortReq", __func__);
1242     AVDT_AbortReq(p_scb->avdt_handle);
1243   }
1244 }
1245
1246 /*******************************************************************************
1247  *
1248  * Function         bta_av_security_ind
1249  *
1250  * Description      Handle an AVDTP security indication.
1251  *
1252  * Returns          void
1253  *
1254  ******************************************************************************/
1255 void bta_av_security_ind(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
1256   p_scb->avdt_label = p_data->str_msg.msg.hdr.label;
1257
1258   if (bta_av_cb.features & BTA_AV_FEAT_PROTECT) {
1259     tBTA_AV_PROTECT_REQ protect_req;
1260     protect_req.chnl = p_scb->chnl;
1261     protect_req.hndl = p_scb->hndl;
1262     protect_req.p_data = p_data->str_msg.msg.security_ind.p_data;
1263     protect_req.len = p_data->str_msg.msg.security_ind.len;
1264
1265     tBTA_AV bta_av_data;
1266     bta_av_data.protect_req = protect_req;
1267     (*bta_av_cb.p_cback)(BTA_AV_PROTECT_REQ_EVT, &bta_av_data);
1268   }
1269   /* app doesn't support security indication; respond with failure */
1270   else {
1271     AVDT_SecurityRsp(p_scb->avdt_handle, p_scb->avdt_label, AVDT_ERR_NSC, NULL,
1272                      0);
1273   }
1274 }
1275
1276 /*******************************************************************************
1277  *
1278  * Function         bta_av_security_cfm
1279  *
1280  * Description      Handle an AVDTP security confirm.
1281  *
1282  * Returns          void
1283  *
1284  ******************************************************************************/
1285 void bta_av_security_cfm(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
1286   if (bta_av_cb.features & BTA_AV_FEAT_PROTECT) {
1287     tBTA_AV_PROTECT_RSP protect_rsp;
1288     protect_rsp.chnl = p_scb->chnl;
1289     protect_rsp.hndl = p_scb->hndl;
1290     protect_rsp.p_data = p_data->str_msg.msg.security_cfm.p_data;
1291     protect_rsp.len = p_data->str_msg.msg.security_cfm.len;
1292     protect_rsp.err_code = p_data->str_msg.msg.hdr.err_code;
1293
1294     tBTA_AV bta_av_data;
1295     bta_av_data.protect_rsp = protect_rsp;
1296     (*bta_av_cb.p_cback)(BTA_AV_PROTECT_RSP_EVT, &bta_av_data);
1297   }
1298 }
1299
1300 /*******************************************************************************
1301  *
1302  * Function         bta_av_do_close
1303  *
1304  * Description      Close stream.
1305  *
1306  * Returns          void
1307  *
1308  ******************************************************************************/
1309 void bta_av_do_close(tBTA_AV_SCB* p_scb, UNUSED_ATTR tBTA_AV_DATA* p_data) {
1310   APPL_TRACE_DEBUG("%s: p_scb->co_started=%d", __func__, p_scb->co_started);
1311
1312   /* stop stream if started */
1313   if (p_scb->co_started) {
1314     bta_av_str_stopped(p_scb, NULL);
1315   }
1316   alarm_cancel(p_scb->link_signalling_timer);
1317
1318   /* close stream */
1319   p_scb->started = false;
1320   p_scb->use_rtp_header_marker_bit = false;
1321
1322   /* drop the buffers queued in L2CAP */
1323   L2CA_FlushChannel(p_scb->l2c_cid, L2CAP_FLUSH_CHANS_ALL);
1324
1325   AVDT_CloseReq(p_scb->avdt_handle);
1326   /* just in case that the link is congested, link is flow controled by peer or
1327    * for whatever reason the the close request can not be sent in time.
1328    * when this timer expires, AVDT_DisconnectReq will be called to disconnect
1329    * the link
1330    */
1331   bta_sys_start_timer(p_scb->avrc_ct_timer, BTA_AV_CLOSE_REQ_TIME_VAL,
1332                       BTA_AV_API_CLOSE_EVT, p_scb->hndl);
1333 }
1334
1335 /*******************************************************************************
1336  *
1337  * Function         bta_av_connect_req
1338  *
1339  * Description      Connect AVDTP connection.
1340  *
1341  * Returns          void
1342  *
1343  ******************************************************************************/
1344 void bta_av_connect_req(tBTA_AV_SCB* p_scb, UNUSED_ATTR tBTA_AV_DATA* p_data) {
1345   APPL_TRACE_DEBUG("%s: peer %s coll_mask=0x%02x", __func__,
1346                    p_scb->PeerAddress().ToString().c_str(), p_scb->coll_mask);
1347   p_scb->sdp_discovery_started = false;
1348   if (p_scb->coll_mask & BTA_AV_COLL_INC_TMR) {
1349     /* SNK initiated L2C connection while SRC was doing SDP.    */
1350     /* Wait until timeout to check if SNK starts signalling.    */
1351     APPL_TRACE_WARNING("%s: coll_mask=0x%02x incoming timer is up", __func__,
1352                        p_scb->coll_mask);
1353     p_scb->coll_mask |= BTA_AV_COLL_API_CALLED;
1354     APPL_TRACE_EVENT("%s: updated coll_mask=0x%02x", __func__,
1355                      p_scb->coll_mask);
1356     return;
1357   }
1358
1359   AVDT_ConnectReq(p_scb->PeerAddress(), p_scb->hdi, &bta_av_proc_stream_evt);
1360 }
1361
1362 /*******************************************************************************
1363  *
1364  * Function         bta_av_sdp_failed
1365  *
1366  * Description      Service discovery failed.
1367  *
1368  * Returns          void
1369  *
1370  ******************************************************************************/
1371 void bta_av_sdp_failed(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
1372   APPL_TRACE_ERROR("%s: peer_addr=%s open_status=%d", __func__,
1373                    p_scb->PeerAddress().ToString().c_str(), p_scb->open_status);
1374
1375   if (p_scb->open_status == BTA_AV_SUCCESS) {
1376     p_scb->open_status = BTA_AV_FAIL_SDP;
1377   }
1378
1379   p_scb->sdp_discovery_started = false;
1380   bta_av_str_closed(p_scb, p_data);
1381 }
1382
1383 /*******************************************************************************
1384  *
1385  * Function         bta_av_disc_results
1386  *
1387  * Description      Handle the AVDTP discover results.  Search through the
1388  *                  results and find the first available stream, and get
1389  *                  its capabilities.
1390  *
1391  * Returns          void
1392  *
1393  ******************************************************************************/
1394 void bta_av_disc_results(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
1395   uint8_t num_snks = 0, num_srcs = 0, i;
1396   /* our uuid in case we initiate connection */
1397   uint16_t uuid_int = p_scb->uuid_int;
1398
1399   APPL_TRACE_DEBUG("%s: peer %s bta_handle: 0x%x initiator UUID 0x%x", __func__,
1400                    p_scb->PeerAddress().ToString().c_str(), p_scb->hndl,
1401                    uuid_int);
1402
1403   /* store number of stream endpoints returned */
1404   p_scb->num_seps = p_data->str_msg.msg.discover_cfm.num_seps;
1405
1406   for (i = 0; i < p_scb->num_seps; i++) {
1407     /* steam not in use, is a sink, and is audio */
1408     if ((!p_scb->sep_info[i].in_use) &&
1409         (p_scb->sep_info[i].media_type == p_scb->media_type)) {
1410       if ((p_scb->sep_info[i].tsep == AVDT_TSEP_SNK) &&
1411           (uuid_int == UUID_SERVCLASS_AUDIO_SOURCE))
1412         num_snks++;
1413
1414       if ((p_scb->sep_info[i].tsep == AVDT_TSEP_SRC) &&
1415           (uuid_int == UUID_SERVCLASS_AUDIO_SINK))
1416         num_srcs++;
1417     }
1418   }
1419
1420   p_scb->p_cos->disc_res(p_scb->hndl, p_scb->PeerAddress(), p_scb->num_seps,
1421                          num_snks, num_srcs, uuid_int);
1422   p_scb->num_disc_snks = num_snks;
1423   p_scb->num_disc_srcs = num_srcs;
1424
1425   /* if we got any */
1426   if (p_scb->num_seps > 0) {
1427     /* initialize index into discovery results */
1428     p_scb->sep_info_idx = 0;
1429
1430     /* get the capabilities of the first available stream */
1431     bta_av_next_getcap(p_scb, p_data);
1432   }
1433   /* else we got discover response but with no streams; we're done */
1434   else {
1435     APPL_TRACE_ERROR("%s: BTA_AV_STR_DISC_FAIL_EVT: peer_addr=%s", __func__,
1436                      p_scb->PeerAddress().ToString().c_str());
1437     bta_av_ssm_execute(p_scb, BTA_AV_STR_DISC_FAIL_EVT, p_data);
1438   }
1439 }
1440
1441 /*******************************************************************************
1442  *
1443  * Function         bta_av_disc_res_as_acp
1444  *
1445  * Description      Handle the AVDTP discover results.  Search through the
1446  *                  results and find the first available stream, and get
1447  *                  its capabilities.
1448  *
1449  * Returns          void
1450  *
1451  ******************************************************************************/
1452 void bta_av_disc_res_as_acp(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
1453   uint8_t num_snks = 0, i;
1454
1455   APPL_TRACE_DEBUG("%s: peer %s bta_handle: 0x%x", __func__,
1456                    p_scb->PeerAddress().ToString().c_str(), p_scb->hndl);
1457
1458   /* store number of stream endpoints returned */
1459   p_scb->num_seps = p_data->str_msg.msg.discover_cfm.num_seps;
1460
1461   for (i = 0; i < p_scb->num_seps; i++) {
1462     /* steam is a sink, and is audio */
1463     if ((p_scb->sep_info[i].tsep == AVDT_TSEP_SNK) &&
1464         (p_scb->sep_info[i].media_type == p_scb->media_type)) {
1465       p_scb->sep_info[i].in_use = false;
1466       num_snks++;
1467     }
1468   }
1469   p_scb->p_cos->disc_res(p_scb->hndl, p_scb->PeerAddress(), p_scb->num_seps,
1470                          num_snks, 0, UUID_SERVCLASS_AUDIO_SOURCE);
1471   p_scb->num_disc_snks = num_snks;
1472   p_scb->num_disc_srcs = 0;
1473
1474   /* if we got any */
1475   if (p_scb->num_seps > 0) {
1476     /* initialize index into discovery results */
1477     p_scb->sep_info_idx = 0;
1478
1479     /* get the capabilities of the first available stream */
1480     bta_av_next_getcap(p_scb, p_data);
1481   }
1482   /* else we got discover response but with no streams; we're done */
1483   else {
1484     APPL_TRACE_ERROR("%s: BTA_AV_STR_DISC_FAIL_EVT: peer_addr=%s", __func__,
1485                      p_scb->PeerAddress().ToString().c_str());
1486     bta_av_ssm_execute(p_scb, BTA_AV_STR_DISC_FAIL_EVT, p_data);
1487   }
1488 }
1489
1490 /*******************************************************************************
1491  *
1492  * Function         bta_av_save_caps
1493  *
1494  * Description      report the SNK SEP capabilities to application
1495  *
1496  * Returns          void
1497  *
1498  ******************************************************************************/
1499 void bta_av_save_caps(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
1500   AvdtpSepConfig cfg;
1501   tAVDT_SEP_INFO* p_info = &p_scb->sep_info[p_scb->sep_info_idx];
1502   uint8_t old_wait = p_scb->wait;
1503   bool getcap_done = false;
1504
1505   APPL_TRACE_DEBUG(
1506       "%s: peer %s bta_handle:0x%x num_seps:%d sep_info_idx:%d wait:0x%x",
1507       __func__, p_scb->PeerAddress().ToString().c_str(), p_scb->hndl,
1508       p_scb->num_seps, p_scb->sep_info_idx, p_scb->wait);
1509   APPL_TRACE_DEBUG("%s: codec: %s", __func__,
1510                    A2DP_CodecInfoString(p_scb->peer_cap.codec_info).c_str());
1511
1512   cfg = p_scb->peer_cap;
1513   /* let application know the capability of the SNK */
1514   if (p_scb->p_cos->getcfg(p_scb->hndl, p_scb->PeerAddress(), cfg.codec_info,
1515                            &p_scb->sep_info_idx, p_info->seid, &cfg.num_protect,
1516                            cfg.protect_info) != A2DP_SUCCESS) {
1517     p_scb->sep_info_idx++;
1518     APPL_TRACE_DEBUG("%s: result: next sep_info_idx:%d", __func__,
1519                      p_scb->sep_info_idx);
1520   } else {
1521     // All capabilities found
1522     getcap_done = true;
1523     APPL_TRACE_DEBUG("%s: result: done sep_info_idx:%d", __func__,
1524                      p_scb->sep_info_idx);
1525   }
1526   APPL_TRACE_DEBUG("%s: codec: %s", __func__,
1527                    A2DP_CodecInfoString(cfg.codec_info).c_str());
1528
1529   if (p_scb->num_seps > p_scb->sep_info_idx && !getcap_done) {
1530     /* Some devices have seps at the end of the discover list, which is not */
1531     /* matching media type(video not audio).                                */
1532     /* In this case, we are done with getcap without sending another        */
1533     /* request to AVDT.                                                     */
1534     if (!bta_av_next_getcap(p_scb, p_data)) getcap_done = true;
1535   } else {
1536     getcap_done = true;
1537   }
1538
1539   if (getcap_done) {
1540     APPL_TRACE_DEBUG("%s: getcap_done: num_seps:%d sep_info_idx:%d wait:0x%x",
1541                      __func__, p_scb->num_seps, p_scb->sep_info_idx,
1542                      p_scb->wait);
1543     p_scb->wait &= ~(BTA_AV_WAIT_ACP_CAPS_ON | BTA_AV_WAIT_ACP_CAPS_STARTED);
1544     if (old_wait & BTA_AV_WAIT_ACP_CAPS_STARTED) {
1545       bta_av_start_ok(p_scb, NULL);
1546     }
1547   }
1548 }
1549
1550 /*******************************************************************************
1551  *
1552  * Function         bta_av_set_use_rc
1553  *
1554  * Description      set to use AVRC for this stream control block.
1555  *
1556  * Returns          void
1557  *
1558  ******************************************************************************/
1559 void bta_av_set_use_rc(tBTA_AV_SCB* p_scb, UNUSED_ATTR tBTA_AV_DATA* p_data) {
1560   p_scb->use_rc = true;
1561 }
1562
1563 /*******************************************************************************
1564  *
1565  * Function         bta_av_cco_close
1566  *
1567  * Description      call close call-out function.
1568  *
1569  * Returns          void
1570  *
1571  ******************************************************************************/
1572 void bta_av_cco_close(tBTA_AV_SCB* p_scb, UNUSED_ATTR tBTA_AV_DATA* p_data) {
1573   APPL_TRACE_DEBUG("%s: peer %s bta_handle:0x%x", __func__,
1574                    p_scb->PeerAddress().ToString().c_str(), p_scb->hndl);
1575   p_scb->p_cos->close(p_scb->hndl, p_scb->PeerAddress());
1576 }
1577
1578 /*******************************************************************************
1579  *
1580  * Function         bta_av_open_failed
1581  *
1582  * Description      Failed to open an AVDT stream
1583  *
1584  * Returns          void
1585  *
1586  ******************************************************************************/
1587 void bta_av_open_failed(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
1588   bool is_av_opened = false;
1589   tBTA_AV_SCB* p_opened_scb = NULL;
1590   uint8_t idx;
1591
1592   APPL_TRACE_ERROR("%s: peer_addr=%s", __func__,
1593                    p_scb->PeerAddress().ToString().c_str());
1594   p_scb->open_status = BTA_AV_FAIL_STREAM;
1595   bta_av_cco_close(p_scb, p_data);
1596
1597   /* check whether there is already an opened audio or video connection with the
1598    * same device */
1599   for (idx = 0; (idx < BTA_AV_NUM_STRS) && (!is_av_opened); idx++) {
1600     p_opened_scb = bta_av_cb.p_scb[idx];
1601     if (p_opened_scb && (p_opened_scb->state == BTA_AV_OPEN_SST) &&
1602         (p_opened_scb->PeerAddress() == p_scb->PeerAddress()))
1603       is_av_opened = true;
1604   }
1605
1606   /* if there is already an active AV connnection with the same bd_addr,
1607      don't send disconnect req, just report the open event with
1608      BTA_AV_FAIL_GET_CAP status */
1609   if (is_av_opened) {
1610     tBTA_AV_OPEN open;
1611     open.bd_addr = p_scb->PeerAddress();
1612     open.chnl = p_scb->chnl;
1613     open.hndl = p_scb->hndl;
1614     open.status = BTA_AV_FAIL_GET_CAP;
1615     open.starting = bta_av_chk_start(p_scb);
1616     open.edr = 0;
1617     /* set the state back to initial state */
1618     bta_av_set_scb_sst_init(p_scb);
1619
1620     if (p_scb->seps[p_scb->sep_idx].tsep == AVDT_TSEP_SRC) {
1621       open.sep = AVDT_TSEP_SNK;
1622     } else if (p_scb->seps[p_scb->sep_idx].tsep == AVDT_TSEP_SNK) {
1623       open.sep = AVDT_TSEP_SRC;
1624     }
1625
1626     APPL_TRACE_ERROR(
1627         "%s: there is already an active connection: peer_addr=%s chnl=%d "
1628         "hndl=0x%x status=%d starting=%d edr=%d",
1629         __func__, open.bd_addr.ToString().c_str(), open.chnl, open.hndl,
1630         open.status, open.starting, open.edr);
1631
1632     tBTA_AV bta_av_data;
1633     bta_av_data.open = open;
1634     (*bta_av_cb.p_cback)(BTA_AV_OPEN_EVT, &bta_av_data);
1635   } else {
1636     AVDT_DisconnectReq(p_scb->PeerAddress(), &bta_av_proc_stream_evt);
1637   }
1638 }
1639
1640 /*******************************************************************************
1641  *
1642  * Function         bta_av_getcap_results
1643  *
1644  * Description      Handle the AVDTP get capabilities results.  Check the codec
1645  *                  type and see if it matches ours.  If it does not, get the
1646  *                  capabilities of the next stream, if any.
1647  *
1648  * Returns          void
1649  *
1650  ******************************************************************************/
1651 void bta_av_getcap_results(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
1652   AvdtpSepConfig cfg = p_scb->cfg;
1653   uint8_t media_type = A2DP_GetMediaType(p_scb->peer_cap.codec_info);
1654   tAVDT_SEP_INFO* p_info = &p_scb->sep_info[p_scb->sep_info_idx];
1655
1656   cfg.num_codec = 1;
1657   cfg.num_protect = p_scb->peer_cap.num_protect;
1658   memcpy(cfg.codec_info, p_scb->peer_cap.codec_info, AVDT_CODEC_SIZE);
1659   memcpy(cfg.protect_info, p_scb->peer_cap.protect_info, AVDT_PROTECT_SIZE);
1660
1661   APPL_TRACE_DEBUG("%s: peer %s bta_handle:0x%x num_codec:%d psc_mask=0x%x",
1662                    __func__, p_scb->PeerAddress().ToString().c_str(),
1663                    p_scb->hndl, p_scb->peer_cap.num_codec, p_scb->cfg.psc_mask);
1664   APPL_TRACE_DEBUG("%s: media type 0x%x, 0x%x", __func__, media_type,
1665                    p_scb->media_type);
1666   APPL_TRACE_DEBUG("%s: codec: %s", __func__,
1667                    A2DP_CodecInfoString(p_scb->cfg.codec_info).c_str());
1668
1669   /* if codec present and we get a codec configuration */
1670   if ((p_scb->peer_cap.num_codec != 0) && (media_type == p_scb->media_type) &&
1671       (p_scb->p_cos->getcfg(p_scb->hndl, p_scb->PeerAddress(), cfg.codec_info,
1672                             &p_scb->sep_info_idx, p_info->seid,
1673                             &cfg.num_protect,
1674                             cfg.protect_info) == A2DP_SUCCESS)) {
1675     /* UUID for which connection was initiatied */
1676     uint16_t uuid_int = p_scb->uuid_int;
1677
1678     /* save copy of codec configuration */
1679     p_scb->cfg = cfg;
1680
1681     APPL_TRACE_DEBUG("%s: result: sep_info_idx=%d", __func__,
1682                      p_scb->sep_info_idx);
1683     APPL_TRACE_DEBUG("%s: codec: %s", __func__,
1684                      A2DP_CodecInfoString(p_scb->cfg.codec_info).c_str());
1685
1686     APPL_TRACE_DEBUG("%s: initiator UUID = 0x%x", __func__, uuid_int);
1687     if (uuid_int == UUID_SERVCLASS_AUDIO_SOURCE)
1688       bta_av_adjust_seps_idx(p_scb,
1689                              bta_av_get_scb_handle(p_scb, AVDT_TSEP_SRC));
1690     else if (uuid_int == UUID_SERVCLASS_AUDIO_SINK)
1691       bta_av_adjust_seps_idx(p_scb,
1692                              bta_av_get_scb_handle(p_scb, AVDT_TSEP_SNK));
1693     LOG_INFO("%s: sep_idx=%d avdt_handle=%d bta_handle=0x%x", __func__,
1694              p_scb->sep_idx, p_scb->avdt_handle, p_scb->hndl);
1695
1696     /* use only the services peer supports */
1697     cfg.psc_mask &= p_scb->peer_cap.psc_mask;
1698     p_scb->cur_psc_mask = cfg.psc_mask;
1699     APPL_TRACE_DEBUG(
1700         "%s: peer %s bta_handle:0x%x sep_idx:%d sep_info_idx:%d "
1701         "cur_psc_mask:0x%x",
1702         __func__, p_scb->PeerAddress().ToString().c_str(), p_scb->hndl,
1703         p_scb->sep_idx, p_scb->sep_info_idx, p_scb->cur_psc_mask);
1704
1705     if ((uuid_int == UUID_SERVCLASS_AUDIO_SINK) &&
1706         (p_scb->seps[p_scb->sep_idx].p_app_sink_data_cback != NULL)) {
1707       APPL_TRACE_DEBUG("%s: configure decoder for Sink connection", __func__);
1708       tBTA_AV_MEDIA av_sink_codec_info;
1709       av_sink_codec_info.avk_config.bd_addr = p_scb->PeerAddress();
1710       av_sink_codec_info.avk_config.codec_info = p_scb->cfg.codec_info;
1711       p_scb->seps[p_scb->sep_idx].p_app_sink_data_cback(
1712           p_scb->PeerAddress(), BTA_AV_SINK_MEDIA_CFG_EVT, &av_sink_codec_info);
1713     }
1714
1715     if (uuid_int == UUID_SERVCLASS_AUDIO_SOURCE) {
1716       A2DP_AdjustCodec(cfg.codec_info);
1717     }
1718
1719     /* open the stream */
1720     AVDT_OpenReq(p_scb->seps[p_scb->sep_idx].av_handle, p_scb->PeerAddress(),
1721                  p_scb->hdi, p_scb->sep_info[p_scb->sep_info_idx].seid, &cfg);
1722   } else {
1723     /* try the next stream, if any */
1724     p_scb->sep_info_idx++;
1725     bta_av_next_getcap(p_scb, p_data);
1726   }
1727 }
1728
1729 /*******************************************************************************
1730  *
1731  * Function         bta_av_setconfig_rej
1732  *
1733  * Description      Send AVDTP set config reject.
1734  *
1735  * Returns          void
1736  *
1737  ******************************************************************************/
1738 void bta_av_setconfig_rej(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
1739   tBTA_AV_REJECT reject;
1740   uint8_t avdt_handle = p_data->ci_setconfig.avdt_handle;
1741
1742   bta_av_adjust_seps_idx(p_scb, avdt_handle);
1743   LOG_INFO("%s: sep_idx=%d avdt_handle=%d bta_handle=0x%x", __func__,
1744            p_scb->sep_idx, p_scb->avdt_handle, p_scb->hndl);
1745   AVDT_ConfigRsp(p_scb->avdt_handle, p_scb->avdt_label, AVDT_ERR_UNSUP_CFG, 0);
1746
1747   reject.bd_addr = p_data->str_msg.bd_addr;
1748   reject.hndl = p_scb->hndl;
1749
1750   tBTA_AV bta_av_data;
1751   bta_av_data.reject = reject;
1752   (*bta_av_cb.p_cback)(BTA_AV_REJECT_EVT, &bta_av_data);
1753 }
1754
1755 /*******************************************************************************
1756  *
1757  * Function         bta_av_discover_req
1758  *
1759  * Description      Send an AVDTP discover request to the peer.
1760  *
1761  * Returns          void
1762  *
1763  ******************************************************************************/
1764 void bta_av_discover_req(tBTA_AV_SCB* p_scb, UNUSED_ATTR tBTA_AV_DATA* p_data) {
1765   /* send avdtp discover request */
1766
1767   AVDT_DiscoverReq(p_scb->PeerAddress(), p_scb->hdi, p_scb->sep_info,
1768                    BTA_AV_NUM_SEPS, &bta_av_proc_stream_evt);
1769 }
1770
1771 /*******************************************************************************
1772  *
1773  * Function         bta_av_conn_failed
1774  *
1775  * Description      AVDTP connection failed.
1776  *
1777  * Returns          void
1778  *
1779  ******************************************************************************/
1780 void bta_av_conn_failed(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
1781   APPL_TRACE_ERROR("%s: peer_addr=%s open_status=%d", __func__,
1782                    p_scb->PeerAddress().ToString().c_str(), p_scb->open_status);
1783
1784   p_scb->open_status = BTA_AV_FAIL_STREAM;
1785   bta_av_str_closed(p_scb, p_data);
1786 }
1787
1788 /*******************************************************************************
1789  *
1790  * Function         bta_av_do_start
1791  *
1792  * Description      Start stream.
1793  *
1794  * Returns          void
1795  *
1796  ******************************************************************************/
1797 void bta_av_do_start(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
1798   LOG_INFO(
1799       "A2dp stream start peer:%s sco_occupied:%s av_role:0x%x started:%s "
1800       "wait:0x%x",
1801       PRIVATE_ADDRESS(p_scb->PeerAddress()),
1802       logbool(bta_av_cb.sco_occupied).c_str(), p_scb->role,
1803       logbool(p_scb->started).c_str(), p_scb->wait);
1804   if (bta_av_cb.sco_occupied) {
1805     LOG_WARN("A2dp stream start failed");
1806     bta_av_start_failed(p_scb, p_data);
1807     return;
1808   }
1809
1810   /* disallow role switch during streaming, only if we are the central role
1811    * i.e. allow role switch, if we are peripheral.
1812    * It would not hurt us, if the peer device wants us to be central */
1813   tHCI_ROLE cur_role;
1814   if ((BTM_GetRole(p_scb->PeerAddress(), &cur_role) == BTM_SUCCESS) &&
1815       (cur_role == HCI_ROLE_CENTRAL)) {
1816     BTM_block_role_switch_for(p_scb->PeerAddress());
1817   }
1818   BTM_block_sniff_mode_for(p_scb->PeerAddress());
1819
1820   if (p_scb->started) {
1821     p_scb->role |= BTA_AV_ROLE_START_INT;
1822     if (p_scb->wait != 0) {
1823       LOG_WARN(
1824           "%s: peer %s start stream request ignored: "
1825           "already waiting: sco_occupied:%s role:0x%x started:%s wait:0x%x",
1826           __func__, p_scb->PeerAddress().ToString().c_str(),
1827           logbool(bta_av_cb.sco_occupied).c_str(), p_scb->role,
1828           logbool(p_scb->started).c_str(), p_scb->wait);
1829       return;
1830     }
1831     if (p_scb->role & BTA_AV_ROLE_SUSPEND) {
1832       notify_start_failed(p_scb);
1833     } else {
1834       bta_av_start_ok(p_scb, NULL);
1835     }
1836     return;
1837   }
1838
1839   if ((p_scb->role & BTA_AV_ROLE_START_INT) != 0) {
1840     LOG_WARN(
1841         "%s: peer %s start stream request ignored: "
1842         "already initiated: sco_occupied:%s role:0x%x started:%s wait:0x%x",
1843         __func__, p_scb->PeerAddress().ToString().c_str(),
1844         logbool(bta_av_cb.sco_occupied).c_str(), p_scb->role,
1845         logbool(p_scb->started).c_str(), p_scb->wait);
1846     return;
1847   }
1848
1849   p_scb->role |= BTA_AV_ROLE_START_INT;
1850   bta_sys_busy(BTA_ID_AV, bta_av_cb.audio_open_cnt, p_scb->PeerAddress());
1851   uint16_t result = AVDT_StartReq(&p_scb->avdt_handle, 1);
1852   if (result != AVDT_SUCCESS) {
1853     LOG_ERROR("%s: AVDT_StartReq failed for peer %s result:%d", __func__,
1854               p_scb->PeerAddress().ToString().c_str(), result);
1855     bta_av_start_failed(p_scb, p_data);
1856   }
1857   LOG_INFO(
1858       "%s: peer %s start requested: sco_occupied:%s role:0x%x "
1859       "started:%s wait:0x%x",
1860       __func__, p_scb->PeerAddress().ToString().c_str(),
1861       logbool(bta_av_cb.sco_occupied).c_str(), p_scb->role,
1862       logbool(p_scb->started).c_str(), p_scb->wait);
1863 }
1864
1865 /*******************************************************************************
1866  *
1867  * Function         bta_av_str_stopped
1868  *
1869  * Description      Stream stopped.
1870  *
1871  * Returns          void
1872  *
1873  ******************************************************************************/
1874 void bta_av_str_stopped(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
1875   tBTA_AV_SUSPEND suspend_rsp;
1876   uint8_t start = p_scb->started;
1877   bool sus_evt = true;
1878   BT_HDR* p_buf;
1879
1880   APPL_TRACE_ERROR(
1881       "%s: peer %s bta_handle:0x%x audio_open_cnt:%d, p_data %p start:%d",
1882       __func__, p_scb->PeerAddress().ToString().c_str(), p_scb->hndl,
1883       bta_av_cb.audio_open_cnt, p_data, start);
1884
1885   bta_sys_idle(BTA_ID_AV, bta_av_cb.audio_open_cnt, p_scb->PeerAddress());
1886   BTM_unblock_role_switch_for(p_scb->PeerAddress());
1887   BTM_unblock_sniff_mode_for(p_scb->PeerAddress());
1888
1889   if (p_scb->co_started) {
1890     if (bta_av_cb.offload_started_hndl == p_scb->hndl) {
1891       bta_av_vendor_offload_stop();
1892       bta_av_cb.offload_started_hndl = 0;
1893     } else if (bta_av_cb.offload_start_pending_hndl == p_scb->hndl) {
1894       APPL_TRACE_WARNING("%s: Stop pending offload start command", __func__);
1895       bta_av_vendor_offload_stop();
1896       bta_av_cb.offload_start_pending_hndl = 0;
1897     }
1898
1899     bta_av_stream_chg(p_scb, false);
1900     p_scb->co_started = false;
1901
1902     p_scb->p_cos->stop(p_scb->hndl, p_scb->PeerAddress());
1903   }
1904
1905   /* if q_info.a2dp_list is not empty, drop it now */
1906   if (BTA_AV_CHNL_AUDIO == p_scb->chnl) {
1907     while (!list_is_empty(p_scb->a2dp_list)) {
1908       p_buf = (BT_HDR*)list_front(p_scb->a2dp_list);
1909       list_remove(p_scb->a2dp_list, p_buf);
1910       osi_free(p_buf);
1911     }
1912
1913     /* drop the audio buffers queued in L2CAP */
1914     if (p_data && p_data->api_stop.flush)
1915       L2CA_FlushChannel(p_scb->l2c_cid, L2CAP_FLUSH_CHANS_ALL);
1916   }
1917
1918   suspend_rsp.chnl = p_scb->chnl;
1919   suspend_rsp.hndl = p_scb->hndl;
1920
1921   if (p_data && p_data->api_stop.suspend) {
1922     APPL_TRACE_DEBUG("%s: peer %s suspending: %d, sup:%d", __func__,
1923                      p_scb->PeerAddress().ToString().c_str(), start,
1924                      p_scb->suspend_sup);
1925     if ((start) && (p_scb->suspend_sup)) {
1926       sus_evt = false;
1927       p_scb->l2c_bufs = 0;
1928       AVDT_SuspendReq(&p_scb->avdt_handle, 1);
1929     }
1930
1931     /* send SUSPEND_EVT event only if not in reconfiguring state and sus_evt is
1932      * true*/
1933     if ((sus_evt) && (p_scb->state != BTA_AV_RCFG_SST)) {
1934       suspend_rsp.status = BTA_AV_SUCCESS;
1935       suspend_rsp.initiator = true;
1936       tBTA_AV bta_av_data;
1937       bta_av_data.suspend = suspend_rsp;
1938       (*bta_av_cb.p_cback)(BTA_AV_SUSPEND_EVT, &bta_av_data);
1939     }
1940   } else {
1941     suspend_rsp.status = BTA_AV_SUCCESS;
1942     suspend_rsp.initiator = true;
1943     APPL_TRACE_EVENT("%s: status %d", __func__, suspend_rsp.status);
1944
1945     // Send STOP_EVT event only if not in reconfiguring state.
1946     // However, we should send STOP_EVT if we are reconfiguring when taking
1947     // the Close->Configure->Open->Start path.
1948     if (p_scb->state != BTA_AV_RCFG_SST ||
1949         (p_data && p_data->api_stop.reconfig_stop)) {
1950       tBTA_AV bta_av_data;
1951       bta_av_data.suspend = suspend_rsp;
1952       (*bta_av_cb.p_cback)(BTA_AV_STOP_EVT, &bta_av_data);
1953     }
1954   }
1955 }
1956
1957 /*******************************************************************************
1958  *
1959  * Function         bta_av_reconfig
1960  *
1961  * Description      process the reconfigure request.
1962  *                  save the parameter in control block and
1963  *                  suspend, reconfigure or close the stream
1964  *
1965  * Returns          void
1966  *
1967  ******************************************************************************/
1968 void bta_av_reconfig(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
1969   AvdtpSepConfig* p_cfg;
1970   tBTA_AV_API_STOP stop;
1971   tBTA_AV_API_RCFG* p_rcfg = &p_data->api_reconfig;
1972
1973   APPL_TRACE_DEBUG("%s: r:%d, s:%d idx: %d (o:%d)", __func__, p_scb->recfg_sup,
1974                    p_scb->suspend_sup, p_scb->rcfg_idx, p_scb->sep_info_idx);
1975
1976   p_scb->num_recfg = 0;
1977   /* store the new configuration in control block */
1978   p_cfg = &p_scb->cfg;
1979
1980   alarm_cancel(p_scb->avrc_ct_timer);
1981
1982   LOG_DEBUG("p_scb->sep_info_idx=%d p_scb->rcfg_idx=%d p_rcfg->sep_info_idx=%d",
1983             p_scb->sep_info_idx, p_scb->rcfg_idx, p_rcfg->sep_info_idx);
1984   LOG_DEBUG("Peer capable codec: %s",
1985             A2DP_CodecInfoString(p_scb->peer_cap.codec_info).c_str());
1986   LOG_DEBUG("Current codec: %s",
1987             A2DP_CodecInfoString(p_scb->cfg.codec_info).c_str());
1988   LOG_DEBUG("Reconfig codec: %s",
1989             A2DP_CodecInfoString(p_rcfg->codec_info).c_str());
1990
1991   BTM_LogHistory(
1992       kBtmLogTag, p_scb->PeerAddress(), "Codec reconfig",
1993       base::StringPrintf("%s => %s", A2DP_CodecName(p_scb->cfg.codec_info),
1994                          A2DP_CodecName(p_rcfg->codec_info)));
1995
1996   p_cfg->num_protect = p_rcfg->num_protect;
1997   memcpy(p_cfg->codec_info, p_rcfg->codec_info, AVDT_CODEC_SIZE);
1998   memcpy(p_cfg->protect_info, p_rcfg->p_protect_info, p_rcfg->num_protect);
1999   p_scb->rcfg_idx = p_rcfg->sep_info_idx;
2000   p_cfg->psc_mask = p_scb->cur_psc_mask;
2001
2002   // If the requested SEP index is same as the current one, then we
2003   // can Suspend->Reconfigure->Start.
2004   // Otherwise, we have to Close->Configure->Open->Start or
2005   // Close->Configure->Open for streams that are / are not started.
2006   if ((p_scb->rcfg_idx == p_scb->sep_info_idx) && p_rcfg->suspend &&
2007       p_scb->recfg_sup && p_scb->suspend_sup) {
2008     if (p_scb->started) {
2009       // Suspend->Reconfigure->Start
2010       stop.flush = false;
2011       stop.suspend = true;
2012       stop.reconfig_stop = false;
2013       bta_av_str_stopped(p_scb, (tBTA_AV_DATA*)&stop);
2014     } else {
2015       // Reconfigure
2016       APPL_TRACE_DEBUG("%s: reconfig", __func__);
2017       APPL_TRACE_DEBUG("%s: codec: %s", __func__,
2018                        A2DP_CodecInfoString(p_scb->cfg.codec_info).c_str());
2019       AVDT_ReconfigReq(p_scb->avdt_handle, &p_scb->cfg);
2020       p_scb->cfg.psc_mask = p_scb->cur_psc_mask;
2021     }
2022   } else {
2023     // Close the stream first, and then Configure it
2024     APPL_TRACE_DEBUG("%s: Close/Open started: %d state: %d num_protect: %d",
2025                      __func__, p_scb->started, p_scb->state,
2026                      p_cfg->num_protect);
2027     if (p_scb->started) {
2028       // Close->Configure->Open->Start
2029       if ((p_scb->rcfg_idx != p_scb->sep_info_idx) && p_scb->recfg_sup) {
2030         // Make sure we trigger STOP_EVT when taking the longer road to
2031         // reconfiguration, otherwise we don't call Start.
2032         stop.flush = false;
2033         stop.suspend = false;
2034         stop.reconfig_stop = true;
2035         bta_av_str_stopped(p_scb, (tBTA_AV_DATA*)&stop);
2036       } else {
2037         bta_av_str_stopped(p_scb, NULL);
2038       }
2039       p_scb->started = false;
2040     } else {
2041       // Close->Configure->Open
2042       bta_av_str_stopped(p_scb, NULL);
2043     }
2044     // Drop the buffers queued in L2CAP
2045     L2CA_FlushChannel(p_scb->l2c_cid, L2CAP_FLUSH_CHANS_ALL);
2046     AVDT_CloseReq(p_scb->avdt_handle);
2047   }
2048 }
2049
2050 /*******************************************************************************
2051  *
2052  * Function         bta_av_data_path
2053  *
2054  * Description      Handle stream data path.
2055  *
2056  * Returns          void
2057  *
2058  ******************************************************************************/
2059 void bta_av_data_path(tBTA_AV_SCB* p_scb, UNUSED_ATTR tBTA_AV_DATA* p_data) {
2060   BT_HDR* p_buf = NULL;
2061   uint32_t timestamp;
2062   bool new_buf = false;
2063   uint8_t m_pt = 0x60;
2064   tAVDT_DATA_OPT_MASK opt;
2065
2066   if (!p_scb->started) return;
2067
2068   if (p_scb->cong) return;
2069
2070   if (p_scb->use_rtp_header_marker_bit) {
2071     m_pt |= AVDT_MARKER_SET;
2072   }
2073
2074   // Always get the current number of bufs que'd up
2075   p_scb->l2c_bufs =
2076       (uint8_t)L2CA_FlushChannel(p_scb->l2c_cid, L2CAP_FLUSH_CHANS_GET);
2077
2078   if (!list_is_empty(p_scb->a2dp_list)) {
2079     p_buf = (BT_HDR*)list_front(p_scb->a2dp_list);
2080     list_remove(p_scb->a2dp_list, p_buf);
2081     /* use q_info.a2dp data, read the timestamp */
2082     timestamp = *(uint32_t*)(p_buf + 1);
2083   } else {
2084     new_buf = true;
2085     /* A2DP_list empty, call co_data, dup data to other channels */
2086     p_buf = p_scb->p_cos->data(p_scb->cfg.codec_info, &timestamp);
2087
2088     if (p_buf) {
2089       /* use the offset area for the time stamp */
2090       *(uint32_t*)(p_buf + 1) = timestamp;
2091
2092       /* dup the data to other channels */
2093       bta_av_dup_audio_buf(p_scb, p_buf);
2094     }
2095   }
2096
2097   if (p_buf) {
2098     if (p_scb->l2c_bufs < (BTA_AV_QUEUE_DATA_CHK_NUM)) {
2099       /* There's a buffer, just queue it to L2CAP.
2100        * There's no need to increment it here, it is always read from
2101        * L2CAP (see above).
2102        */
2103
2104       /* opt is a bit mask, it could have several options set */
2105       opt = AVDT_DATA_OPT_NONE;
2106       if (p_scb->no_rtp_header) {
2107         opt |= AVDT_DATA_OPT_NO_RTP;
2108       }
2109
2110       //
2111       // Fragment the payload if larger than the MTU.
2112       // NOTE: The fragmentation is RTP-compatibie.
2113       //
2114       size_t extra_fragments_n = 0;
2115       if (p_buf->len > 0) {
2116         extra_fragments_n = (p_buf->len / p_scb->stream_mtu) +
2117                             ((p_buf->len % p_scb->stream_mtu) ? 1 : 0) - 1;
2118       }
2119       std::vector<BT_HDR*> extra_fragments;
2120       extra_fragments.reserve(extra_fragments_n);
2121
2122       uint8_t* data_begin = (uint8_t*)(p_buf + 1) + p_buf->offset;
2123       uint8_t* data_end = (uint8_t*)(p_buf + 1) + p_buf->offset + p_buf->len;
2124       while (extra_fragments_n-- > 0) {
2125         data_begin += p_scb->stream_mtu;
2126         size_t fragment_len = data_end - data_begin;
2127         if (fragment_len > p_scb->stream_mtu) fragment_len = p_scb->stream_mtu;
2128
2129         BT_HDR* p_buf2 = (BT_HDR*)osi_malloc(BT_DEFAULT_BUFFER_SIZE);
2130         p_buf2->offset = p_buf->offset;
2131         p_buf2->len = 0;
2132         p_buf2->layer_specific = 0;
2133         uint8_t* packet2 =
2134             (uint8_t*)(p_buf2 + 1) + p_buf2->offset + p_buf2->len;
2135         memcpy(packet2, data_begin, fragment_len);
2136         p_buf2->len += fragment_len;
2137         extra_fragments.push_back(p_buf2);
2138         p_buf->len -= fragment_len;
2139       }
2140
2141       if (!extra_fragments.empty()) {
2142         // Reset the RTP Marker bit for all fragments except the last one
2143         m_pt &= ~AVDT_MARKER_SET;
2144       }
2145       AVDT_WriteReqOpt(p_scb->avdt_handle, p_buf, timestamp, m_pt, opt);
2146       for (size_t i = 0; i < extra_fragments.size(); i++) {
2147         if (i + 1 == extra_fragments.size()) {
2148           // Set the RTP Marker bit for the last fragment
2149           m_pt |= AVDT_MARKER_SET;
2150         }
2151         BT_HDR* p_buf2 = extra_fragments[i];
2152         AVDT_WriteReqOpt(p_scb->avdt_handle, p_buf2, timestamp, m_pt, opt);
2153       }
2154       p_scb->cong = true;
2155     } else {
2156       /* there's a buffer, but L2CAP does not seem to be moving data */
2157       if (new_buf) {
2158         /* just got this buffer from co_data,
2159          * put it in queue */
2160         list_append(p_scb->a2dp_list, p_buf);
2161       } else {
2162         /* just dequeue it from the a2dp_list */
2163         if (list_length(p_scb->a2dp_list) < 3) {
2164           /* put it back to the queue */
2165           list_prepend(p_scb->a2dp_list, p_buf);
2166         } else {
2167           /* too many buffers in a2dp_list, drop it. */
2168           bta_av_co_audio_drop(p_scb->hndl, p_scb->PeerAddress());
2169           osi_free(p_buf);
2170         }
2171       }
2172     }
2173   }
2174 }
2175
2176 /*******************************************************************************
2177  *
2178  * Function         bta_av_start_ok
2179  *
2180  * Description      Stream started.
2181  *
2182  * Returns          void
2183  *
2184  ******************************************************************************/
2185 void bta_av_start_ok(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
2186   bool initiator = false;
2187   bool suspend = false;
2188   uint8_t new_role = p_scb->role;
2189   BT_HDR_RIGID hdr;
2190   tHCI_ROLE cur_role;
2191   uint8_t local_tsep = p_scb->seps[p_scb->sep_idx].tsep;
2192
2193   LOG_INFO("%s: peer %s bta_handle:0x%x wait:0x%x role:0x%x local_tsep:%d",
2194            __func__, p_scb->PeerAddress().ToString().c_str(), p_scb->hndl,
2195            p_scb->wait, p_scb->role, local_tsep);
2196
2197   p_scb->started = true;
2198
2199   if (local_tsep == AVDT_TSEP_SRC) {
2200     // The RTP Header marker bit for the A2DP Source encoder
2201     A2dpCodecConfig* codec_config =
2202         bta_av_get_a2dp_peer_current_codec(p_scb->PeerAddress());
2203     CHECK(codec_config != nullptr);
2204     p_scb->use_rtp_header_marker_bit = codec_config->useRtpHeaderMarkerBit();
2205   }
2206
2207   if (p_scb->sco_suspend) {
2208     p_scb->sco_suspend = false;
2209   }
2210
2211   if (new_role & BTA_AV_ROLE_START_INT) initiator = true;
2212
2213   /* for A2DP SINK we do not send get_caps */
2214   if ((p_scb->avdt_handle == p_scb->seps[p_scb->sep_idx].av_handle) &&
2215       (local_tsep == AVDT_TSEP_SNK)) {
2216     p_scb->wait &= ~(BTA_AV_WAIT_ACP_CAPS_ON);
2217     APPL_TRACE_DEBUG("%s: local SEP type is SNK new wait is 0x%x", __func__,
2218                      p_scb->wait);
2219   }
2220   if (p_scb->wait & BTA_AV_WAIT_ROLE_SW_FAILED) {
2221     /* role switch has failed */
2222     APPL_TRACE_ERROR(
2223         "%s: peer %s role switch failed: bta_handle:0x%x wait:0x%x, role:0x%x",
2224         __func__, p_scb->PeerAddress().ToString().c_str(), p_scb->hndl,
2225         p_scb->wait, p_scb->role);
2226     p_scb->wait &= ~BTA_AV_WAIT_ROLE_SW_FAILED;
2227     p_data = (tBTA_AV_DATA*)&hdr;
2228     hdr.offset = BTA_AV_RS_FAIL;
2229   }
2230   APPL_TRACE_DEBUG("%s: peer %s wait:0x%x use_rtp_header_marker_bit:%s",
2231                    __func__, p_scb->PeerAddress().ToString().c_str(),
2232                    p_scb->wait,
2233                    (p_scb->use_rtp_header_marker_bit) ? "true" : "false");
2234
2235   if (p_data && (p_data->hdr.offset != BTA_AV_RS_NONE)) {
2236     p_scb->wait &= ~BTA_AV_WAIT_ROLE_SW_BITS;
2237     if (p_data->hdr.offset == BTA_AV_RS_FAIL) {
2238       bta_sys_idle(BTA_ID_AV, bta_av_cb.audio_open_cnt, p_scb->PeerAddress());
2239       tBTA_AV_START start;
2240       start.chnl = p_scb->chnl;
2241       start.status = BTA_AV_FAIL_ROLE;
2242       start.hndl = p_scb->hndl;
2243       start.initiator = initiator;
2244       tBTA_AV bta_av_data;
2245       bta_av_data.start = start;
2246       (*bta_av_cb.p_cback)(BTA_AV_START_EVT, &bta_av_data);
2247       return;
2248     }
2249   }
2250
2251   if (!bta_av_link_role_ok(p_scb, A2DP_SET_ONE_BIT))
2252     p_scb->q_tag = BTA_AV_Q_TAG_START;
2253   else {
2254     /* The wait flag may be set here while we are already central on the link */
2255     /* this could happen if a role switch complete event occurred during
2256      * reconfig */
2257     /* if we are now central on the link, there is no need to wait for the role
2258      * switch, */
2259     /* complete anymore so we can clear the wait for role switch flag */
2260     p_scb->wait &= ~BTA_AV_WAIT_ROLE_SW_BITS;
2261   }
2262
2263   if (p_scb->wait &
2264       (BTA_AV_WAIT_ROLE_SW_RES_OPEN | BTA_AV_WAIT_ROLE_SW_RES_START)) {
2265     p_scb->wait |= BTA_AV_WAIT_ROLE_SW_STARTED;
2266     p_scb->q_tag = BTA_AV_Q_TAG_START;
2267   }
2268
2269   if (p_scb->wait) {
2270     APPL_TRACE_ERROR("%s: peer %s wait:0x%x q_tag:%d not started", __func__,
2271                      p_scb->PeerAddress().ToString().c_str(), p_scb->wait,
2272                      p_scb->q_tag);
2273     /* Clear first bit of p_scb->wait and not to return from this point else
2274      * HAL layer gets blocked. And if there is delay in Get Capability response
2275      * as
2276      * first bit of p_scb->wait is cleared hence it ensures bt_av_start_ok is
2277      * not called
2278      * again from bta_av_save_caps.
2279      */
2280     p_scb->wait &= ~BTA_AV_WAIT_ACP_CAPS_ON;
2281   }
2282
2283   /* tell role manager to check M/S role */
2284   bta_sys_conn_open(BTA_ID_AV, p_scb->app_id, p_scb->PeerAddress());
2285
2286   bta_sys_busy(BTA_ID_AV, bta_av_cb.audio_open_cnt, p_scb->PeerAddress());
2287
2288   if (p_scb->media_type == AVDT_MEDIA_TYPE_AUDIO) {
2289     /* in normal logic, conns should be bta_av_cb.audio_count - 1,
2290      * However, bta_av_stream_chg is not called to increase
2291      * bta_av_cb.audio_count yet.
2292      * If the code were to be re-arranged for some reasons, this number may need
2293      * to be changed
2294      */
2295     p_scb->co_started = bta_av_cb.audio_open_cnt;
2296   }
2297
2298   /* clear the congestion flag */
2299   p_scb->cong = false;
2300
2301   if (new_role & BTA_AV_ROLE_START_INT) {
2302     new_role &= ~BTA_AV_ROLE_START_INT;
2303   } else if ((new_role & BTA_AV_ROLE_AD_ACP) &&
2304              (new_role & BTA_AV_ROLE_SUSPEND_OPT)) {
2305     suspend = true;
2306   }
2307
2308   if (!suspend) {
2309     p_scb->q_tag = BTA_AV_Q_TAG_STREAM;
2310     bta_av_stream_chg(p_scb, true);
2311   }
2312
2313   {
2314     /* If sink starts stream, disable sniff mode here */
2315     if (!initiator) {
2316       /* If souce is the central role, disable role switch during streaming.
2317        * Otherwise allow role switch, if source is peripheral.
2318        * Because it would not hurt source, if the peer device wants source to be
2319        * central */
2320       if ((BTM_GetRole(p_scb->PeerAddress(), &cur_role) == BTM_SUCCESS) &&
2321           (cur_role == HCI_ROLE_CENTRAL)) {
2322         BTM_block_role_switch_for(p_scb->PeerAddress());
2323       }
2324     }
2325
2326     p_scb->role = new_role;
2327     p_scb->role &= ~BTA_AV_ROLE_AD_ACP;
2328     p_scb->role &= ~BTA_AV_ROLE_SUSPEND_OPT;
2329
2330     p_scb->no_rtp_header = false;
2331     p_scb->p_cos->start(p_scb->hndl, p_scb->PeerAddress(),
2332                         p_scb->cfg.codec_info, &p_scb->no_rtp_header);
2333     p_scb->co_started = true;
2334
2335     APPL_TRACE_DEBUG("%s: peer %s suspending: %d, role:0x%x, init %d", __func__,
2336                      p_scb->PeerAddress().ToString().c_str(), suspend,
2337                      p_scb->role, initiator);
2338
2339     tBTA_AV_START start;
2340     start.suspending = suspend;
2341     start.initiator = initiator;
2342     start.chnl = p_scb->chnl;
2343     start.status = BTA_AV_SUCCESS;
2344     start.hndl = p_scb->hndl;
2345     tBTA_AV bta_av_data;
2346     bta_av_data.start = start;
2347     (*bta_av_cb.p_cback)(BTA_AV_START_EVT, &bta_av_data);
2348
2349     if (suspend) {
2350       tBTA_AV_API_STOP stop;
2351       p_scb->role |= BTA_AV_ROLE_SUSPEND;
2352       p_scb->cong = true; /* do not allow the media data to go through */
2353       /* do not duplicate the media packets to this channel */
2354       p_scb->p_cos->stop(p_scb->hndl, p_scb->PeerAddress());
2355       p_scb->co_started = false;
2356       stop.flush = false;
2357       stop.suspend = true;
2358       stop.reconfig_stop = false;
2359       bta_av_ssm_execute(p_scb, BTA_AV_AP_STOP_EVT, (tBTA_AV_DATA*)&stop);
2360     }
2361   }
2362 }
2363
2364 /*******************************************************************************
2365  *
2366  * Function         bta_av_start_failed
2367  *
2368  * Description      Stream start failed.
2369  *
2370  * Returns          void
2371  *
2372  ******************************************************************************/
2373 void bta_av_start_failed(tBTA_AV_SCB* p_scb, UNUSED_ATTR tBTA_AV_DATA* p_data) {
2374   APPL_TRACE_ERROR(
2375       "%s: peer %s bta_handle:0x%x audio_open_cnt:%d started:%s co_started:%d",
2376       __func__, p_scb->PeerAddress().ToString().c_str(), p_scb->hndl,
2377       bta_av_cb.audio_open_cnt, logbool(p_scb->started).c_str(),
2378       p_scb->co_started);
2379
2380   if (!p_scb->started && !p_scb->co_started) {
2381     bta_sys_idle(BTA_ID_AV, bta_av_cb.audio_open_cnt, p_scb->PeerAddress());
2382     notify_start_failed(p_scb);
2383   }
2384
2385   BTM_unblock_role_switch_for(p_scb->PeerAddress());
2386   BTM_unblock_sniff_mode_for(p_scb->PeerAddress());
2387   p_scb->sco_suspend = false;
2388 }
2389
2390 /*******************************************************************************
2391  *
2392  * Function         bta_av_str_closed
2393  *
2394  * Description      Stream closed.
2395  *
2396  * Returns          void
2397  *
2398  ******************************************************************************/
2399 void bta_av_str_closed(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
2400   tBTA_AV data;
2401   tBTA_AV_EVT event;
2402
2403   APPL_TRACE_WARNING(
2404       "%s: peer %s bta_handle:0x%x open_status:%d chnl:%d co_started:%d",
2405       __func__, p_scb->PeerAddress().ToString().c_str(), p_scb->hndl,
2406       p_scb->open_status, p_scb->chnl, p_scb->co_started);
2407
2408   BTM_unblock_role_switch_for(p_scb->PeerAddress());
2409   BTM_unblock_sniff_mode_for(p_scb->PeerAddress());
2410   if (bta_av_cb.audio_open_cnt <= 1) {
2411     BTM_default_unblock_role_switch();
2412   }
2413
2414   if (p_scb->open_status != BTA_AV_SUCCESS) {
2415     /* must be failure when opening the stream */
2416     data.open.bd_addr = p_scb->PeerAddress();
2417     data.open.status = p_scb->open_status;
2418     data.open.chnl = p_scb->chnl;
2419     data.open.hndl = p_scb->hndl;
2420
2421     if (p_scb->seps[p_scb->sep_idx].tsep == AVDT_TSEP_SRC)
2422       data.open.sep = AVDT_TSEP_SNK;
2423     else if (p_scb->seps[p_scb->sep_idx].tsep == AVDT_TSEP_SNK)
2424       data.open.sep = AVDT_TSEP_SRC;
2425
2426     event = BTA_AV_OPEN_EVT;
2427     p_scb->open_status = BTA_AV_SUCCESS;
2428
2429     bta_sys_conn_close(BTA_ID_AV, p_scb->app_id, p_scb->PeerAddress());
2430     bta_av_cleanup(p_scb, p_data);
2431     (*bta_av_cb.p_cback)(event, &data);
2432   } else {
2433     /* do stop if we were started */
2434     if (p_scb->co_started) {
2435       bta_av_str_stopped(p_scb, NULL);
2436     }
2437
2438     {
2439       p_scb->p_cos->close(p_scb->hndl, p_scb->PeerAddress());
2440       data.close.chnl = p_scb->chnl;
2441       data.close.hndl = p_scb->hndl;
2442       event = BTA_AV_CLOSE_EVT;
2443
2444       bta_sys_conn_close(BTA_ID_AV, p_scb->app_id, p_scb->PeerAddress());
2445       bta_av_cleanup(p_scb, p_data);
2446       (*bta_av_cb.p_cback)(event, &data);
2447     }
2448   }
2449 }
2450
2451 /*******************************************************************************
2452  *
2453  * Function         bta_av_clr_cong
2454  *
2455  * Description      Clear stream congestion flag.
2456  *
2457  * Returns          void
2458  *
2459  ******************************************************************************/
2460 void bta_av_clr_cong(tBTA_AV_SCB* p_scb, UNUSED_ATTR tBTA_AV_DATA* p_data) {
2461   APPL_TRACE_DEBUG("%s", __func__);
2462   if (p_scb->co_started) {
2463     p_scb->cong = false;
2464   }
2465 }
2466
2467 /*******************************************************************************
2468  *
2469  * Function         bta_av_suspend_cfm
2470  *
2471  * Description      process the suspend response
2472  *
2473  * Returns          void
2474  *
2475  ******************************************************************************/
2476 void bta_av_suspend_cfm(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
2477   tBTA_AV_SUSPEND suspend_rsp;
2478   uint8_t err_code = p_data->str_msg.msg.hdr.err_code;
2479
2480   APPL_TRACE_DEBUG("%s: peer %s bta_handle:0x%x audio_open_cnt:%d err_code:%d",
2481                    __func__, p_scb->PeerAddress().ToString().c_str(),
2482                    p_scb->hndl, bta_av_cb.audio_open_cnt, err_code);
2483
2484   if (!p_scb->started) {
2485     /* handle the condition where there is a collision of SUSPEND req from
2486      *either side
2487      ** Second SUSPEND req could be rejected. Do not treat this as a failure
2488      */
2489     APPL_TRACE_WARNING("%s: already suspended, ignore, err_code %d", __func__,
2490                        err_code);
2491     return;
2492   }
2493
2494   suspend_rsp.status = BTA_AV_SUCCESS;
2495   if (err_code && (err_code != AVDT_ERR_BAD_STATE)) {
2496     suspend_rsp.status = BTA_AV_FAIL;
2497
2498     APPL_TRACE_ERROR("%s: suspend failed, closing connection", __func__);
2499
2500     /* SUSPEND failed. Close connection. */
2501     bta_av_ssm_execute(p_scb, BTA_AV_API_CLOSE_EVT, NULL);
2502   } else {
2503     /* only set started to false when suspend is successful */
2504     p_scb->started = false;
2505   }
2506
2507   if (p_scb->role & BTA_AV_ROLE_SUSPEND) {
2508     p_scb->role &= ~BTA_AV_ROLE_SUSPEND;
2509     p_scb->cong = false;
2510   }
2511
2512   bta_sys_idle(BTA_ID_AV, bta_av_cb.audio_open_cnt, p_scb->PeerAddress());
2513   BTM_unblock_role_switch_for(p_scb->PeerAddress());
2514   BTM_unblock_sniff_mode_for(p_scb->PeerAddress());
2515
2516   /* in case that we received suspend_ind, we may need to call co_stop here */
2517   if (p_scb->co_started) {
2518     if (bta_av_cb.offload_started_hndl == p_scb->hndl) {
2519       bta_av_vendor_offload_stop();
2520       bta_av_cb.offload_started_hndl = 0;
2521     } else if (bta_av_cb.offload_start_pending_hndl == p_scb->hndl) {
2522       APPL_TRACE_WARNING("%s: Stop pending offload start command", __func__);
2523       bta_av_vendor_offload_stop();
2524       bta_av_cb.offload_start_pending_hndl = 0;
2525     }
2526     bta_av_stream_chg(p_scb, false);
2527
2528     {
2529       p_scb->co_started = false;
2530       p_scb->p_cos->stop(p_scb->hndl, p_scb->PeerAddress());
2531     }
2532   }
2533
2534   {
2535     suspend_rsp.chnl = p_scb->chnl;
2536     suspend_rsp.hndl = p_scb->hndl;
2537     suspend_rsp.initiator = p_data->str_msg.initiator;
2538     tBTA_AV bta_av_data;
2539     bta_av_data.suspend = suspend_rsp;
2540     (*bta_av_cb.p_cback)(BTA_AV_SUSPEND_EVT, &bta_av_data);
2541   }
2542 }
2543
2544 /*******************************************************************************
2545  *
2546  * Function         bta_av_rcfg_str_ok
2547  *
2548  * Description      report reconfigure successful
2549  *
2550  * Returns          void
2551  *
2552  ******************************************************************************/
2553 void bta_av_rcfg_str_ok(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
2554   p_scb->l2c_cid = AVDT_GetL2CapChannel(p_scb->avdt_handle);
2555   APPL_TRACE_DEBUG("%s: peer %s bta_handle:0x%x l2c_cid:%d", __func__,
2556                    p_scb->PeerAddress().ToString().c_str(), p_scb->hndl,
2557                    p_scb->l2c_cid);
2558
2559   if (p_data != NULL) {
2560     // p_data could be NULL if the reconfig was triggered by the local device
2561     p_scb->stream_mtu =
2562         p_data->str_msg.msg.open_ind.peer_mtu - AVDT_MEDIA_HDR_SIZE;
2563     APPL_TRACE_DEBUG("%s: l2c_cid: 0x%x stream_mtu: %d", __func__,
2564                      p_scb->l2c_cid, p_scb->stream_mtu);
2565     p_scb->p_cos->update_mtu(p_scb->hndl, p_scb->PeerAddress(),
2566                              p_scb->stream_mtu);
2567   }
2568
2569   /* rc listen */
2570   bta_av_st_rc_timer(p_scb, NULL);
2571
2572   /* No need to keep the role bits once reconfig is done. */
2573   p_scb->role &= ~BTA_AV_ROLE_AD_ACP;
2574   p_scb->role &= ~BTA_AV_ROLE_SUSPEND_OPT;
2575   p_scb->role &= ~BTA_AV_ROLE_START_INT;
2576
2577   {
2578     /* reconfigure success  */
2579     tBTA_AV_RECONFIG reconfig;
2580     reconfig.status = BTA_AV_SUCCESS;
2581     reconfig.chnl = p_scb->chnl;
2582     reconfig.hndl = p_scb->hndl;
2583     tBTA_AV bta_av_data;
2584     bta_av_data.reconfig = reconfig;
2585     (*bta_av_cb.p_cback)(BTA_AV_RECONFIG_EVT, &bta_av_data);
2586   }
2587 }
2588
2589 /*******************************************************************************
2590  *
2591  * Function         bta_av_rcfg_failed
2592  *
2593  * Description      process reconfigure failed
2594  *
2595  * Returns          void
2596  *
2597  ******************************************************************************/
2598 void bta_av_rcfg_failed(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
2599   APPL_TRACE_ERROR("%s: num_recfg=%d conn_lcb=0x%x peer_addr=%s", __func__,
2600                    p_scb->num_recfg, bta_av_cb.conn_lcb,
2601                    p_scb->PeerAddress().ToString().c_str());
2602
2603   if (p_scb->num_recfg > BTA_AV_RECONFIG_RETRY) {
2604     bta_av_cco_close(p_scb, p_data);
2605     /* report failure */
2606     tBTA_AV_RECONFIG reconfig;
2607     reconfig.status = BTA_AV_FAIL_STREAM;
2608     reconfig.chnl = p_scb->chnl;
2609     reconfig.hndl = p_scb->hndl;
2610     tBTA_AV bta_av_data;
2611     bta_av_data.reconfig = reconfig;
2612     (*bta_av_cb.p_cback)(BTA_AV_RECONFIG_EVT, &bta_av_data);
2613     /* go to closing state */
2614     bta_av_ssm_execute(p_scb, BTA_AV_API_CLOSE_EVT, NULL);
2615   } else {
2616     /* open failed. try again */
2617     p_scb->num_recfg++;
2618     // conn_lcb is the index bitmask of all used LCBs, and since LCB and SCB use
2619     // the same index, it should be safe to use SCB index here.
2620     if ((bta_av_cb.conn_lcb & (1 << p_scb->hdi)) != 0) {
2621       AVDT_DisconnectReq(p_scb->PeerAddress(), &bta_av_proc_stream_evt);
2622     } else {
2623       APPL_TRACE_WARNING("%s: conn_lcb=0x%x bta_handle=0x%x (hdi=%u) no link",
2624                          __func__, bta_av_cb.conn_lcb, p_scb->hndl, p_scb->hdi);
2625       bta_av_connect_req(p_scb, NULL);
2626     }
2627   }
2628 }
2629
2630 /*******************************************************************************
2631  *
2632  * Function         bta_av_rcfg_connect
2633  *
2634  * Description      stream closed. reconnect the stream
2635  *
2636  * Returns          void
2637  *
2638  ******************************************************************************/
2639 void bta_av_rcfg_connect(tBTA_AV_SCB* p_scb, UNUSED_ATTR tBTA_AV_DATA* p_data) {
2640   APPL_TRACE_DEBUG("%s", __func__);
2641
2642   p_scb->cong = false;
2643   p_scb->num_recfg++;
2644   APPL_TRACE_DEBUG("%s: num_recfg: %d", __func__, p_scb->num_recfg);
2645   if (p_scb->num_recfg > BTA_AV_RECONFIG_RETRY) {
2646     /* let bta_av_rcfg_failed report fail */
2647     bta_av_rcfg_failed(p_scb, NULL);
2648   } else {
2649     AVDT_ConnectReq(p_scb->PeerAddress(), p_scb->hdi, &bta_av_proc_stream_evt);
2650   }
2651 }
2652
2653 /*******************************************************************************
2654  *
2655  * Function         bta_av_rcfg_discntd
2656  *
2657  * Description      AVDT disconnected. reconnect the stream
2658  *
2659  * Returns          void
2660  *
2661  ******************************************************************************/
2662 void bta_av_rcfg_discntd(tBTA_AV_SCB* p_scb, UNUSED_ATTR tBTA_AV_DATA* p_data) {
2663   APPL_TRACE_ERROR("%s: num_recfg=%d conn_lcb=0x%x peer_addr=%s", __func__,
2664                    p_scb->num_recfg, bta_av_cb.conn_lcb,
2665                    p_scb->PeerAddress().ToString().c_str());
2666
2667   p_scb->num_recfg++;
2668   if (p_scb->num_recfg > BTA_AV_RECONFIG_RETRY) {
2669     /* report failure */
2670     tBTA_AV_RECONFIG reconfig;
2671     reconfig.status = BTA_AV_FAIL_STREAM;
2672     reconfig.chnl = p_scb->chnl;
2673     reconfig.hndl = p_scb->hndl;
2674     tBTA_AV bta_av_data;
2675     bta_av_data.reconfig = reconfig;
2676     (*bta_av_cb.p_cback)(BTA_AV_RECONFIG_EVT, &bta_av_data);
2677     /* report close event & go to init state */
2678     bta_av_ssm_execute(p_scb, BTA_AV_STR_DISC_FAIL_EVT, NULL);
2679   } else {
2680     AVDT_ConnectReq(p_scb->PeerAddress(), p_scb->hdi, &bta_av_proc_stream_evt);
2681   }
2682 }
2683
2684 /*******************************************************************************
2685  *
2686  * Function         bta_av_suspend_cont
2687  *
2688  * Description      received the suspend response.
2689  *                  continue to reconfigure the stream
2690  *
2691  * Returns          void
2692  *
2693  ******************************************************************************/
2694 void bta_av_suspend_cont(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
2695   uint8_t err_code = p_data->str_msg.msg.hdr.err_code;
2696
2697   APPL_TRACE_DEBUG("%s: err_code=%d", __func__, err_code);
2698
2699   p_scb->started = false;
2700   p_scb->cong = false;
2701   if (err_code) {
2702     if (AVDT_ERR_CONNECT == err_code) {
2703       /* report failure */
2704       tBTA_AV_RECONFIG reconfig;
2705       reconfig.status = BTA_AV_FAIL;
2706       tBTA_AV bta_av_data;
2707       bta_av_data.reconfig = reconfig;
2708       (*bta_av_cb.p_cback)(BTA_AV_RECONFIG_EVT, &bta_av_data);
2709       APPL_TRACE_ERROR("%s: BTA_AV_STR_DISC_FAIL_EVT: peer_addr=%s", __func__,
2710                        p_scb->PeerAddress().ToString().c_str());
2711       bta_av_ssm_execute(p_scb, BTA_AV_STR_DISC_FAIL_EVT, NULL);
2712     } else {
2713       APPL_TRACE_ERROR("%s: suspend rejected, try close", __func__);
2714       /* drop the buffers queued in L2CAP */
2715       L2CA_FlushChannel(p_scb->l2c_cid, L2CAP_FLUSH_CHANS_ALL);
2716
2717       AVDT_CloseReq(p_scb->avdt_handle);
2718     }
2719   } else {
2720     APPL_TRACE_DEBUG("%s: calling AVDT_ReconfigReq", __func__);
2721     /* reconfig the stream */
2722
2723     APPL_TRACE_DEBUG("%s: codec: %s", __func__,
2724                      A2DP_CodecInfoString(p_scb->cfg.codec_info).c_str());
2725     AVDT_ReconfigReq(p_scb->avdt_handle, &p_scb->cfg);
2726     p_scb->cfg.psc_mask = p_scb->cur_psc_mask;
2727   }
2728 }
2729
2730 /*******************************************************************************
2731  *
2732  * Function         bta_av_rcfg_cfm
2733  *
2734  * Description      if reconfigure is successful, report the event
2735  *                  otherwise, close the stream.
2736  *
2737  * Returns          void
2738  *
2739  ******************************************************************************/
2740 void bta_av_rcfg_cfm(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
2741   uint8_t err_code = p_data->str_msg.msg.hdr.err_code;
2742
2743   APPL_TRACE_DEBUG("%s: err_code = %d", __func__, err_code);
2744
2745   // Disable AVDTP RECONFIGURE for rejectlisted devices
2746   bool disable_avdtp_reconfigure = false;
2747   {
2748     char remote_name[BTM_MAX_REM_BD_NAME_LEN] = "";
2749     if (btif_storage_get_stored_remote_name(p_scb->PeerAddress(),
2750                                             remote_name)) {
2751       if (interop_match_name(INTEROP_DISABLE_AVDTP_RECONFIGURE, remote_name) ||
2752           interop_match_addr(INTEROP_DISABLE_AVDTP_RECONFIGURE,
2753                              (const RawAddress*)&p_scb->PeerAddress())) {
2754         LOG_INFO(
2755             "%s: disable AVDTP RECONFIGURE: interop matched "
2756             "name %s address %s",
2757             __func__, remote_name, p_scb->PeerAddress().ToString().c_str());
2758         disable_avdtp_reconfigure = true;
2759       }
2760     }
2761   }
2762
2763   if ((err_code != 0) || disable_avdtp_reconfigure) {
2764     APPL_TRACE_ERROR("%s: reconfig rejected, try close", __func__);
2765     /* Disable reconfiguration feature only with explicit rejection(not with
2766      * timeout) */
2767     if ((err_code != AVDT_ERR_TIMEOUT) || disable_avdtp_reconfigure) {
2768       p_scb->recfg_sup = false;
2769     }
2770     /* started flag is false when reconfigure command is sent */
2771     /* drop the buffers queued in L2CAP */
2772     L2CA_FlushChannel(p_scb->l2c_cid, L2CAP_FLUSH_CHANS_ALL);
2773     AVDT_CloseReq(p_scb->avdt_handle);
2774   } else {
2775     /* update the codec info after rcfg cfm */
2776     APPL_TRACE_DEBUG(
2777         "%s: updating from codec %s to codec %s", __func__,
2778         A2DP_CodecName(p_scb->cfg.codec_info),
2779         A2DP_CodecName(p_data->str_msg.msg.reconfig_cfm.p_cfg->codec_info));
2780     memcpy(p_scb->cfg.codec_info,
2781            p_data->str_msg.msg.reconfig_cfm.p_cfg->codec_info, AVDT_CODEC_SIZE);
2782     /* take the SSM back to OPEN state */
2783     bta_av_ssm_execute(p_scb, BTA_AV_STR_OPEN_OK_EVT, NULL);
2784   }
2785 }
2786
2787 /*******************************************************************************
2788  *
2789  * Function         bta_av_rcfg_open
2790  *
2791  * Description      AVDT is connected. open the stream with the new
2792  *                  configuration
2793  *
2794  * Returns          void
2795  *
2796  ******************************************************************************/
2797 void bta_av_rcfg_open(tBTA_AV_SCB* p_scb, UNUSED_ATTR tBTA_AV_DATA* p_data) {
2798   APPL_TRACE_DEBUG("%s: peer %s bta_handle:0x%x num_disc_snks:%d", __func__,
2799                    p_scb->PeerAddress().ToString().c_str(), p_scb->hndl,
2800                    p_scb->num_disc_snks);
2801
2802   if (p_scb->num_disc_snks == 0) {
2803     /* Need to update call-out module so that it will be ready for discover */
2804     p_scb->p_cos->stop(p_scb->hndl, p_scb->PeerAddress());
2805
2806     /* send avdtp discover request */
2807     AVDT_DiscoverReq(p_scb->PeerAddress(), p_scb->hdi, p_scb->sep_info,
2808                      BTA_AV_NUM_SEPS, &bta_av_proc_stream_evt);
2809   } else {
2810     APPL_TRACE_DEBUG("%s: calling AVDT_OpenReq()", __func__);
2811     APPL_TRACE_DEBUG("%s: codec: %s", __func__,
2812                      A2DP_CodecInfoString(p_scb->cfg.codec_info).c_str());
2813
2814     /* we may choose to use a different SEP at reconfig.
2815      * adjust the sep_idx now */
2816     bta_av_adjust_seps_idx(p_scb, bta_av_get_scb_handle(p_scb, AVDT_TSEP_SRC));
2817     LOG_INFO("%s: sep_idx=%d avdt_handle=%d bta_handle=0x%x", __func__,
2818              p_scb->sep_idx, p_scb->avdt_handle, p_scb->hndl);
2819
2820     /* open the stream with the new config */
2821     p_scb->sep_info_idx = p_scb->rcfg_idx;
2822     AVDT_OpenReq(p_scb->avdt_handle, p_scb->PeerAddress(), p_scb->hdi,
2823                  p_scb->sep_info[p_scb->sep_info_idx].seid, &p_scb->cfg);
2824   }
2825 }
2826
2827 /*******************************************************************************
2828  *
2829  * Function         bta_av_security_rej
2830  *
2831  * Description      Send an AVDTP security reject.
2832  *
2833  * Returns          void
2834  *
2835  ******************************************************************************/
2836 void bta_av_security_rej(tBTA_AV_SCB* p_scb, UNUSED_ATTR tBTA_AV_DATA* p_data) {
2837   AVDT_SecurityRsp(p_scb->avdt_handle, p_scb->avdt_label, AVDT_ERR_BAD_STATE,
2838                    NULL, 0);
2839 }
2840
2841 /*******************************************************************************
2842  *
2843  * Function         bta_av_chk_2nd_start
2844  *
2845  * Description      check if this is 2nd stream and if it needs to be started.
2846  *                  This function needs to be kept very similar to
2847  *                  bta_av_chk_start
2848  *
2849  * Returns          void
2850  *
2851  ******************************************************************************/
2852 void bta_av_chk_2nd_start(tBTA_AV_SCB* p_scb,
2853                           UNUSED_ATTR tBTA_AV_DATA* p_data) {
2854   LOG_INFO(
2855       "%s: peer %s channel:%d bta_av_cb.audio_open_cnt:%d role:0x%x "
2856       "features:0x%x",
2857       __func__, p_scb->PeerAddress().ToString().c_str(), p_scb->chnl,
2858       bta_av_cb.audio_open_cnt, p_scb->role, bta_av_cb.features);
2859
2860   if ((p_scb->chnl == BTA_AV_CHNL_AUDIO) && (bta_av_cb.audio_open_cnt >= 2) &&
2861       (((p_scb->role & BTA_AV_ROLE_AD_ACP) == 0) ||  // Outgoing connection or
2862        (bta_av_cb.features & BTA_AV_FEAT_ACP_START))) {  // Auto-starting option
2863     // More than one audio channel is connected.
2864     if (!(p_scb->role & BTA_AV_ROLE_SUSPEND_OPT)) {
2865       // This channel does not need to be reconfigured.
2866       // If there is other channel streaming, start the stream now.
2867       bool new_started = false;
2868       for (int i = 0; i < BTA_AV_NUM_STRS; i++) {
2869         tBTA_AV_SCB* p_scbi = bta_av_cb.p_scb[i];
2870         if (p_scb == p_scbi) {
2871           continue;
2872         }
2873         if (p_scbi && p_scbi->chnl == BTA_AV_CHNL_AUDIO && p_scbi->co_started) {
2874           if (!new_started) {
2875             // Start the new stream
2876             new_started = true;
2877             LOG_INFO(
2878                 "%s: starting new stream for peer %s because peer %s "
2879                 "already started",
2880                 __func__, p_scb->PeerAddress().ToString().c_str(),
2881                 p_scbi->PeerAddress().ToString().c_str());
2882             bta_av_ssm_execute(p_scb, BTA_AV_AP_START_EVT, NULL);
2883           }
2884           // May need to update the flush timeout of this already started stream
2885           if (p_scbi->co_started != bta_av_cb.audio_open_cnt) {
2886             p_scbi->co_started = bta_av_cb.audio_open_cnt;
2887           }
2888         }
2889       }
2890     }
2891   }
2892 }
2893
2894 /*******************************************************************************
2895  *
2896  * Function         bta_av_open_rc
2897  *
2898  * Description      Send a message to main SM to open RC channel.
2899  *
2900  * Returns          void
2901  *
2902  ******************************************************************************/
2903 void bta_av_open_rc(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
2904   APPL_TRACE_DEBUG("%s: use_rc: %d, wait: 0x%x role: 0x%x", __func__,
2905                    p_scb->use_rc, p_scb->wait, p_scb->role);
2906   if ((p_scb->wait & BTA_AV_WAIT_ROLE_SW_BITS) &&
2907       (p_scb->q_tag == BTA_AV_Q_TAG_START)) {
2908     /* waiting for role switch for some reason & the timer expires */
2909     if (!bta_av_link_role_ok(p_scb, A2DP_SET_ONE_BIT)) {
2910       APPL_TRACE_ERROR(
2911           "%s: failed to start streaming for role management reasons!!",
2912           __func__);
2913       alarm_cancel(p_scb->avrc_ct_timer);
2914
2915       tBTA_AV_START start;
2916       start.chnl = p_scb->chnl;
2917       start.status = BTA_AV_FAIL_ROLE;
2918       start.initiator = true;
2919       start.hndl = p_scb->hndl;
2920       p_scb->wait &= ~BTA_AV_WAIT_ROLE_SW_BITS;
2921       bta_av_cb.rs_idx = 0;
2922       tBTA_AV bta_av_data;
2923       bta_av_data.start = start;
2924       (*bta_av_cb.p_cback)(BTA_AV_START_EVT, &bta_av_data);
2925     } else {
2926       /* role switch is done. continue to start streaming */
2927       bta_av_cb.rs_idx = 0;
2928       p_data->hdr.offset = BTA_AV_RS_OK;
2929       bta_av_start_ok(p_scb, p_data);
2930     }
2931     return;
2932   }
2933
2934   if (p_scb->use_rc || (p_scb->role & BTA_AV_ROLE_AD_ACP)) {
2935     if (bta_av_cb.disc) {
2936       /* AVRC discover db is in use */
2937       if (p_scb->rc_handle == BTA_AV_RC_HANDLE_NONE) {
2938         /* AVRC channel is not connected. delay a little bit */
2939         if ((p_scb->wait & BTA_AV_WAIT_ROLE_SW_BITS) == 0) {
2940           bta_sys_start_timer(p_scb->avrc_ct_timer, BTA_AV_RC_DISC_TIME_VAL,
2941                               BTA_AV_AVRC_TIMER_EVT, p_scb->hndl);
2942         } else {
2943           p_scb->wait |= BTA_AV_WAIT_CHECK_RC;
2944         }
2945       }
2946     } else {
2947       /* use main SM for AVRC SDP activities */
2948       if (is_new_avrcp_enabled()) {
2949         APPL_TRACE_WARNING("%s: Using the new AVRCP Profile", __func__);
2950         bluetooth::avrcp::AvrcpService::Get()->ConnectDevice(
2951             p_scb->PeerAddress());
2952       } else {
2953         bta_av_rc_disc((uint8_t)(p_scb->hdi + 1));
2954       }
2955     }
2956   } else {
2957     if (BTA_AV_RC_HANDLE_NONE != p_scb->rc_handle) {
2958       /* the open API said that this handle does not want a RC connection.
2959        * disconnect it now */
2960       AVRC_Close(p_scb->rc_handle);
2961     }
2962   }
2963 }
2964
2965 /*******************************************************************************
2966  *
2967  * Function         bta_av_open_at_inc
2968  *
2969  * Description      This function is called if API open is called by application
2970  *                  while state-machine is at incoming state.
2971  *
2972  * Returns          void
2973  *
2974  ******************************************************************************/
2975 void bta_av_open_at_inc(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
2976   memcpy(&(p_scb->open_api), &(p_data->api_open), sizeof(tBTA_AV_API_OPEN));
2977
2978   APPL_TRACE_DEBUG("%s: peer %s coll_mask=0x%02x", __func__,
2979                    p_scb->PeerAddress().ToString().c_str(), p_scb->coll_mask);
2980
2981   if (p_scb->coll_mask & BTA_AV_COLL_INC_TMR) {
2982     p_scb->coll_mask |= BTA_AV_COLL_API_CALLED;
2983
2984     /* API open will be handled at timeout if SNK did not start signalling. */
2985     /* API open will be ignored if SNK starts signalling.                   */
2986   } else {
2987     /* SNK did not start signalling, API was called N seconds timeout. */
2988     /* We need to switch to INIT state and start opening connection. */
2989     p_scb->coll_mask = 0;
2990     bta_av_set_scb_sst_init(p_scb);
2991
2992     tBTA_AV_API_OPEN* p_buf =
2993         (tBTA_AV_API_OPEN*)osi_malloc(sizeof(tBTA_AV_API_OPEN));
2994     memcpy(p_buf, &(p_scb->open_api), sizeof(tBTA_AV_API_OPEN));
2995     bta_sys_sendmsg(p_buf);
2996   }
2997 }
2998
2999 void offload_vendor_callback(tBTM_VSC_CMPL* param) {
3000   tBTA_AV value{0};
3001   uint8_t sub_opcode = 0;
3002   if (param->param_len) {
3003     APPL_TRACE_DEBUG("%s: param_len = %d status = %d", __func__,
3004                      param->param_len, param->p_param_buf[0]);
3005     value.status = static_cast<tBTA_AV_STATUS>(param->p_param_buf[0]);
3006   }
3007   if (value.status == 0) {
3008     sub_opcode = param->p_param_buf[1];
3009     APPL_TRACE_DEBUG("%s: subopcode = %d", __func__, sub_opcode);
3010     switch (sub_opcode) {
3011       case VS_HCI_A2DP_OFFLOAD_STOP:
3012         APPL_TRACE_DEBUG("%s: VS_HCI_STOP_A2DP_MEDIA successful", __func__);
3013         break;
3014       case VS_HCI_A2DP_OFFLOAD_START:
3015         if (bta_av_cb.offload_start_pending_hndl) {
3016           APPL_TRACE_DEBUG("%s: VS_HCI_START_A2DP_MEDIA successful", __func__);
3017           bta_av_cb.offload_started_hndl = bta_av_cb.offload_start_pending_hndl;
3018           bta_av_cb.offload_start_pending_hndl = 0;
3019         } else {
3020           LOG_INFO("%s: No pending start command due to AVDTP suspend immediately", __func__);
3021         }
3022         (*bta_av_cb.p_cback)(BTA_AV_OFFLOAD_START_RSP_EVT, &value);
3023         break;
3024       default:
3025         break;
3026     }
3027   } else {
3028     APPL_TRACE_DEBUG("%s: Offload failed for subopcode= %d", __func__,
3029                      sub_opcode);
3030     if (param->opcode != VS_HCI_A2DP_OFFLOAD_STOP) {
3031       bta_av_cb.offload_start_pending_hndl = 0;
3032       (*bta_av_cb.p_cback)(BTA_AV_OFFLOAD_START_RSP_EVT, &value);
3033     }
3034   }
3035 }
3036
3037 void bta_av_vendor_offload_start(tBTA_AV_SCB* p_scb,
3038                                  tBT_A2DP_OFFLOAD* offload_start) {
3039   uint8_t param[sizeof(tBT_A2DP_OFFLOAD)];
3040   APPL_TRACE_DEBUG("%s", __func__);
3041
3042   uint8_t* p_param = param;
3043   *p_param++ = VS_HCI_A2DP_OFFLOAD_START;
3044
3045   UINT32_TO_STREAM(p_param, offload_start->codec_type);
3046   UINT16_TO_STREAM(p_param, offload_start->max_latency);
3047   ARRAY_TO_STREAM(p_param, offload_start->scms_t_enable,
3048                   static_cast<int>(offload_start->scms_t_enable.size()));
3049   UINT32_TO_STREAM(p_param, offload_start->sample_rate);
3050   UINT8_TO_STREAM(p_param, offload_start->bits_per_sample);
3051   UINT8_TO_STREAM(p_param, offload_start->ch_mode);
3052   UINT32_TO_STREAM(p_param, offload_start->encoded_audio_bitrate);
3053   UINT16_TO_STREAM(p_param, offload_start->acl_hdl);
3054   UINT16_TO_STREAM(p_param, offload_start->l2c_rcid);
3055   UINT16_TO_STREAM(p_param, offload_start->mtu);
3056   ARRAY_TO_STREAM(p_param, offload_start->codec_info,
3057                   (int8_t)sizeof(offload_start->codec_info));
3058   bta_av_cb.offload_start_pending_hndl = p_scb->hndl;
3059   BTM_VendorSpecificCommand(HCI_CONTROLLER_A2DP, p_param - param,
3060                             param, offload_vendor_callback);
3061 }
3062
3063 void bta_av_vendor_offload_stop() {
3064   uint8_t param[sizeof(tBT_A2DP_OFFLOAD)];
3065   APPL_TRACE_DEBUG("%s", __func__);
3066   param[0] = VS_HCI_A2DP_OFFLOAD_STOP;
3067   BTM_VendorSpecificCommand(HCI_CONTROLLER_A2DP, 1, param,
3068                             offload_vendor_callback);
3069 }
3070 /*******************************************************************************
3071  *
3072  * Function         bta_av_offload_req
3073  *
3074  * Description      This function is called if application requests offload of
3075  *                  a2dp audio.
3076  *
3077  * Returns          void
3078  *
3079  ******************************************************************************/
3080 void bta_av_offload_req(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
3081   tBTA_AV_STATUS status = BTA_AV_FAIL_RESOURCES;
3082
3083   tBT_A2DP_OFFLOAD offload_start;
3084   APPL_TRACE_DEBUG("%s: stream %s, audio channels open %d", __func__,
3085                    p_scb->started ? "STARTED" : "STOPPED",
3086                    bta_av_cb.audio_open_cnt);
3087   /* Check if stream has already been started. */
3088   /* Support offload if only one audio source stream is open. */
3089   if (p_scb->started != true) {
3090     status = BTA_AV_FAIL_STREAM;
3091   } else if (bta_av_cb.offload_start_pending_hndl ||
3092              bta_av_cb.offload_started_hndl) {
3093     APPL_TRACE_WARNING("%s: offload already started, ignore request", __func__);
3094     return;
3095   } else {
3096     bta_av_offload_codec_builder(p_scb, &offload_start);
3097     bta_av_vendor_offload_start(p_scb, &offload_start);
3098     return;
3099   }
3100   if (status != BTA_AV_SUCCESS) {
3101     tBTA_AV bta_av_data;
3102     bta_av_data.status = status;
3103     (*bta_av_cb.p_cback)(BTA_AV_OFFLOAD_START_RSP_EVT, &bta_av_data);
3104   }
3105   /* TODO(eisenbach): RE-IMPLEMENT USING VSC OR HAL EXTENSION
3106   else if (bta_av_cb.audio_open_cnt == 1 &&
3107              p_scb->seps[p_scb->sep_idx].tsep == AVDT_TSEP_SRC &&
3108              p_scb->chnl == BTA_AV_CHNL_AUDIO) {
3109     bt_vendor_op_a2dp_offload_t a2dp_offload_start;
3110
3111     if (L2CA_GetConnectionConfig(
3112             p_scb->l2c_cid, &a2dp_offload_start.acl_data_size,
3113             &a2dp_offload_start.remote_cid, &a2dp_offload_start.lm_handle)) {
3114       APPL_TRACE_DEBUG("%s: l2cmtu %d lcid 0x%02X rcid 0x%02X lm_handle
3115   0x%02X",
3116                       __func__, a2dp_offload_start.acl_data_size,
3117                        p_scb->l2c_cid, a2dp_offload_start.remote_cid,
3118                        a2dp_offload_start.lm_handle);
3119
3120       a2dp_offload_start.bta_av_handle = p_scb->hndl;
3121       a2dp_offload_start.xmit_quota = BTA_AV_A2DP_OFFLOAD_XMIT_QUOTA;
3122       a2dp_offload_start.stream_mtu = p_scb->stream_mtu;
3123       a2dp_offload_start.local_cid = p_scb->l2c_cid;
3124       a2dp_offload_start.is_flushable = true;
3125       a2dp_offload_start.stream_source =
3126           ((uint32_t)(p_scb->cfg.codec_info[1] | p_scb->cfg.codec_info[2]));
3127
3128       memcpy(a2dp_offload_start.codec_info, p_scb->cfg.codec_info,
3129              sizeof(a2dp_offload_start.codec_info));
3130
3131       if (!vendor_get_interface()->send_command(
3132               (vendor_opcode_t)BT_VND_OP_A2DP_OFFLOAD_START,
3133               &a2dp_offload_start)) {
3134         status = BTA_AV_SUCCESS;
3135         p_scb->offload_start_pending = true;
3136       }
3137     }
3138   }
3139  */
3140 }
3141
3142 /*******************************************************************************
3143  *
3144  * Function         bta_av_offload_rsp
3145  *
3146  * Description      This function is called when the vendor lib responds to
3147  *                  BT_VND_OP_A2DP_OFFLOAD_START.
3148  *
3149  * Returns          void
3150  *
3151  ******************************************************************************/
3152 void bta_av_offload_rsp(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
3153   tBTA_AV_STATUS status = p_data->api_status_rsp.status;
3154
3155   APPL_TRACE_DEBUG("%s: stream %s status %s", __func__,
3156                    p_scb->started ? "STARTED" : "STOPPED",
3157                    status ? "FAIL" : "SUCCESS");
3158
3159   /* Check if stream has already been started. */
3160   if (status == BTA_AV_SUCCESS && p_scb->started != true) {
3161     status = BTA_AV_FAIL_STREAM;
3162   }
3163
3164   bta_av_cb.offload_start_pending_hndl = 0;
3165   tBTA_AV bta_av_data;
3166   bta_av_data.status = status;
3167   (*bta_av_cb.p_cback)(BTA_AV_OFFLOAD_START_RSP_EVT, &bta_av_data);
3168 }
3169
3170 static void bta_av_offload_codec_builder(tBTA_AV_SCB* p_scb,
3171                                          tBT_A2DP_OFFLOAD* p_a2dp_offload) {
3172   A2dpCodecConfig* CodecConfig = bta_av_get_a2dp_current_codec();
3173   btav_a2dp_codec_index_t codec_index =
3174       A2DP_SourceCodecIndex(p_scb->cfg.codec_info);
3175   uint32_t codec_type = 0;
3176   uint16_t mtu = p_scb->stream_mtu;
3177   APPL_TRACE_DEBUG("%s:codec_index = %d", __func__, codec_index);
3178   switch (codec_index) {
3179     case BTAV_A2DP_CODEC_INDEX_SOURCE_SBC:
3180       codec_type = BTA_AV_CODEC_TYPE_SBC;
3181       if (A2DP_GetMaxBitpoolSbc(p_scb->cfg.codec_info) <=
3182           A2DP_SBC_BITPOOL_MIDDLE_QUALITY) {
3183         APPL_TRACE_WARNING("%s: Restricting streaming MTU size for MQ Bitpool",
3184                            __func__);
3185         mtu = MAX_2MBPS_AVDTP_MTU;
3186       }
3187       break;
3188     case BTAV_A2DP_CODEC_INDEX_SOURCE_AAC:
3189       codec_type = BTA_AV_CODEC_TYPE_AAC;
3190       break;
3191     case BTAV_A2DP_CODEC_INDEX_SOURCE_APTX:
3192       codec_type = BTA_AV_CODEC_TYPE_APTX;
3193       break;
3194     case BTAV_A2DP_CODEC_INDEX_SOURCE_APTX_HD:
3195       codec_type = BTA_AV_CODEC_TYPE_APTXHD;
3196       break;
3197     case BTAV_A2DP_CODEC_INDEX_SOURCE_LDAC:
3198       codec_type = BTA_AV_CODEC_TYPE_LDAC;
3199       break;
3200     default:
3201       APPL_TRACE_ERROR("%s: Unknown Codec type ", __func__);
3202       return;
3203   }
3204   if (mtu > MAX_3MBPS_AVDTP_MTU) mtu = MAX_3MBPS_AVDTP_MTU;
3205   p_a2dp_offload->codec_type = codec_type;
3206   p_a2dp_offload->max_latency = 0;
3207   p_a2dp_offload->mtu = mtu;
3208   p_a2dp_offload->acl_hdl =
3209       get_btm_client_interface().lifecycle.BTM_GetHCIConnHandle(
3210           p_scb->PeerAddress(), BT_TRANSPORT_BR_EDR);
3211   btav_a2dp_scmst_info_t scmst_info =
3212       p_scb->p_cos->get_scmst_info(p_scb->PeerAddress());
3213   p_a2dp_offload->scms_t_enable[0] = scmst_info.enable_status;
3214   p_a2dp_offload->scms_t_enable[1] = scmst_info.cp_header;
3215   APPL_TRACE_DEBUG(
3216       "%s: SCMS-T_enable status: %d, "
3217       "SCMS-T header (if it's enabled): 0x%02x",
3218       __func__, scmst_info.enable_status, scmst_info.cp_header);
3219
3220   switch (A2DP_GetTrackSampleRate(p_scb->cfg.codec_info)) {
3221     case 44100:
3222       p_a2dp_offload->sample_rate = BTAV_A2DP_CODEC_SAMPLE_RATE_44100;
3223       break;
3224     case 48000:
3225       p_a2dp_offload->sample_rate = BTAV_A2DP_CODEC_SAMPLE_RATE_48000;
3226       break;
3227     case 88200:
3228       p_a2dp_offload->sample_rate = BTAV_A2DP_CODEC_SAMPLE_RATE_88200;
3229       break;
3230     case 96000:
3231       p_a2dp_offload->sample_rate = BTAV_A2DP_CODEC_SAMPLE_RATE_96000;
3232       break;
3233   }
3234   if (L2CA_GetRemoteCid(p_scb->l2c_cid, &p_a2dp_offload->l2c_rcid) == false) {
3235     APPL_TRACE_ERROR("%s: Failed to fetch l2c rcid", __func__);
3236     return;
3237   }
3238   switch (CodecConfig->getAudioBitsPerSample()) {
3239     case 16:
3240       p_a2dp_offload->bits_per_sample = BTAV_A2DP_CODEC_BITS_PER_SAMPLE_16;
3241       break;
3242     case 24:
3243       p_a2dp_offload->bits_per_sample = BTAV_A2DP_CODEC_BITS_PER_SAMPLE_24;
3244       break;
3245     case 32:
3246       p_a2dp_offload->bits_per_sample = BTAV_A2DP_CODEC_BITS_PER_SAMPLE_32;
3247       break;
3248   }
3249   p_a2dp_offload->ch_mode = A2DP_GetTrackChannelCount(p_scb->cfg.codec_info);
3250   p_a2dp_offload->encoded_audio_bitrate = CodecConfig->getTrackBitRate();
3251   if (!CodecConfig->getCodecSpecificConfig(p_a2dp_offload)) {
3252     APPL_TRACE_ERROR("%s: not a valid codec info", __func__);
3253   }
3254 }