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     uint16_t handle = get_btm_client_interface().lifecycle.BTM_GetHCIConnHandle(
1891         p_scb->PeerAddress(), BT_TRANSPORT_BR_EDR);
1892     if (bta_av_cb.offload_started_acl_hdl == handle) {
1893       bta_av_vendor_offload_stop();
1894       bta_av_cb.offload_started_acl_hdl = HCI_INVALID_HANDLE;
1895     } else if (bta_av_cb.offload_start_pending_acl_hdl == handle) {
1896       APPL_TRACE_WARNING("%s: Stop pending offload start command", __func__);
1897       bta_av_vendor_offload_stop();
1898       bta_av_cb.offload_start_pending_acl_hdl = HCI_INVALID_HANDLE;
1899     }
1900
1901     bta_av_stream_chg(p_scb, false);
1902     p_scb->co_started = false;
1903
1904     p_scb->p_cos->stop(p_scb->hndl, p_scb->PeerAddress());
1905   }
1906
1907   /* if q_info.a2dp_list is not empty, drop it now */
1908   if (BTA_AV_CHNL_AUDIO == p_scb->chnl) {
1909     while (!list_is_empty(p_scb->a2dp_list)) {
1910       p_buf = (BT_HDR*)list_front(p_scb->a2dp_list);
1911       list_remove(p_scb->a2dp_list, p_buf);
1912       osi_free(p_buf);
1913     }
1914
1915     /* drop the audio buffers queued in L2CAP */
1916     if (p_data && p_data->api_stop.flush)
1917       L2CA_FlushChannel(p_scb->l2c_cid, L2CAP_FLUSH_CHANS_ALL);
1918   }
1919
1920   suspend_rsp.chnl = p_scb->chnl;
1921   suspend_rsp.hndl = p_scb->hndl;
1922
1923   if (p_data && p_data->api_stop.suspend) {
1924     APPL_TRACE_DEBUG("%s: peer %s suspending: %d, sup:%d", __func__,
1925                      p_scb->PeerAddress().ToString().c_str(), start,
1926                      p_scb->suspend_sup);
1927     if ((start) && (p_scb->suspend_sup)) {
1928       sus_evt = false;
1929       p_scb->l2c_bufs = 0;
1930       AVDT_SuspendReq(&p_scb->avdt_handle, 1);
1931     }
1932
1933     /* send SUSPEND_EVT event only if not in reconfiguring state and sus_evt is
1934      * true*/
1935     if ((sus_evt) && (p_scb->state != BTA_AV_RCFG_SST)) {
1936       suspend_rsp.status = BTA_AV_SUCCESS;
1937       suspend_rsp.initiator = true;
1938       tBTA_AV bta_av_data;
1939       bta_av_data.suspend = suspend_rsp;
1940       (*bta_av_cb.p_cback)(BTA_AV_SUSPEND_EVT, &bta_av_data);
1941     }
1942   } else {
1943     suspend_rsp.status = BTA_AV_SUCCESS;
1944     suspend_rsp.initiator = true;
1945     APPL_TRACE_EVENT("%s: status %d", __func__, suspend_rsp.status);
1946
1947     // Send STOP_EVT event only if not in reconfiguring state.
1948     // However, we should send STOP_EVT if we are reconfiguring when taking
1949     // the Close->Configure->Open->Start path.
1950     if (p_scb->state != BTA_AV_RCFG_SST ||
1951         (p_data && p_data->api_stop.reconfig_stop)) {
1952       tBTA_AV bta_av_data;
1953       bta_av_data.suspend = suspend_rsp;
1954       (*bta_av_cb.p_cback)(BTA_AV_STOP_EVT, &bta_av_data);
1955     }
1956   }
1957 }
1958
1959 /*******************************************************************************
1960  *
1961  * Function         bta_av_reconfig
1962  *
1963  * Description      process the reconfigure request.
1964  *                  save the parameter in control block and
1965  *                  suspend, reconfigure or close the stream
1966  *
1967  * Returns          void
1968  *
1969  ******************************************************************************/
1970 void bta_av_reconfig(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
1971   AvdtpSepConfig* p_cfg;
1972   tBTA_AV_API_STOP stop;
1973   tBTA_AV_API_RCFG* p_rcfg = &p_data->api_reconfig;
1974
1975   APPL_TRACE_DEBUG("%s: r:%d, s:%d idx: %d (o:%d)", __func__, p_scb->recfg_sup,
1976                    p_scb->suspend_sup, p_scb->rcfg_idx, p_scb->sep_info_idx);
1977
1978   p_scb->num_recfg = 0;
1979   /* store the new configuration in control block */
1980   p_cfg = &p_scb->cfg;
1981
1982   alarm_cancel(p_scb->avrc_ct_timer);
1983
1984   LOG_DEBUG("p_scb->sep_info_idx=%d p_scb->rcfg_idx=%d p_rcfg->sep_info_idx=%d",
1985             p_scb->sep_info_idx, p_scb->rcfg_idx, p_rcfg->sep_info_idx);
1986   LOG_DEBUG("Peer capable codec: %s",
1987             A2DP_CodecInfoString(p_scb->peer_cap.codec_info).c_str());
1988   LOG_DEBUG("Current codec: %s",
1989             A2DP_CodecInfoString(p_scb->cfg.codec_info).c_str());
1990   LOG_DEBUG("Reconfig codec: %s",
1991             A2DP_CodecInfoString(p_rcfg->codec_info).c_str());
1992
1993   BTM_LogHistory(
1994       kBtmLogTag, p_scb->PeerAddress(), "Codec reconfig",
1995       base::StringPrintf("%s => %s", A2DP_CodecName(p_scb->cfg.codec_info),
1996                          A2DP_CodecName(p_rcfg->codec_info)));
1997
1998   p_cfg->num_protect = p_rcfg->num_protect;
1999   memcpy(p_cfg->codec_info, p_rcfg->codec_info, AVDT_CODEC_SIZE);
2000   memcpy(p_cfg->protect_info, p_rcfg->p_protect_info, p_rcfg->num_protect);
2001   p_scb->rcfg_idx = p_rcfg->sep_info_idx;
2002   p_cfg->psc_mask = p_scb->cur_psc_mask;
2003
2004   // If the requested SEP index is same as the current one, then we
2005   // can Suspend->Reconfigure->Start.
2006   // Otherwise, we have to Close->Configure->Open->Start or
2007   // Close->Configure->Open for streams that are / are not started.
2008   if ((p_scb->rcfg_idx == p_scb->sep_info_idx) && p_rcfg->suspend &&
2009       p_scb->recfg_sup && p_scb->suspend_sup) {
2010     if (p_scb->started) {
2011       // Suspend->Reconfigure->Start
2012       stop.flush = false;
2013       stop.suspend = true;
2014       stop.reconfig_stop = false;
2015       bta_av_str_stopped(p_scb, (tBTA_AV_DATA*)&stop);
2016     } else {
2017       // Reconfigure
2018       APPL_TRACE_DEBUG("%s: reconfig", __func__);
2019       APPL_TRACE_DEBUG("%s: codec: %s", __func__,
2020                        A2DP_CodecInfoString(p_scb->cfg.codec_info).c_str());
2021       AVDT_ReconfigReq(p_scb->avdt_handle, &p_scb->cfg);
2022       p_scb->cfg.psc_mask = p_scb->cur_psc_mask;
2023     }
2024   } else {
2025     // Close the stream first, and then Configure it
2026     APPL_TRACE_DEBUG("%s: Close/Open started: %d state: %d num_protect: %d",
2027                      __func__, p_scb->started, p_scb->state,
2028                      p_cfg->num_protect);
2029     if (p_scb->started) {
2030       // Close->Configure->Open->Start
2031       if ((p_scb->rcfg_idx != p_scb->sep_info_idx) && p_scb->recfg_sup) {
2032         // Make sure we trigger STOP_EVT when taking the longer road to
2033         // reconfiguration, otherwise we don't call Start.
2034         stop.flush = false;
2035         stop.suspend = false;
2036         stop.reconfig_stop = true;
2037         bta_av_str_stopped(p_scb, (tBTA_AV_DATA*)&stop);
2038       } else {
2039         bta_av_str_stopped(p_scb, NULL);
2040       }
2041       p_scb->started = false;
2042     } else {
2043       // Close->Configure->Open
2044       bta_av_str_stopped(p_scb, NULL);
2045     }
2046     // Drop the buffers queued in L2CAP
2047     L2CA_FlushChannel(p_scb->l2c_cid, L2CAP_FLUSH_CHANS_ALL);
2048     AVDT_CloseReq(p_scb->avdt_handle);
2049   }
2050 }
2051
2052 /*******************************************************************************
2053  *
2054  * Function         bta_av_data_path
2055  *
2056  * Description      Handle stream data path.
2057  *
2058  * Returns          void
2059  *
2060  ******************************************************************************/
2061 void bta_av_data_path(tBTA_AV_SCB* p_scb, UNUSED_ATTR tBTA_AV_DATA* p_data) {
2062   BT_HDR* p_buf = NULL;
2063   uint32_t timestamp;
2064   bool new_buf = false;
2065   uint8_t m_pt = 0x60;
2066   tAVDT_DATA_OPT_MASK opt;
2067
2068   if (!p_scb->started) return;
2069
2070   if (p_scb->cong) return;
2071
2072   if (p_scb->use_rtp_header_marker_bit) {
2073     m_pt |= AVDT_MARKER_SET;
2074   }
2075
2076   // Always get the current number of bufs que'd up
2077   p_scb->l2c_bufs =
2078       (uint8_t)L2CA_FlushChannel(p_scb->l2c_cid, L2CAP_FLUSH_CHANS_GET);
2079
2080   if (!list_is_empty(p_scb->a2dp_list)) {
2081     p_buf = (BT_HDR*)list_front(p_scb->a2dp_list);
2082     list_remove(p_scb->a2dp_list, p_buf);
2083     /* use q_info.a2dp data, read the timestamp */
2084     timestamp = *(uint32_t*)(p_buf + 1);
2085   } else {
2086     new_buf = true;
2087     /* A2DP_list empty, call co_data, dup data to other channels */
2088     p_buf = p_scb->p_cos->data(p_scb->cfg.codec_info, &timestamp);
2089
2090     if (p_buf) {
2091       /* use the offset area for the time stamp */
2092       *(uint32_t*)(p_buf + 1) = timestamp;
2093
2094       /* dup the data to other channels */
2095       bta_av_dup_audio_buf(p_scb, p_buf);
2096     }
2097   }
2098
2099   if (p_buf) {
2100     if (p_scb->l2c_bufs < (BTA_AV_QUEUE_DATA_CHK_NUM)) {
2101       /* There's a buffer, just queue it to L2CAP.
2102        * There's no need to increment it here, it is always read from
2103        * L2CAP (see above).
2104        */
2105
2106       /* opt is a bit mask, it could have several options set */
2107       opt = AVDT_DATA_OPT_NONE;
2108       if (p_scb->no_rtp_header) {
2109         opt |= AVDT_DATA_OPT_NO_RTP;
2110       }
2111
2112       //
2113       // Fragment the payload if larger than the MTU.
2114       // NOTE: The fragmentation is RTP-compatibie.
2115       //
2116       size_t extra_fragments_n = 0;
2117       if (p_buf->len > 0) {
2118         extra_fragments_n = (p_buf->len / p_scb->stream_mtu) +
2119                             ((p_buf->len % p_scb->stream_mtu) ? 1 : 0) - 1;
2120       }
2121       std::vector<BT_HDR*> extra_fragments;
2122       extra_fragments.reserve(extra_fragments_n);
2123
2124       uint8_t* data_begin = (uint8_t*)(p_buf + 1) + p_buf->offset;
2125       uint8_t* data_end = (uint8_t*)(p_buf + 1) + p_buf->offset + p_buf->len;
2126       while (extra_fragments_n-- > 0) {
2127         data_begin += p_scb->stream_mtu;
2128         size_t fragment_len = data_end - data_begin;
2129         if (fragment_len > p_scb->stream_mtu) fragment_len = p_scb->stream_mtu;
2130
2131         BT_HDR* p_buf2 = (BT_HDR*)osi_malloc(BT_DEFAULT_BUFFER_SIZE);
2132         p_buf2->offset = p_buf->offset;
2133         p_buf2->len = 0;
2134         p_buf2->layer_specific = 0;
2135         uint8_t* packet2 =
2136             (uint8_t*)(p_buf2 + 1) + p_buf2->offset + p_buf2->len;
2137         memcpy(packet2, data_begin, fragment_len);
2138         p_buf2->len += fragment_len;
2139         extra_fragments.push_back(p_buf2);
2140         p_buf->len -= fragment_len;
2141       }
2142
2143       if (!extra_fragments.empty()) {
2144         // Reset the RTP Marker bit for all fragments except the last one
2145         m_pt &= ~AVDT_MARKER_SET;
2146       }
2147       AVDT_WriteReqOpt(p_scb->avdt_handle, p_buf, timestamp, m_pt, opt);
2148       for (size_t i = 0; i < extra_fragments.size(); i++) {
2149         if (i + 1 == extra_fragments.size()) {
2150           // Set the RTP Marker bit for the last fragment
2151           m_pt |= AVDT_MARKER_SET;
2152         }
2153         BT_HDR* p_buf2 = extra_fragments[i];
2154         AVDT_WriteReqOpt(p_scb->avdt_handle, p_buf2, timestamp, m_pt, opt);
2155       }
2156       p_scb->cong = true;
2157     } else {
2158       /* there's a buffer, but L2CAP does not seem to be moving data */
2159       if (new_buf) {
2160         /* just got this buffer from co_data,
2161          * put it in queue */
2162         list_append(p_scb->a2dp_list, p_buf);
2163       } else {
2164         /* just dequeue it from the a2dp_list */
2165         if (list_length(p_scb->a2dp_list) < 3) {
2166           /* put it back to the queue */
2167           list_prepend(p_scb->a2dp_list, p_buf);
2168         } else {
2169           /* too many buffers in a2dp_list, drop it. */
2170           bta_av_co_audio_drop(p_scb->hndl, p_scb->PeerAddress());
2171           osi_free(p_buf);
2172         }
2173       }
2174     }
2175   }
2176 }
2177
2178 /*******************************************************************************
2179  *
2180  * Function         bta_av_start_ok
2181  *
2182  * Description      Stream started.
2183  *
2184  * Returns          void
2185  *
2186  ******************************************************************************/
2187 void bta_av_start_ok(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
2188   bool initiator = false;
2189   bool suspend = false;
2190   uint8_t new_role = p_scb->role;
2191   BT_HDR_RIGID hdr;
2192   tHCI_ROLE cur_role;
2193   uint8_t local_tsep = p_scb->seps[p_scb->sep_idx].tsep;
2194
2195   LOG_INFO("%s: peer %s bta_handle:0x%x wait:0x%x role:0x%x local_tsep:%d",
2196            __func__, p_scb->PeerAddress().ToString().c_str(), p_scb->hndl,
2197            p_scb->wait, p_scb->role, local_tsep);
2198
2199   p_scb->started = true;
2200
2201   if (local_tsep == AVDT_TSEP_SRC) {
2202     // The RTP Header marker bit for the A2DP Source encoder
2203     A2dpCodecConfig* codec_config =
2204         bta_av_get_a2dp_peer_current_codec(p_scb->PeerAddress());
2205     CHECK(codec_config != nullptr);
2206     p_scb->use_rtp_header_marker_bit = codec_config->useRtpHeaderMarkerBit();
2207   }
2208
2209   if (p_scb->sco_suspend) {
2210     p_scb->sco_suspend = false;
2211   }
2212
2213   if (new_role & BTA_AV_ROLE_START_INT) initiator = true;
2214
2215   /* for A2DP SINK we do not send get_caps */
2216   if ((p_scb->avdt_handle == p_scb->seps[p_scb->sep_idx].av_handle) &&
2217       (local_tsep == AVDT_TSEP_SNK)) {
2218     p_scb->wait &= ~(BTA_AV_WAIT_ACP_CAPS_ON);
2219     APPL_TRACE_DEBUG("%s: local SEP type is SNK new wait is 0x%x", __func__,
2220                      p_scb->wait);
2221   }
2222   if (p_scb->wait & BTA_AV_WAIT_ROLE_SW_FAILED) {
2223     /* role switch has failed */
2224     APPL_TRACE_ERROR(
2225         "%s: peer %s role switch failed: bta_handle:0x%x wait:0x%x, role:0x%x",
2226         __func__, p_scb->PeerAddress().ToString().c_str(), p_scb->hndl,
2227         p_scb->wait, p_scb->role);
2228     p_scb->wait &= ~BTA_AV_WAIT_ROLE_SW_FAILED;
2229     p_data = (tBTA_AV_DATA*)&hdr;
2230     hdr.offset = BTA_AV_RS_FAIL;
2231   }
2232   APPL_TRACE_DEBUG("%s: peer %s wait:0x%x use_rtp_header_marker_bit:%s",
2233                    __func__, p_scb->PeerAddress().ToString().c_str(),
2234                    p_scb->wait,
2235                    (p_scb->use_rtp_header_marker_bit) ? "true" : "false");
2236
2237   if (p_data && (p_data->hdr.offset != BTA_AV_RS_NONE)) {
2238     p_scb->wait &= ~BTA_AV_WAIT_ROLE_SW_BITS;
2239     if (p_data->hdr.offset == BTA_AV_RS_FAIL) {
2240       bta_sys_idle(BTA_ID_AV, bta_av_cb.audio_open_cnt, p_scb->PeerAddress());
2241       tBTA_AV_START start;
2242       start.chnl = p_scb->chnl;
2243       start.status = BTA_AV_FAIL_ROLE;
2244       start.hndl = p_scb->hndl;
2245       start.initiator = initiator;
2246       tBTA_AV bta_av_data;
2247       bta_av_data.start = start;
2248       (*bta_av_cb.p_cback)(BTA_AV_START_EVT, &bta_av_data);
2249       return;
2250     }
2251   }
2252
2253   if (!bta_av_link_role_ok(p_scb, A2DP_SET_ONE_BIT))
2254     p_scb->q_tag = BTA_AV_Q_TAG_START;
2255   else {
2256     /* The wait flag may be set here while we are already central on the link */
2257     /* this could happen if a role switch complete event occurred during
2258      * reconfig */
2259     /* if we are now central on the link, there is no need to wait for the role
2260      * switch, */
2261     /* complete anymore so we can clear the wait for role switch flag */
2262     p_scb->wait &= ~BTA_AV_WAIT_ROLE_SW_BITS;
2263   }
2264
2265   if (p_scb->wait &
2266       (BTA_AV_WAIT_ROLE_SW_RES_OPEN | BTA_AV_WAIT_ROLE_SW_RES_START)) {
2267     p_scb->wait |= BTA_AV_WAIT_ROLE_SW_STARTED;
2268     p_scb->q_tag = BTA_AV_Q_TAG_START;
2269   }
2270
2271   if (p_scb->wait) {
2272     APPL_TRACE_ERROR("%s: peer %s wait:0x%x q_tag:%d not started", __func__,
2273                      p_scb->PeerAddress().ToString().c_str(), p_scb->wait,
2274                      p_scb->q_tag);
2275     /* Clear first bit of p_scb->wait and not to return from this point else
2276      * HAL layer gets blocked. And if there is delay in Get Capability response
2277      * as
2278      * first bit of p_scb->wait is cleared hence it ensures bt_av_start_ok is
2279      * not called
2280      * again from bta_av_save_caps.
2281      */
2282     p_scb->wait &= ~BTA_AV_WAIT_ACP_CAPS_ON;
2283   }
2284
2285   /* tell role manager to check M/S role */
2286   bta_sys_conn_open(BTA_ID_AV, p_scb->app_id, p_scb->PeerAddress());
2287
2288   bta_sys_busy(BTA_ID_AV, bta_av_cb.audio_open_cnt, p_scb->PeerAddress());
2289
2290   if (p_scb->media_type == AVDT_MEDIA_TYPE_AUDIO) {
2291     /* in normal logic, conns should be bta_av_cb.audio_count - 1,
2292      * However, bta_av_stream_chg is not called to increase
2293      * bta_av_cb.audio_count yet.
2294      * If the code were to be re-arranged for some reasons, this number may need
2295      * to be changed
2296      */
2297     p_scb->co_started = bta_av_cb.audio_open_cnt;
2298   }
2299
2300   /* clear the congestion flag */
2301   p_scb->cong = false;
2302
2303   if (new_role & BTA_AV_ROLE_START_INT) {
2304     new_role &= ~BTA_AV_ROLE_START_INT;
2305   } else if ((new_role & BTA_AV_ROLE_AD_ACP) &&
2306              (new_role & BTA_AV_ROLE_SUSPEND_OPT)) {
2307     suspend = true;
2308   }
2309
2310   if (!suspend) {
2311     p_scb->q_tag = BTA_AV_Q_TAG_STREAM;
2312     bta_av_stream_chg(p_scb, true);
2313   }
2314
2315   {
2316     /* If sink starts stream, disable sniff mode here */
2317     if (!initiator) {
2318       /* If souce is the central role, disable role switch during streaming.
2319        * Otherwise allow role switch, if source is peripheral.
2320        * Because it would not hurt source, if the peer device wants source to be
2321        * central */
2322       if ((BTM_GetRole(p_scb->PeerAddress(), &cur_role) == BTM_SUCCESS) &&
2323           (cur_role == HCI_ROLE_CENTRAL)) {
2324         BTM_block_role_switch_for(p_scb->PeerAddress());
2325       }
2326     }
2327
2328     p_scb->role = new_role;
2329     p_scb->role &= ~BTA_AV_ROLE_AD_ACP;
2330     p_scb->role &= ~BTA_AV_ROLE_SUSPEND_OPT;
2331
2332     p_scb->no_rtp_header = false;
2333     p_scb->p_cos->start(p_scb->hndl, p_scb->PeerAddress(),
2334                         p_scb->cfg.codec_info, &p_scb->no_rtp_header);
2335     p_scb->co_started = true;
2336
2337     APPL_TRACE_DEBUG("%s: peer %s suspending: %d, role:0x%x, init %d", __func__,
2338                      p_scb->PeerAddress().ToString().c_str(), suspend,
2339                      p_scb->role, initiator);
2340
2341     tBTA_AV_START start;
2342     start.suspending = suspend;
2343     start.initiator = initiator;
2344     start.chnl = p_scb->chnl;
2345     start.status = BTA_AV_SUCCESS;
2346     start.hndl = p_scb->hndl;
2347     tBTA_AV bta_av_data;
2348     bta_av_data.start = start;
2349     (*bta_av_cb.p_cback)(BTA_AV_START_EVT, &bta_av_data);
2350
2351     if (suspend) {
2352       tBTA_AV_API_STOP stop;
2353       p_scb->role |= BTA_AV_ROLE_SUSPEND;
2354       p_scb->cong = true; /* do not allow the media data to go through */
2355       /* do not duplicate the media packets to this channel */
2356       p_scb->p_cos->stop(p_scb->hndl, p_scb->PeerAddress());
2357       p_scb->co_started = false;
2358       stop.flush = false;
2359       stop.suspend = true;
2360       stop.reconfig_stop = false;
2361       bta_av_ssm_execute(p_scb, BTA_AV_AP_STOP_EVT, (tBTA_AV_DATA*)&stop);
2362     }
2363   }
2364 }
2365
2366 /*******************************************************************************
2367  *
2368  * Function         bta_av_start_failed
2369  *
2370  * Description      Stream start failed.
2371  *
2372  * Returns          void
2373  *
2374  ******************************************************************************/
2375 void bta_av_start_failed(tBTA_AV_SCB* p_scb, UNUSED_ATTR tBTA_AV_DATA* p_data) {
2376   APPL_TRACE_ERROR(
2377       "%s: peer %s bta_handle:0x%x audio_open_cnt:%d started:%s co_started:%d",
2378       __func__, p_scb->PeerAddress().ToString().c_str(), p_scb->hndl,
2379       bta_av_cb.audio_open_cnt, logbool(p_scb->started).c_str(),
2380       p_scb->co_started);
2381
2382   if (!p_scb->started && !p_scb->co_started) {
2383     bta_sys_idle(BTA_ID_AV, bta_av_cb.audio_open_cnt, p_scb->PeerAddress());
2384     notify_start_failed(p_scb);
2385   }
2386
2387   BTM_unblock_role_switch_for(p_scb->PeerAddress());
2388   BTM_unblock_sniff_mode_for(p_scb->PeerAddress());
2389   p_scb->sco_suspend = false;
2390 }
2391
2392 /*******************************************************************************
2393  *
2394  * Function         bta_av_str_closed
2395  *
2396  * Description      Stream closed.
2397  *
2398  * Returns          void
2399  *
2400  ******************************************************************************/
2401 void bta_av_str_closed(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
2402   tBTA_AV data;
2403   tBTA_AV_EVT event;
2404
2405   APPL_TRACE_WARNING(
2406       "%s: peer %s bta_handle:0x%x open_status:%d chnl:%d co_started:%d",
2407       __func__, p_scb->PeerAddress().ToString().c_str(), p_scb->hndl,
2408       p_scb->open_status, p_scb->chnl, p_scb->co_started);
2409
2410   BTM_unblock_role_switch_for(p_scb->PeerAddress());
2411   BTM_unblock_sniff_mode_for(p_scb->PeerAddress());
2412   if (bta_av_cb.audio_open_cnt <= 1) {
2413     BTM_default_unblock_role_switch();
2414   }
2415
2416   if (p_scb->open_status != BTA_AV_SUCCESS) {
2417     /* must be failure when opening the stream */
2418     data.open.bd_addr = p_scb->PeerAddress();
2419     data.open.status = p_scb->open_status;
2420     data.open.chnl = p_scb->chnl;
2421     data.open.hndl = p_scb->hndl;
2422
2423     if (p_scb->seps[p_scb->sep_idx].tsep == AVDT_TSEP_SRC)
2424       data.open.sep = AVDT_TSEP_SNK;
2425     else if (p_scb->seps[p_scb->sep_idx].tsep == AVDT_TSEP_SNK)
2426       data.open.sep = AVDT_TSEP_SRC;
2427
2428     event = BTA_AV_OPEN_EVT;
2429     p_scb->open_status = BTA_AV_SUCCESS;
2430
2431     bta_sys_conn_close(BTA_ID_AV, p_scb->app_id, p_scb->PeerAddress());
2432     bta_av_cleanup(p_scb, p_data);
2433     (*bta_av_cb.p_cback)(event, &data);
2434   } else {
2435     /* do stop if we were started */
2436     if (p_scb->co_started) {
2437       bta_av_str_stopped(p_scb, NULL);
2438     }
2439
2440     {
2441       p_scb->p_cos->close(p_scb->hndl, p_scb->PeerAddress());
2442       data.close.chnl = p_scb->chnl;
2443       data.close.hndl = p_scb->hndl;
2444       event = BTA_AV_CLOSE_EVT;
2445
2446       bta_sys_conn_close(BTA_ID_AV, p_scb->app_id, p_scb->PeerAddress());
2447       bta_av_cleanup(p_scb, p_data);
2448       (*bta_av_cb.p_cback)(event, &data);
2449     }
2450   }
2451 }
2452
2453 /*******************************************************************************
2454  *
2455  * Function         bta_av_clr_cong
2456  *
2457  * Description      Clear stream congestion flag.
2458  *
2459  * Returns          void
2460  *
2461  ******************************************************************************/
2462 void bta_av_clr_cong(tBTA_AV_SCB* p_scb, UNUSED_ATTR tBTA_AV_DATA* p_data) {
2463   APPL_TRACE_DEBUG("%s", __func__);
2464   if (p_scb->co_started) {
2465     p_scb->cong = false;
2466   }
2467 }
2468
2469 /*******************************************************************************
2470  *
2471  * Function         bta_av_suspend_cfm
2472  *
2473  * Description      process the suspend response
2474  *
2475  * Returns          void
2476  *
2477  ******************************************************************************/
2478 void bta_av_suspend_cfm(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
2479   tBTA_AV_SUSPEND suspend_rsp;
2480   uint8_t err_code = p_data->str_msg.msg.hdr.err_code;
2481
2482   APPL_TRACE_DEBUG("%s: peer %s bta_handle:0x%x audio_open_cnt:%d err_code:%d",
2483                    __func__, p_scb->PeerAddress().ToString().c_str(),
2484                    p_scb->hndl, bta_av_cb.audio_open_cnt, err_code);
2485
2486   if (!p_scb->started) {
2487     /* handle the condition where there is a collision of SUSPEND req from
2488      *either side
2489      ** Second SUSPEND req could be rejected. Do not treat this as a failure
2490      */
2491     APPL_TRACE_WARNING("%s: already suspended, ignore, err_code %d", __func__,
2492                        err_code);
2493     return;
2494   }
2495
2496   suspend_rsp.status = BTA_AV_SUCCESS;
2497   if (err_code && (err_code != AVDT_ERR_BAD_STATE)) {
2498     suspend_rsp.status = BTA_AV_FAIL;
2499
2500     APPL_TRACE_ERROR("%s: suspend failed, closing connection", __func__);
2501
2502     /* SUSPEND failed. Close connection. */
2503     bta_av_ssm_execute(p_scb, BTA_AV_API_CLOSE_EVT, NULL);
2504   } else {
2505     /* only set started to false when suspend is successful */
2506     p_scb->started = false;
2507   }
2508
2509   if (p_scb->role & BTA_AV_ROLE_SUSPEND) {
2510     p_scb->role &= ~BTA_AV_ROLE_SUSPEND;
2511     p_scb->cong = false;
2512   }
2513
2514   bta_sys_idle(BTA_ID_AV, bta_av_cb.audio_open_cnt, p_scb->PeerAddress());
2515   BTM_unblock_role_switch_for(p_scb->PeerAddress());
2516   BTM_unblock_sniff_mode_for(p_scb->PeerAddress());
2517
2518   /* in case that we received suspend_ind, we may need to call co_stop here */
2519   if (p_scb->co_started) {
2520     uint16_t handle = get_btm_client_interface().lifecycle.BTM_GetHCIConnHandle(
2521         p_scb->PeerAddress(), BT_TRANSPORT_BR_EDR);
2522     if (bta_av_cb.offload_started_acl_hdl == handle) {
2523       bta_av_vendor_offload_stop();
2524       bta_av_cb.offload_started_acl_hdl = HCI_INVALID_HANDLE;
2525     } else if (bta_av_cb.offload_start_pending_acl_hdl == handle) {
2526       APPL_TRACE_WARNING("%s: Stop pending offload start command", __func__);
2527       bta_av_vendor_offload_stop();
2528       bta_av_cb.offload_start_pending_acl_hdl = HCI_INVALID_HANDLE;
2529     }
2530     bta_av_stream_chg(p_scb, false);
2531
2532     {
2533       p_scb->co_started = false;
2534       p_scb->p_cos->stop(p_scb->hndl, p_scb->PeerAddress());
2535     }
2536   }
2537
2538   {
2539     suspend_rsp.chnl = p_scb->chnl;
2540     suspend_rsp.hndl = p_scb->hndl;
2541     suspend_rsp.initiator = p_data->str_msg.initiator;
2542     tBTA_AV bta_av_data;
2543     bta_av_data.suspend = suspend_rsp;
2544     (*bta_av_cb.p_cback)(BTA_AV_SUSPEND_EVT, &bta_av_data);
2545   }
2546 }
2547
2548 /*******************************************************************************
2549  *
2550  * Function         bta_av_rcfg_str_ok
2551  *
2552  * Description      report reconfigure successful
2553  *
2554  * Returns          void
2555  *
2556  ******************************************************************************/
2557 void bta_av_rcfg_str_ok(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
2558   p_scb->l2c_cid = AVDT_GetL2CapChannel(p_scb->avdt_handle);
2559   APPL_TRACE_DEBUG("%s: peer %s bta_handle:0x%x l2c_cid:%d", __func__,
2560                    p_scb->PeerAddress().ToString().c_str(), p_scb->hndl,
2561                    p_scb->l2c_cid);
2562
2563   if (p_data != NULL) {
2564     // p_data could be NULL if the reconfig was triggered by the local device
2565     p_scb->stream_mtu =
2566         p_data->str_msg.msg.open_ind.peer_mtu - AVDT_MEDIA_HDR_SIZE;
2567     APPL_TRACE_DEBUG("%s: l2c_cid: 0x%x stream_mtu: %d", __func__,
2568                      p_scb->l2c_cid, p_scb->stream_mtu);
2569     p_scb->p_cos->update_mtu(p_scb->hndl, p_scb->PeerAddress(),
2570                              p_scb->stream_mtu);
2571   }
2572
2573   /* rc listen */
2574   bta_av_st_rc_timer(p_scb, NULL);
2575
2576   /* No need to keep the role bits once reconfig is done. */
2577   p_scb->role &= ~BTA_AV_ROLE_AD_ACP;
2578   p_scb->role &= ~BTA_AV_ROLE_SUSPEND_OPT;
2579   p_scb->role &= ~BTA_AV_ROLE_START_INT;
2580
2581   {
2582     /* reconfigure success  */
2583     tBTA_AV_RECONFIG reconfig;
2584     reconfig.status = BTA_AV_SUCCESS;
2585     reconfig.chnl = p_scb->chnl;
2586     reconfig.hndl = p_scb->hndl;
2587     tBTA_AV bta_av_data;
2588     bta_av_data.reconfig = reconfig;
2589     (*bta_av_cb.p_cback)(BTA_AV_RECONFIG_EVT, &bta_av_data);
2590   }
2591 }
2592
2593 /*******************************************************************************
2594  *
2595  * Function         bta_av_rcfg_failed
2596  *
2597  * Description      process reconfigure failed
2598  *
2599  * Returns          void
2600  *
2601  ******************************************************************************/
2602 void bta_av_rcfg_failed(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
2603   APPL_TRACE_ERROR("%s: num_recfg=%d conn_lcb=0x%x peer_addr=%s", __func__,
2604                    p_scb->num_recfg, bta_av_cb.conn_lcb,
2605                    p_scb->PeerAddress().ToString().c_str());
2606
2607   if (p_scb->num_recfg > BTA_AV_RECONFIG_RETRY) {
2608     bta_av_cco_close(p_scb, p_data);
2609     /* report failure */
2610     tBTA_AV_RECONFIG reconfig;
2611     reconfig.status = BTA_AV_FAIL_STREAM;
2612     reconfig.chnl = p_scb->chnl;
2613     reconfig.hndl = p_scb->hndl;
2614     tBTA_AV bta_av_data;
2615     bta_av_data.reconfig = reconfig;
2616     (*bta_av_cb.p_cback)(BTA_AV_RECONFIG_EVT, &bta_av_data);
2617     /* go to closing state */
2618     bta_av_ssm_execute(p_scb, BTA_AV_API_CLOSE_EVT, NULL);
2619   } else {
2620     /* open failed. try again */
2621     p_scb->num_recfg++;
2622     // conn_lcb is the index bitmask of all used LCBs, and since LCB and SCB use
2623     // the same index, it should be safe to use SCB index here.
2624     if ((bta_av_cb.conn_lcb & (1 << p_scb->hdi)) != 0) {
2625       AVDT_DisconnectReq(p_scb->PeerAddress(), &bta_av_proc_stream_evt);
2626     } else {
2627       APPL_TRACE_WARNING("%s: conn_lcb=0x%x bta_handle=0x%x (hdi=%u) no link",
2628                          __func__, bta_av_cb.conn_lcb, p_scb->hndl, p_scb->hdi);
2629       bta_av_connect_req(p_scb, NULL);
2630     }
2631   }
2632 }
2633
2634 /*******************************************************************************
2635  *
2636  * Function         bta_av_rcfg_connect
2637  *
2638  * Description      stream closed. reconnect the stream
2639  *
2640  * Returns          void
2641  *
2642  ******************************************************************************/
2643 void bta_av_rcfg_connect(tBTA_AV_SCB* p_scb, UNUSED_ATTR tBTA_AV_DATA* p_data) {
2644   APPL_TRACE_DEBUG("%s", __func__);
2645
2646   p_scb->cong = false;
2647   p_scb->num_recfg++;
2648   APPL_TRACE_DEBUG("%s: num_recfg: %d", __func__, p_scb->num_recfg);
2649   if (p_scb->num_recfg > BTA_AV_RECONFIG_RETRY) {
2650     /* let bta_av_rcfg_failed report fail */
2651     bta_av_rcfg_failed(p_scb, NULL);
2652   } else {
2653     AVDT_ConnectReq(p_scb->PeerAddress(), p_scb->hdi, &bta_av_proc_stream_evt);
2654   }
2655 }
2656
2657 /*******************************************************************************
2658  *
2659  * Function         bta_av_rcfg_discntd
2660  *
2661  * Description      AVDT disconnected. reconnect the stream
2662  *
2663  * Returns          void
2664  *
2665  ******************************************************************************/
2666 void bta_av_rcfg_discntd(tBTA_AV_SCB* p_scb, UNUSED_ATTR tBTA_AV_DATA* p_data) {
2667   APPL_TRACE_ERROR("%s: num_recfg=%d conn_lcb=0x%x peer_addr=%s", __func__,
2668                    p_scb->num_recfg, bta_av_cb.conn_lcb,
2669                    p_scb->PeerAddress().ToString().c_str());
2670
2671   p_scb->num_recfg++;
2672   if (p_scb->num_recfg > BTA_AV_RECONFIG_RETRY) {
2673     /* report failure */
2674     tBTA_AV_RECONFIG reconfig;
2675     reconfig.status = BTA_AV_FAIL_STREAM;
2676     reconfig.chnl = p_scb->chnl;
2677     reconfig.hndl = p_scb->hndl;
2678     tBTA_AV bta_av_data;
2679     bta_av_data.reconfig = reconfig;
2680     (*bta_av_cb.p_cback)(BTA_AV_RECONFIG_EVT, &bta_av_data);
2681     /* report close event & go to init state */
2682     bta_av_ssm_execute(p_scb, BTA_AV_STR_DISC_FAIL_EVT, NULL);
2683   } else {
2684     AVDT_ConnectReq(p_scb->PeerAddress(), p_scb->hdi, &bta_av_proc_stream_evt);
2685   }
2686 }
2687
2688 /*******************************************************************************
2689  *
2690  * Function         bta_av_suspend_cont
2691  *
2692  * Description      received the suspend response.
2693  *                  continue to reconfigure the stream
2694  *
2695  * Returns          void
2696  *
2697  ******************************************************************************/
2698 void bta_av_suspend_cont(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
2699   uint8_t err_code = p_data->str_msg.msg.hdr.err_code;
2700
2701   APPL_TRACE_DEBUG("%s: err_code=%d", __func__, err_code);
2702
2703   p_scb->started = false;
2704   p_scb->cong = false;
2705   if (err_code) {
2706     if (AVDT_ERR_CONNECT == err_code) {
2707       /* report failure */
2708       tBTA_AV_RECONFIG reconfig;
2709       reconfig.status = BTA_AV_FAIL;
2710       tBTA_AV bta_av_data;
2711       bta_av_data.reconfig = reconfig;
2712       (*bta_av_cb.p_cback)(BTA_AV_RECONFIG_EVT, &bta_av_data);
2713       APPL_TRACE_ERROR("%s: BTA_AV_STR_DISC_FAIL_EVT: peer_addr=%s", __func__,
2714                        p_scb->PeerAddress().ToString().c_str());
2715       bta_av_ssm_execute(p_scb, BTA_AV_STR_DISC_FAIL_EVT, NULL);
2716     } else {
2717       APPL_TRACE_ERROR("%s: suspend rejected, try close", __func__);
2718       /* drop the buffers queued in L2CAP */
2719       L2CA_FlushChannel(p_scb->l2c_cid, L2CAP_FLUSH_CHANS_ALL);
2720
2721       AVDT_CloseReq(p_scb->avdt_handle);
2722     }
2723   } else {
2724     APPL_TRACE_DEBUG("%s: calling AVDT_ReconfigReq", __func__);
2725     /* reconfig the stream */
2726
2727     APPL_TRACE_DEBUG("%s: codec: %s", __func__,
2728                      A2DP_CodecInfoString(p_scb->cfg.codec_info).c_str());
2729     AVDT_ReconfigReq(p_scb->avdt_handle, &p_scb->cfg);
2730     p_scb->cfg.psc_mask = p_scb->cur_psc_mask;
2731   }
2732 }
2733
2734 /*******************************************************************************
2735  *
2736  * Function         bta_av_rcfg_cfm
2737  *
2738  * Description      if reconfigure is successful, report the event
2739  *                  otherwise, close the stream.
2740  *
2741  * Returns          void
2742  *
2743  ******************************************************************************/
2744 void bta_av_rcfg_cfm(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
2745   uint8_t err_code = p_data->str_msg.msg.hdr.err_code;
2746
2747   APPL_TRACE_DEBUG("%s: err_code = %d", __func__, err_code);
2748
2749   // Disable AVDTP RECONFIGURE for rejectlisted devices
2750   bool disable_avdtp_reconfigure = false;
2751   {
2752     char remote_name[BTM_MAX_REM_BD_NAME_LEN] = "";
2753     if (btif_storage_get_stored_remote_name(p_scb->PeerAddress(),
2754                                             remote_name)) {
2755       if (interop_match_name(INTEROP_DISABLE_AVDTP_RECONFIGURE, remote_name) ||
2756           interop_match_addr(INTEROP_DISABLE_AVDTP_RECONFIGURE,
2757                              (const RawAddress*)&p_scb->PeerAddress())) {
2758         LOG_INFO(
2759             "%s: disable AVDTP RECONFIGURE: interop matched "
2760             "name %s address %s",
2761             __func__, remote_name, p_scb->PeerAddress().ToString().c_str());
2762         disable_avdtp_reconfigure = true;
2763       }
2764     }
2765   }
2766
2767   if ((err_code != 0) || disable_avdtp_reconfigure) {
2768     APPL_TRACE_ERROR("%s: reconfig rejected, try close", __func__);
2769     /* Disable reconfiguration feature only with explicit rejection(not with
2770      * timeout) */
2771     if ((err_code != AVDT_ERR_TIMEOUT) || disable_avdtp_reconfigure) {
2772       p_scb->recfg_sup = false;
2773     }
2774     /* started flag is false when reconfigure command is sent */
2775     /* drop the buffers queued in L2CAP */
2776     L2CA_FlushChannel(p_scb->l2c_cid, L2CAP_FLUSH_CHANS_ALL);
2777     AVDT_CloseReq(p_scb->avdt_handle);
2778   } else {
2779     /* update the codec info after rcfg cfm */
2780     APPL_TRACE_DEBUG(
2781         "%s: updating from codec %s to codec %s", __func__,
2782         A2DP_CodecName(p_scb->cfg.codec_info),
2783         A2DP_CodecName(p_data->str_msg.msg.reconfig_cfm.p_cfg->codec_info));
2784     memcpy(p_scb->cfg.codec_info,
2785            p_data->str_msg.msg.reconfig_cfm.p_cfg->codec_info, AVDT_CODEC_SIZE);
2786     /* take the SSM back to OPEN state */
2787     bta_av_ssm_execute(p_scb, BTA_AV_STR_OPEN_OK_EVT, NULL);
2788   }
2789 }
2790
2791 /*******************************************************************************
2792  *
2793  * Function         bta_av_rcfg_open
2794  *
2795  * Description      AVDT is connected. open the stream with the new
2796  *                  configuration
2797  *
2798  * Returns          void
2799  *
2800  ******************************************************************************/
2801 void bta_av_rcfg_open(tBTA_AV_SCB* p_scb, UNUSED_ATTR tBTA_AV_DATA* p_data) {
2802   APPL_TRACE_DEBUG("%s: peer %s bta_handle:0x%x num_disc_snks:%d", __func__,
2803                    p_scb->PeerAddress().ToString().c_str(), p_scb->hndl,
2804                    p_scb->num_disc_snks);
2805
2806   if (p_scb->num_disc_snks == 0) {
2807     /* Need to update call-out module so that it will be ready for discover */
2808     p_scb->p_cos->stop(p_scb->hndl, p_scb->PeerAddress());
2809
2810     /* send avdtp discover request */
2811     AVDT_DiscoverReq(p_scb->PeerAddress(), p_scb->hdi, p_scb->sep_info,
2812                      BTA_AV_NUM_SEPS, &bta_av_proc_stream_evt);
2813   } else {
2814     APPL_TRACE_DEBUG("%s: calling AVDT_OpenReq()", __func__);
2815     APPL_TRACE_DEBUG("%s: codec: %s", __func__,
2816                      A2DP_CodecInfoString(p_scb->cfg.codec_info).c_str());
2817
2818     /* we may choose to use a different SEP at reconfig.
2819      * adjust the sep_idx now */
2820     bta_av_adjust_seps_idx(p_scb, bta_av_get_scb_handle(p_scb, AVDT_TSEP_SRC));
2821     LOG_INFO("%s: sep_idx=%d avdt_handle=%d bta_handle=0x%x", __func__,
2822              p_scb->sep_idx, p_scb->avdt_handle, p_scb->hndl);
2823
2824     /* open the stream with the new config */
2825     p_scb->sep_info_idx = p_scb->rcfg_idx;
2826     AVDT_OpenReq(p_scb->avdt_handle, p_scb->PeerAddress(), p_scb->hdi,
2827                  p_scb->sep_info[p_scb->sep_info_idx].seid, &p_scb->cfg);
2828   }
2829 }
2830
2831 /*******************************************************************************
2832  *
2833  * Function         bta_av_security_rej
2834  *
2835  * Description      Send an AVDTP security reject.
2836  *
2837  * Returns          void
2838  *
2839  ******************************************************************************/
2840 void bta_av_security_rej(tBTA_AV_SCB* p_scb, UNUSED_ATTR tBTA_AV_DATA* p_data) {
2841   AVDT_SecurityRsp(p_scb->avdt_handle, p_scb->avdt_label, AVDT_ERR_BAD_STATE,
2842                    NULL, 0);
2843 }
2844
2845 /*******************************************************************************
2846  *
2847  * Function         bta_av_chk_2nd_start
2848  *
2849  * Description      check if this is 2nd stream and if it needs to be started.
2850  *                  This function needs to be kept very similar to
2851  *                  bta_av_chk_start
2852  *
2853  * Returns          void
2854  *
2855  ******************************************************************************/
2856 void bta_av_chk_2nd_start(tBTA_AV_SCB* p_scb,
2857                           UNUSED_ATTR tBTA_AV_DATA* p_data) {
2858   LOG_INFO(
2859       "%s: peer %s channel:%d bta_av_cb.audio_open_cnt:%d role:0x%x "
2860       "features:0x%x",
2861       __func__, p_scb->PeerAddress().ToString().c_str(), p_scb->chnl,
2862       bta_av_cb.audio_open_cnt, p_scb->role, bta_av_cb.features);
2863
2864   if ((p_scb->chnl == BTA_AV_CHNL_AUDIO) && (bta_av_cb.audio_open_cnt >= 2) &&
2865       (((p_scb->role & BTA_AV_ROLE_AD_ACP) == 0) ||  // Outgoing connection or
2866        (bta_av_cb.features & BTA_AV_FEAT_ACP_START))) {  // Auto-starting option
2867     // More than one audio channel is connected.
2868     if (!(p_scb->role & BTA_AV_ROLE_SUSPEND_OPT)) {
2869       // This channel does not need to be reconfigured.
2870       // If there is other channel streaming, start the stream now.
2871       bool new_started = false;
2872       for (int i = 0; i < BTA_AV_NUM_STRS; i++) {
2873         tBTA_AV_SCB* p_scbi = bta_av_cb.p_scb[i];
2874         if (p_scb == p_scbi) {
2875           continue;
2876         }
2877         if (p_scbi && p_scbi->chnl == BTA_AV_CHNL_AUDIO && p_scbi->co_started) {
2878           if (!new_started) {
2879             // Start the new stream
2880             new_started = true;
2881             LOG_INFO(
2882                 "%s: starting new stream for peer %s because peer %s "
2883                 "already started",
2884                 __func__, p_scb->PeerAddress().ToString().c_str(),
2885                 p_scbi->PeerAddress().ToString().c_str());
2886             bta_av_ssm_execute(p_scb, BTA_AV_AP_START_EVT, NULL);
2887           }
2888           // May need to update the flush timeout of this already started stream
2889           if (p_scbi->co_started != bta_av_cb.audio_open_cnt) {
2890             p_scbi->co_started = bta_av_cb.audio_open_cnt;
2891           }
2892         }
2893       }
2894     }
2895   }
2896 }
2897
2898 /*******************************************************************************
2899  *
2900  * Function         bta_av_open_rc
2901  *
2902  * Description      Send a message to main SM to open RC channel.
2903  *
2904  * Returns          void
2905  *
2906  ******************************************************************************/
2907 void bta_av_open_rc(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
2908   APPL_TRACE_DEBUG("%s: use_rc: %d, wait: 0x%x role: 0x%x", __func__,
2909                    p_scb->use_rc, p_scb->wait, p_scb->role);
2910   if ((p_scb->wait & BTA_AV_WAIT_ROLE_SW_BITS) &&
2911       (p_scb->q_tag == BTA_AV_Q_TAG_START)) {
2912     /* waiting for role switch for some reason & the timer expires */
2913     if (!bta_av_link_role_ok(p_scb, A2DP_SET_ONE_BIT)) {
2914       APPL_TRACE_ERROR(
2915           "%s: failed to start streaming for role management reasons!!",
2916           __func__);
2917       alarm_cancel(p_scb->avrc_ct_timer);
2918
2919       tBTA_AV_START start;
2920       start.chnl = p_scb->chnl;
2921       start.status = BTA_AV_FAIL_ROLE;
2922       start.initiator = true;
2923       start.hndl = p_scb->hndl;
2924       p_scb->wait &= ~BTA_AV_WAIT_ROLE_SW_BITS;
2925       bta_av_cb.rs_idx = 0;
2926       tBTA_AV bta_av_data;
2927       bta_av_data.start = start;
2928       (*bta_av_cb.p_cback)(BTA_AV_START_EVT, &bta_av_data);
2929     } else {
2930       /* role switch is done. continue to start streaming */
2931       bta_av_cb.rs_idx = 0;
2932       p_data->hdr.offset = BTA_AV_RS_OK;
2933       bta_av_start_ok(p_scb, p_data);
2934     }
2935     return;
2936   }
2937
2938   if (p_scb->use_rc || (p_scb->role & BTA_AV_ROLE_AD_ACP)) {
2939     if (bta_av_cb.disc) {
2940       /* AVRC discover db is in use */
2941       if (p_scb->rc_handle == BTA_AV_RC_HANDLE_NONE) {
2942         /* AVRC channel is not connected. delay a little bit */
2943         if ((p_scb->wait & BTA_AV_WAIT_ROLE_SW_BITS) == 0) {
2944           bta_sys_start_timer(p_scb->avrc_ct_timer, BTA_AV_RC_DISC_TIME_VAL,
2945                               BTA_AV_AVRC_TIMER_EVT, p_scb->hndl);
2946         } else {
2947           p_scb->wait |= BTA_AV_WAIT_CHECK_RC;
2948         }
2949       }
2950     } else {
2951       /* use main SM for AVRC SDP activities */
2952       if (is_new_avrcp_enabled()) {
2953         APPL_TRACE_WARNING("%s: Using the new AVRCP Profile", __func__);
2954         bluetooth::avrcp::AvrcpService::Get()->ConnectDevice(
2955             p_scb->PeerAddress());
2956       } else {
2957         bta_av_rc_disc((uint8_t)(p_scb->hdi + 1));
2958       }
2959     }
2960   } else {
2961     if (BTA_AV_RC_HANDLE_NONE != p_scb->rc_handle) {
2962       /* the open API said that this handle does not want a RC connection.
2963        * disconnect it now */
2964       AVRC_Close(p_scb->rc_handle);
2965     }
2966   }
2967 }
2968
2969 /*******************************************************************************
2970  *
2971  * Function         bta_av_open_at_inc
2972  *
2973  * Description      This function is called if API open is called by application
2974  *                  while state-machine is at incoming state.
2975  *
2976  * Returns          void
2977  *
2978  ******************************************************************************/
2979 void bta_av_open_at_inc(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
2980   memcpy(&(p_scb->open_api), &(p_data->api_open), sizeof(tBTA_AV_API_OPEN));
2981
2982   APPL_TRACE_DEBUG("%s: peer %s coll_mask=0x%02x", __func__,
2983                    p_scb->PeerAddress().ToString().c_str(), p_scb->coll_mask);
2984
2985   if (p_scb->coll_mask & BTA_AV_COLL_INC_TMR) {
2986     p_scb->coll_mask |= BTA_AV_COLL_API_CALLED;
2987
2988     /* API open will be handled at timeout if SNK did not start signalling. */
2989     /* API open will be ignored if SNK starts signalling.                   */
2990   } else {
2991     /* SNK did not start signalling, API was called N seconds timeout. */
2992     /* We need to switch to INIT state and start opening connection. */
2993     p_scb->coll_mask = 0;
2994     bta_av_set_scb_sst_init(p_scb);
2995
2996     tBTA_AV_API_OPEN* p_buf =
2997         (tBTA_AV_API_OPEN*)osi_malloc(sizeof(tBTA_AV_API_OPEN));
2998     memcpy(p_buf, &(p_scb->open_api), sizeof(tBTA_AV_API_OPEN));
2999     bta_sys_sendmsg(p_buf);
3000   }
3001 }
3002
3003 void offload_vendor_callback(tBTM_VSC_CMPL* param) {
3004   tBTA_AV value{0};
3005   uint8_t sub_opcode = 0;
3006   if (param->param_len) {
3007     APPL_TRACE_DEBUG("%s: param_len = %d status = %d", __func__,
3008                      param->param_len, param->p_param_buf[0]);
3009     value.status = static_cast<tBTA_AV_STATUS>(param->p_param_buf[0]);
3010   }
3011   if (value.status == 0) {
3012     sub_opcode = param->p_param_buf[1];
3013     APPL_TRACE_DEBUG("%s: subopcode = %d", __func__, sub_opcode);
3014     switch (sub_opcode) {
3015       case VS_HCI_A2DP_OFFLOAD_STOP:
3016         APPL_TRACE_DEBUG("%s: VS_HCI_STOP_A2DP_MEDIA successful", __func__);
3017         break;
3018       case VS_HCI_A2DP_OFFLOAD_START:
3019         if (bta_av_cb.offload_start_pending_acl_hdl != HCI_INVALID_HANDLE) {
3020           bta_av_cb.offload_started_acl_hdl =
3021               bta_av_cb.offload_start_pending_acl_hdl;
3022           bta_av_cb.offload_start_pending_acl_hdl = HCI_INVALID_HANDLE;
3023         } else {
3024           LOG_INFO("%s: No pending start command due to AVDTP suspend immediately", __func__);
3025         }
3026         (*bta_av_cb.p_cback)(BTA_AV_OFFLOAD_START_RSP_EVT, &value);
3027         break;
3028       default:
3029         break;
3030     }
3031   } else {
3032     APPL_TRACE_DEBUG("%s: Offload failed for subopcode= %d", __func__,
3033                      sub_opcode);
3034     if (param->opcode != VS_HCI_A2DP_OFFLOAD_STOP) {
3035       bta_av_cb.offload_start_pending_acl_hdl = HCI_INVALID_HANDLE;
3036       (*bta_av_cb.p_cback)(BTA_AV_OFFLOAD_START_RSP_EVT, &value);
3037     }
3038   }
3039 }
3040
3041 void bta_av_vendor_offload_start(tBTA_AV_SCB* p_scb,
3042                                  tBT_A2DP_OFFLOAD* offload_start) {
3043   uint8_t param[sizeof(tBT_A2DP_OFFLOAD)];
3044   APPL_TRACE_DEBUG("%s", __func__);
3045
3046   uint8_t* p_param = param;
3047   *p_param++ = VS_HCI_A2DP_OFFLOAD_START;
3048
3049   UINT32_TO_STREAM(p_param, offload_start->codec_type);
3050   UINT16_TO_STREAM(p_param, offload_start->max_latency);
3051   ARRAY_TO_STREAM(p_param, offload_start->scms_t_enable,
3052                   static_cast<int>(offload_start->scms_t_enable.size()));
3053   UINT32_TO_STREAM(p_param, offload_start->sample_rate);
3054   UINT8_TO_STREAM(p_param, offload_start->bits_per_sample);
3055   UINT8_TO_STREAM(p_param, offload_start->ch_mode);
3056   UINT32_TO_STREAM(p_param, offload_start->encoded_audio_bitrate);
3057   UINT16_TO_STREAM(p_param, offload_start->acl_hdl);
3058   UINT16_TO_STREAM(p_param, offload_start->l2c_rcid);
3059   UINT16_TO_STREAM(p_param, offload_start->mtu);
3060   ARRAY_TO_STREAM(p_param, offload_start->codec_info,
3061                   (int8_t)sizeof(offload_start->codec_info));
3062   bta_av_cb.offload_start_pending_acl_hdl = offload_start->acl_hdl;
3063   BTM_VendorSpecificCommand(HCI_CONTROLLER_A2DP, p_param - param,
3064                             param, offload_vendor_callback);
3065 }
3066
3067 void bta_av_vendor_offload_stop() {
3068   uint8_t param[sizeof(tBT_A2DP_OFFLOAD)];
3069   APPL_TRACE_DEBUG("%s", __func__);
3070   param[0] = VS_HCI_A2DP_OFFLOAD_STOP;
3071   BTM_VendorSpecificCommand(HCI_CONTROLLER_A2DP, 1, param,
3072                             offload_vendor_callback);
3073 }
3074 /*******************************************************************************
3075  *
3076  * Function         bta_av_offload_req
3077  *
3078  * Description      This function is called if application requests offload of
3079  *                  a2dp audio.
3080  *
3081  * Returns          void
3082  *
3083  ******************************************************************************/
3084 void bta_av_offload_req(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
3085   tBTA_AV_STATUS status = BTA_AV_FAIL_RESOURCES;
3086
3087   tBT_A2DP_OFFLOAD offload_start;
3088   APPL_TRACE_DEBUG("%s: stream %s, audio channels open %d", __func__,
3089                    p_scb->started ? "STARTED" : "STOPPED",
3090                    bta_av_cb.audio_open_cnt);
3091   /* Check if stream has already been started. */
3092   /* Support offload if only one audio source stream is open. */
3093   if (p_scb->started != true) {
3094     status = BTA_AV_FAIL_STREAM;
3095   } else if (bta_av_cb.offload_start_pending_acl_hdl != HCI_INVALID_HANDLE ||
3096              bta_av_cb.offload_started_acl_hdl != HCI_INVALID_HANDLE) {
3097     APPL_TRACE_WARNING("%s: offload already started, ignore request", __func__);
3098     return;
3099   } else {
3100     bta_av_offload_codec_builder(p_scb, &offload_start);
3101     bta_av_vendor_offload_start(p_scb, &offload_start);
3102     return;
3103   }
3104   if (status != BTA_AV_SUCCESS) {
3105     tBTA_AV bta_av_data;
3106     bta_av_data.status = status;
3107     (*bta_av_cb.p_cback)(BTA_AV_OFFLOAD_START_RSP_EVT, &bta_av_data);
3108   }
3109   /* TODO(eisenbach): RE-IMPLEMENT USING VSC OR HAL EXTENSION
3110   else if (bta_av_cb.audio_open_cnt == 1 &&
3111              p_scb->seps[p_scb->sep_idx].tsep == AVDT_TSEP_SRC &&
3112              p_scb->chnl == BTA_AV_CHNL_AUDIO) {
3113     bt_vendor_op_a2dp_offload_t a2dp_offload_start;
3114
3115     if (L2CA_GetConnectionConfig(
3116             p_scb->l2c_cid, &a2dp_offload_start.acl_data_size,
3117             &a2dp_offload_start.remote_cid, &a2dp_offload_start.lm_handle)) {
3118       APPL_TRACE_DEBUG("%s: l2cmtu %d lcid 0x%02X rcid 0x%02X lm_handle
3119   0x%02X",
3120                       __func__, a2dp_offload_start.acl_data_size,
3121                        p_scb->l2c_cid, a2dp_offload_start.remote_cid,
3122                        a2dp_offload_start.lm_handle);
3123
3124       a2dp_offload_start.bta_av_handle = p_scb->hndl;
3125       a2dp_offload_start.xmit_quota = BTA_AV_A2DP_OFFLOAD_XMIT_QUOTA;
3126       a2dp_offload_start.stream_mtu = p_scb->stream_mtu;
3127       a2dp_offload_start.local_cid = p_scb->l2c_cid;
3128       a2dp_offload_start.is_flushable = true;
3129       a2dp_offload_start.stream_source =
3130           ((uint32_t)(p_scb->cfg.codec_info[1] | p_scb->cfg.codec_info[2]));
3131
3132       memcpy(a2dp_offload_start.codec_info, p_scb->cfg.codec_info,
3133              sizeof(a2dp_offload_start.codec_info));
3134
3135       if (!vendor_get_interface()->send_command(
3136               (vendor_opcode_t)BT_VND_OP_A2DP_OFFLOAD_START,
3137               &a2dp_offload_start)) {
3138         status = BTA_AV_SUCCESS;
3139         p_scb->offload_start_pending = true;
3140       }
3141     }
3142   }
3143  */
3144 }
3145
3146 /*******************************************************************************
3147  *
3148  * Function         bta_av_offload_rsp
3149  *
3150  * Description      This function is called when the vendor lib responds to
3151  *                  BT_VND_OP_A2DP_OFFLOAD_START.
3152  *
3153  * Returns          void
3154  *
3155  ******************************************************************************/
3156 void bta_av_offload_rsp(tBTA_AV_SCB* p_scb, tBTA_AV_DATA* p_data) {
3157   tBTA_AV_STATUS status = p_data->api_status_rsp.status;
3158
3159   APPL_TRACE_DEBUG("%s: stream %s status %s", __func__,
3160                    p_scb->started ? "STARTED" : "STOPPED",
3161                    status ? "FAIL" : "SUCCESS");
3162
3163   /* Check if stream has already been started. */
3164   if (status == BTA_AV_SUCCESS && p_scb->started != true) {
3165     status = BTA_AV_FAIL_STREAM;
3166   }
3167
3168   bta_av_cb.offload_start_pending_acl_hdl = HCI_INVALID_HANDLE;
3169   tBTA_AV bta_av_data;
3170   bta_av_data.status = status;
3171   (*bta_av_cb.p_cback)(BTA_AV_OFFLOAD_START_RSP_EVT, &bta_av_data);
3172 }
3173
3174 static void bta_av_offload_codec_builder(tBTA_AV_SCB* p_scb,
3175                                          tBT_A2DP_OFFLOAD* p_a2dp_offload) {
3176   A2dpCodecConfig* CodecConfig = bta_av_get_a2dp_current_codec();
3177   btav_a2dp_codec_index_t codec_index =
3178       A2DP_SourceCodecIndex(p_scb->cfg.codec_info);
3179   uint32_t codec_type = 0;
3180   uint16_t mtu = p_scb->stream_mtu;
3181   APPL_TRACE_DEBUG("%s:codec_index = %d", __func__, codec_index);
3182   switch (codec_index) {
3183     case BTAV_A2DP_CODEC_INDEX_SOURCE_SBC:
3184       codec_type = BTA_AV_CODEC_TYPE_SBC;
3185       if (A2DP_GetMaxBitpoolSbc(p_scb->cfg.codec_info) <=
3186           A2DP_SBC_BITPOOL_MIDDLE_QUALITY) {
3187         APPL_TRACE_WARNING("%s: Restricting streaming MTU size for MQ Bitpool",
3188                            __func__);
3189         mtu = MAX_2MBPS_AVDTP_MTU;
3190       }
3191       break;
3192     case BTAV_A2DP_CODEC_INDEX_SOURCE_AAC:
3193       codec_type = BTA_AV_CODEC_TYPE_AAC;
3194       break;
3195     case BTAV_A2DP_CODEC_INDEX_SOURCE_APTX:
3196       codec_type = BTA_AV_CODEC_TYPE_APTX;
3197       break;
3198     case BTAV_A2DP_CODEC_INDEX_SOURCE_APTX_HD:
3199       codec_type = BTA_AV_CODEC_TYPE_APTXHD;
3200       break;
3201     case BTAV_A2DP_CODEC_INDEX_SOURCE_LDAC:
3202       codec_type = BTA_AV_CODEC_TYPE_LDAC;
3203       break;
3204     default:
3205       APPL_TRACE_ERROR("%s: Unknown Codec type ", __func__);
3206       return;
3207   }
3208   if (mtu > MAX_3MBPS_AVDTP_MTU) mtu = MAX_3MBPS_AVDTP_MTU;
3209   p_a2dp_offload->codec_type = codec_type;
3210   p_a2dp_offload->max_latency = 0;
3211   p_a2dp_offload->mtu = mtu;
3212   p_a2dp_offload->acl_hdl =
3213       get_btm_client_interface().lifecycle.BTM_GetHCIConnHandle(
3214           p_scb->PeerAddress(), BT_TRANSPORT_BR_EDR);
3215   btav_a2dp_scmst_info_t scmst_info =
3216       p_scb->p_cos->get_scmst_info(p_scb->PeerAddress());
3217   p_a2dp_offload->scms_t_enable[0] = scmst_info.enable_status;
3218   p_a2dp_offload->scms_t_enable[1] = scmst_info.cp_header;
3219   APPL_TRACE_DEBUG(
3220       "%s: SCMS-T_enable status: %d, "
3221       "SCMS-T header (if it's enabled): 0x%02x",
3222       __func__, scmst_info.enable_status, scmst_info.cp_header);
3223
3224   switch (A2DP_GetTrackSampleRate(p_scb->cfg.codec_info)) {
3225     case 44100:
3226       p_a2dp_offload->sample_rate = BTAV_A2DP_CODEC_SAMPLE_RATE_44100;
3227       break;
3228     case 48000:
3229       p_a2dp_offload->sample_rate = BTAV_A2DP_CODEC_SAMPLE_RATE_48000;
3230       break;
3231     case 88200:
3232       p_a2dp_offload->sample_rate = BTAV_A2DP_CODEC_SAMPLE_RATE_88200;
3233       break;
3234     case 96000:
3235       p_a2dp_offload->sample_rate = BTAV_A2DP_CODEC_SAMPLE_RATE_96000;
3236       break;
3237   }
3238   if (L2CA_GetRemoteCid(p_scb->l2c_cid, &p_a2dp_offload->l2c_rcid) == false) {
3239     APPL_TRACE_ERROR("%s: Failed to fetch l2c rcid", __func__);
3240     return;
3241   }
3242   switch (CodecConfig->getAudioBitsPerSample()) {
3243     case 16:
3244       p_a2dp_offload->bits_per_sample = BTAV_A2DP_CODEC_BITS_PER_SAMPLE_16;
3245       break;
3246     case 24:
3247       p_a2dp_offload->bits_per_sample = BTAV_A2DP_CODEC_BITS_PER_SAMPLE_24;
3248       break;
3249     case 32:
3250       p_a2dp_offload->bits_per_sample = BTAV_A2DP_CODEC_BITS_PER_SAMPLE_32;
3251       break;
3252   }
3253   p_a2dp_offload->ch_mode = A2DP_GetTrackChannelCount(p_scb->cfg.codec_info);
3254   p_a2dp_offload->encoded_audio_bitrate = CodecConfig->getTrackBitRate();
3255   if (!CodecConfig->getCodecSpecificConfig(p_a2dp_offload)) {
3256     APPL_TRACE_ERROR("%s: not a valid codec info", __func__);
3257   }
3258 }