path: root/stack/btm/btm_devctl.cc

/******************************************************************************
 *
 *  Copyright (C) 1999-2012 Broadcom Corporation
 *
 *  Licensed under the Apache License, Version 2.0 (the "License");
 *  you may not use this file except in compliance with the License.
 *  You may obtain a copy of the License at:
 *
 *  http://www.apache.org/licenses/LICENSE-2.0
 *
 *  Unless required by applicable law or agreed to in writing, software
 *  distributed under the License is distributed on an "AS IS" BASIS,
 *  WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 *  See the License for the specific language governing permissions and
 *  limitations under the License.
 *
 ******************************************************************************/

/******************************************************************************
 *
 *  This file contains functions that handle BTM interface functions for the
 *  Bluetooth device including Rest, HCI buffer size and others
 *
 ******************************************************************************/

#include <base/logging.h>
#include <stddef.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>

#include "bt_types.h"
#include "bt_utils.h"
#include "btcore/include/module.h"
#include "btm_int.h"
#include "btu.h"
#include "device/include/controller.h"
#include "hci_layer.h"
#include "hcimsgs.h"
#include "l2c_int.h"
#include "osi/include/osi.h"
#include "osi/include/thread.h"
#include "stack/gatt/connection_manager.h"

#include "gatt_int.h"
#include "hci/include/vendor.h"

extern thread_t* bt_workqueue_thread;

/******************************************************************************/
/*               L O C A L    D A T A    D E F I N I T I O N S                */
/******************************************************************************/

#ifndef BTM_DEV_RESET_TIMEOUT
#define BTM_DEV_RESET_TIMEOUT 4
#endif

// TODO: Reevaluate this value in the context of timers with ms granularity
#define BTM_DEV_NAME_REPLY_TIMEOUT_MS    \
  (2 * 1000) /* 2 seconds for name reply \
                */

#define BTM_INFO_TIMEOUT 5 /* 5 seconds for info response */

/******************************************************************************/
/*            L O C A L    F U N C T I O N     P R O T O T Y P E S            */
/******************************************************************************/

static void btm_decode_ext_features_page(uint8_t page_number,
                                         const BD_FEATURES p_features);
static void BTM_BT_Quality_Report_VSE_CBack(uint8_t length, uint8_t* p_stream);

/*******************************************************************************
 *
 * Function         btm_dev_init
 *
 * Description      This function is on the BTM startup
 *
 * Returns          void
 *
 ******************************************************************************/
void btm_dev_init(void) {
  /* Initialize nonzero defaults */
  memset(btm_cb.cfg.bd_name, 0, sizeof(tBTM_LOC_BD_NAME));

  btm_cb.devcb.read_local_name_timer = alarm_new("btm.read_local_name_timer");
  btm_cb.devcb.read_rssi_timer = alarm_new("btm.read_rssi_timer");
  btm_cb.devcb.read_failed_contact_counter_timer =
      alarm_new("btm.read_failed_contact_counter_timer");
  btm_cb.devcb.read_automatic_flush_timeout_timer =
      alarm_new("btm.read_automatic_flush_timeout_timer");
  btm_cb.devcb.read_link_quality_timer =
      alarm_new("btm.read_link_quality_timer");
  btm_cb.devcb.read_inq_tx_power_timer =
      alarm_new("btm.read_inq_tx_power_timer");
  btm_cb.devcb.qos_setup_timer = alarm_new("btm.qos_setup_timer");
  btm_cb.devcb.read_tx_power_timer = alarm_new("btm.read_tx_power_timer");

  btm_cb.btm_acl_pkt_types_supported =
      BTM_ACL_PKT_TYPES_MASK_DH1 + BTM_ACL_PKT_TYPES_MASK_DM1 +
      BTM_ACL_PKT_TYPES_MASK_DH3 + BTM_ACL_PKT_TYPES_MASK_DM3 +
      BTM_ACL_PKT_TYPES_MASK_DH5 + BTM_ACL_PKT_TYPES_MASK_DM5;

  btm_cb.btm_sco_pkt_types_supported =
      ESCO_PKT_TYPES_MASK_HV1 + ESCO_PKT_TYPES_MASK_HV2 +
      ESCO_PKT_TYPES_MASK_HV3 + ESCO_PKT_TYPES_MASK_EV3 +
      ESCO_PKT_TYPES_MASK_EV4 + ESCO_PKT_TYPES_MASK_EV5;
}

void btm_dev_free() {
  alarm_free(btm_cb.devcb.read_local_name_timer);
  alarm_free(btm_cb.devcb.read_rssi_timer);
  alarm_free(btm_cb.devcb.read_failed_contact_counter_timer);
  alarm_free(btm_cb.devcb.read_automatic_flush_timeout_timer);
  alarm_free(btm_cb.devcb.read_link_quality_timer);
  alarm_free(btm_cb.devcb.read_inq_tx_power_timer);
  alarm_free(btm_cb.devcb.qos_setup_timer);
  alarm_free(btm_cb.devcb.read_tx_power_timer);
}

/*******************************************************************************
 *
 * Function         btm_db_reset
 *
 * Description      This function is called by BTM_DeviceReset and clears out
 *                  any pending callbacks for inquiries, discoveries, other
 *                  pending functions that may be in progress.
 *
 * Returns          void
 *
 ******************************************************************************/
static void btm_db_reset(void) {
  tBTM_CMPL_CB* p_cb;
  tBTM_STATUS status = BTM_DEV_RESET;

  btm_inq_db_reset();

  if (btm_cb.devcb.p_rln_cmpl_cb) {
    p_cb = btm_cb.devcb.p_rln_cmpl_cb;
    btm_cb.devcb.p_rln_cmpl_cb = NULL;

    if (p_cb) (*p_cb)((void*)NULL);
  }

  if (btm_cb.devcb.p_rssi_cmpl_cb) {
    p_cb = btm_cb.devcb.p_rssi_cmpl_cb;
    btm_cb.devcb.p_rssi_cmpl_cb = NULL;

    if (p_cb) (*p_cb)((tBTM_RSSI_RESULT*)&status);
  }

  if (btm_cb.devcb.p_failed_contact_counter_cmpl_cb) {
    p_cb = btm_cb.devcb.p_failed_contact_counter_cmpl_cb;
    btm_cb.devcb.p_failed_contact_counter_cmpl_cb = NULL;

    if (p_cb) (*p_cb)((tBTM_FAILED_CONTACT_COUNTER_RESULT*)&status);
  }

  if (btm_cb.devcb.p_automatic_flush_timeout_cmpl_cb) {
    p_cb = btm_cb.devcb.p_automatic_flush_timeout_cmpl_cb;
    btm_cb.devcb.p_automatic_flush_timeout_cmpl_cb = NULL;

    if (p_cb) (*p_cb)((tBTM_AUTOMATIC_FLUSH_TIMEOUT_RESULT*)&status);
  }
}

bool set_sec_state_idle(void* data, void* context) {
  tBTM_SEC_DEV_REC* p_dev_rec = static_cast<tBTM_SEC_DEV_REC*>(data);
  p_dev_rec->sec_state = BTM_SEC_STATE_IDLE;
  return true;
}

static void reset_complete(void* result) {
  CHECK(result == FUTURE_SUCCESS);
  const controller_t* controller = controller_get_interface();

  /* Tell L2CAP that all connections are gone */
  l2cu_device_reset();

  /* Clear current security state */
  list_foreach(btm_cb.sec_dev_rec, set_sec_state_idle, NULL);

  /* After the reset controller should restore all parameters to defaults. */
  btm_cb.btm_inq_vars.inq_counter = 1;
  btm_cb.btm_inq_vars.inq_scan_window = HCI_DEF_INQUIRYSCAN_WINDOW;
  btm_cb.btm_inq_vars.inq_scan_period = HCI_DEF_INQUIRYSCAN_INTERVAL;
  btm_cb.btm_inq_vars.inq_scan_type = HCI_DEF_SCAN_TYPE;

  btm_cb.btm_inq_vars.page_scan_window = HCI_DEF_PAGESCAN_WINDOW;
  btm_cb.btm_inq_vars.page_scan_period = HCI_DEF_PAGESCAN_INTERVAL;
  btm_cb.btm_inq_vars.page_scan_type = HCI_DEF_SCAN_TYPE;

  btm_cb.ble_ctr_cb.conn_state = BLE_CONN_IDLE;
  connection_manager::reset(true);

  btm_pm_reset();

  l2c_link_processs_num_bufs(controller->get_acl_buffer_count_classic());

  // setup the random number generator
  std::srand(std::time(nullptr));

#if (BLE_PRIVACY_SPT == TRUE)
  /* Set up the BLE privacy settings */
  if (controller->supports_ble() && controller->supports_ble_privacy() &&
      controller->get_ble_resolving_list_max_size() > 0) {
    btm_ble_resolving_list_init(controller->get_ble_resolving_list_max_size());
    /* set the default random private address timeout */
    btsnd_hcic_ble_set_rand_priv_addr_timeout(
        btm_get_next_private_addrress_interval_ms() / 1000);
  }
#endif

  if (controller->supports_ble()) {
    btm_ble_white_list_init(controller->get_ble_white_list_size());
    l2c_link_processs_ble_num_bufs(controller->get_acl_buffer_count_ble());
  }

  BTM_SetPinType(btm_cb.cfg.pin_type, btm_cb.cfg.pin_code,
                 btm_cb.cfg.pin_code_len);

  for (int i = 0; i <= controller->get_last_features_classic_index(); i++) {
    btm_decode_ext_features_page(i,
                                 controller->get_features_classic(i)->as_array);
  }

  btm_report_device_status(BTM_DEV_STATUS_UP);
}

// TODO(zachoverflow): remove this function
void BTM_DeviceReset(UNUSED_ATTR tBTM_CMPL_CB* p_cb) {
  /* Flush all ACL connections */
  btm_acl_device_down();

  /* Clear the callback, so application would not hang on reset */
  btm_db_reset();

  module_start_up_callbacked_wrapper(get_module(CONTROLLER_MODULE),
                                     bt_workqueue_thread, reset_complete);
}

void BTM_HCI_Reset(void) {
  /* Flush all ACL connections */
  btm_acl_device_down();

  /* Clear the callback, so application would not hang on reset */
  btm_db_reset();

  btsnd_hcic_reset(LOCAL_BR_EDR_CONTROLLER_ID);
}

/*******************************************************************************
 *
 * Function         BTM_IsDeviceUp
 *
 * Description      This function is called to check if the device is up.
 *
 * Returns          true if device is up, else false
 *
 ******************************************************************************/
bool BTM_IsDeviceUp(void) { return controller_get_interface()->get_is_ready(); }

/*******************************************************************************
 *
 * Function         BTM_SetWifiState
 *
 * Description      This function set wifi state.
 *
 * Returns          void
 *
 ******************************************************************************/
void BTM_SetWifiState(bool status) {
  btm_cb.is_wifi_connected = status;
  BTM_TRACE_WARNING ("btm_cb.is_wifi_connected = %d ", btm_cb.is_wifi_connected);
}

/*******************************************************************************
 *
 * Function         BTM_GetWifiState
 *
 * Description      This function returns wifi connected status.
 *
 * Returns          wifi connected status
 *
 ******************************************************************************/
bool BTM_GetWifiState(void) {
  return btm_cb.is_wifi_connected;
}

/*******************************************************************************
 *
 * Function         BTM_SetPowerBackOffState
 *
 * Description      This function set PowerBackOff state.
 *
 * Returns          void
 *
 ******************************************************************************/
void BTM_SetPowerBackOffState(bool status) {
  btm_cb.is_power_backoff = status;
  BTM_TRACE_WARNING ("btm_cb.is_power_backoff = %d ", btm_cb.is_power_backoff);
}

/*******************************************************************************
 *
 * Function         BTM_GetPowerBackOffState
 *
 * Description      This function returns PowerBackOffState status.
 *
 * Returns          PowerBackOffState status
 *
 ******************************************************************************/
bool BTM_GetPowerBackOffState(void) {
  return btm_cb.is_power_backoff;
}

/*******************************************************************************
**
 * Function         btm_read_local_name_timeout
 *
 * Description      Callback when reading the local name times out.
 *
 * Returns          void
 *
 ******************************************************************************/
void btm_read_local_name_timeout(UNUSED_ATTR void* data) {
  tBTM_CMPL_CB* p_cb = btm_cb.devcb.p_rln_cmpl_cb;
  btm_cb.devcb.p_rln_cmpl_cb = NULL;
  if (p_cb) (*p_cb)((void*)NULL);
}

/*******************************************************************************
 *
 * Function         btm_decode_ext_features_page
 *
 * Description      This function is decodes a features page.
 *
 * Returns          void
 *
 ******************************************************************************/
static void btm_decode_ext_features_page(uint8_t page_number,
                                         const uint8_t* p_features) {
  BTM_TRACE_DEBUG("btm_decode_ext_features_page page: %d", page_number);
  switch (page_number) {
    /* Extended (Legacy) Page 0 */
    case 0:

      /* Create ACL supported packet types mask */
      btm_cb.btm_acl_pkt_types_supported =
          (BTM_ACL_PKT_TYPES_MASK_DH1 + BTM_ACL_PKT_TYPES_MASK_DM1);

      if (HCI_3_SLOT_PACKETS_SUPPORTED(p_features))
        btm_cb.btm_acl_pkt_types_supported |=
            (BTM_ACL_PKT_TYPES_MASK_DH3 + BTM_ACL_PKT_TYPES_MASK_DM3);

      if (HCI_5_SLOT_PACKETS_SUPPORTED(p_features))
        btm_cb.btm_acl_pkt_types_supported |=
            (BTM_ACL_PKT_TYPES_MASK_DH5 + BTM_ACL_PKT_TYPES_MASK_DM5);

      /* Add in EDR related ACL types */
      if (!HCI_EDR_ACL_2MPS_SUPPORTED(p_features)) {
        btm_cb.btm_acl_pkt_types_supported |=
            (BTM_ACL_PKT_TYPES_MASK_NO_2_DH1 + BTM_ACL_PKT_TYPES_MASK_NO_2_DH3 +
             BTM_ACL_PKT_TYPES_MASK_NO_2_DH5);
      }

      if (!HCI_EDR_ACL_3MPS_SUPPORTED(p_features)) {
        btm_cb.btm_acl_pkt_types_supported |=
            (BTM_ACL_PKT_TYPES_MASK_NO_3_DH1 + BTM_ACL_PKT_TYPES_MASK_NO_3_DH3 +
             BTM_ACL_PKT_TYPES_MASK_NO_3_DH5);
      }

      /* Check to see if 3 and 5 slot packets are available */
      if (HCI_EDR_ACL_2MPS_SUPPORTED(p_features) ||
          HCI_EDR_ACL_3MPS_SUPPORTED(p_features)) {
        if (!HCI_3_SLOT_EDR_ACL_SUPPORTED(p_features))
          btm_cb.btm_acl_pkt_types_supported |=
              (BTM_ACL_PKT_TYPES_MASK_NO_2_DH3 +
               BTM_ACL_PKT_TYPES_MASK_NO_3_DH3);

        if (!HCI_5_SLOT_EDR_ACL_SUPPORTED(p_features))
          btm_cb.btm_acl_pkt_types_supported |=
              (BTM_ACL_PKT_TYPES_MASK_NO_2_DH5 +
               BTM_ACL_PKT_TYPES_MASK_NO_3_DH5);
      }

      BTM_TRACE_DEBUG("Local supported ACL packet types: 0x%04x",
                      btm_cb.btm_acl_pkt_types_supported);

      /* Create (e)SCO supported packet types mask */
      btm_cb.btm_sco_pkt_types_supported = 0;
#if (BTM_SCO_INCLUDED == TRUE)
      btm_cb.sco_cb.esco_supported = false;
#endif
      if (HCI_SCO_LINK_SUPPORTED(p_features)) {
        btm_cb.btm_sco_pkt_types_supported = ESCO_PKT_TYPES_MASK_HV1;

        if (HCI_HV2_PACKETS_SUPPORTED(p_features))
          btm_cb.btm_sco_pkt_types_supported |= ESCO_PKT_TYPES_MASK_HV2;

        if (HCI_HV3_PACKETS_SUPPORTED(p_features))
          btm_cb.btm_sco_pkt_types_supported |= ESCO_PKT_TYPES_MASK_HV3;
      }

      if (HCI_ESCO_EV3_SUPPORTED(p_features))
        btm_cb.btm_sco_pkt_types_supported |= ESCO_PKT_TYPES_MASK_EV3;

      if (HCI_ESCO_EV4_SUPPORTED(p_features))
        btm_cb.btm_sco_pkt_types_supported |= ESCO_PKT_TYPES_MASK_EV4;

      if (HCI_ESCO_EV5_SUPPORTED(p_features))
        btm_cb.btm_sco_pkt_types_supported |= ESCO_PKT_TYPES_MASK_EV5;
      if (btm_cb.btm_sco_pkt_types_supported & BTM_ESCO_LINK_ONLY_MASK) {
        btm_cb.sco_cb.esco_supported = true;

        /* Add in EDR related eSCO types */
        if (HCI_EDR_ESCO_2MPS_SUPPORTED(p_features)) {
          if (!HCI_3_SLOT_EDR_ESCO_SUPPORTED(p_features))
            btm_cb.btm_sco_pkt_types_supported |= ESCO_PKT_TYPES_MASK_NO_2_EV5;
        } else {
          btm_cb.btm_sco_pkt_types_supported |=
              (ESCO_PKT_TYPES_MASK_NO_2_EV3 + ESCO_PKT_TYPES_MASK_NO_2_EV5);
        }

        if (HCI_EDR_ESCO_3MPS_SUPPORTED(p_features)) {
          if (!HCI_3_SLOT_EDR_ESCO_SUPPORTED(p_features))
            btm_cb.btm_sco_pkt_types_supported |= ESCO_PKT_TYPES_MASK_NO_3_EV5;
        } else {
          btm_cb.btm_sco_pkt_types_supported |=
              (ESCO_PKT_TYPES_MASK_NO_3_EV3 + ESCO_PKT_TYPES_MASK_NO_3_EV5);
        }
      }

      BTM_TRACE_DEBUG("Local supported SCO packet types: 0x%04x",
                      btm_cb.btm_sco_pkt_types_supported);

      /* Create Default Policy Settings */
      if (HCI_SWITCH_SUPPORTED(p_features))
        btm_cb.btm_def_link_policy |= HCI_ENABLE_MASTER_SLAVE_SWITCH;
      else
        btm_cb.btm_def_link_policy &= ~HCI_ENABLE_MASTER_SLAVE_SWITCH;

      if (HCI_HOLD_MODE_SUPPORTED(p_features))
        btm_cb.btm_def_link_policy |= HCI_ENABLE_HOLD_MODE;
      else
        btm_cb.btm_def_link_policy &= ~HCI_ENABLE_HOLD_MODE;

      if (HCI_SNIFF_MODE_SUPPORTED(p_features))
        btm_cb.btm_def_link_policy |= HCI_ENABLE_SNIFF_MODE;
      else
        btm_cb.btm_def_link_policy &= ~HCI_ENABLE_SNIFF_MODE;

      if (HCI_PARK_MODE_SUPPORTED(p_features))
        btm_cb.btm_def_link_policy |= HCI_ENABLE_PARK_MODE;
      else
        btm_cb.btm_def_link_policy &= ~HCI_ENABLE_PARK_MODE;

      btm_sec_dev_reset();

      if (HCI_LMP_INQ_RSSI_SUPPORTED(p_features)) {
        if (HCI_EXT_INQ_RSP_SUPPORTED(p_features))
          BTM_SetInquiryMode(BTM_INQ_RESULT_EXTENDED);
        else
          BTM_SetInquiryMode(BTM_INQ_RESULT_WITH_RSSI);
      }

#if (L2CAP_NON_FLUSHABLE_PB_INCLUDED == TRUE)
      if (HCI_NON_FLUSHABLE_PB_SUPPORTED(p_features))
        l2cu_set_non_flushable_pbf(true);
      else
        l2cu_set_non_flushable_pbf(false);
#endif
      BTM_SetPageScanType(BTM_DEFAULT_SCAN_TYPE);
      BTM_SetInquiryScanType(BTM_DEFAULT_SCAN_TYPE);

      break;

    default:
      BTM_TRACE_WARNING("%s: feature page %d ignored", __func__, page_number);
      break;
  }
}

/*******************************************************************************
 *
 * Function         BTM_SetLocalDeviceName
 *
 * Description      This function is called to set the local device name.
 *
 * Returns          status of the operation
 *
 ******************************************************************************/
tBTM_STATUS BTM_SetLocalDeviceName(char* p_name) {
  uint8_t* p;

  if (!p_name || !p_name[0] || (strlen((char*)p_name) > BD_NAME_LEN))
    return (BTM_ILLEGAL_VALUE);

  if (!controller_get_interface()->get_is_ready()) return (BTM_DEV_RESET);
  /* Save the device name if local storage is enabled */
  p = (uint8_t*)btm_cb.cfg.bd_name;
  if (p != (uint8_t*)p_name)
    strlcpy(btm_cb.cfg.bd_name, p_name, BTM_MAX_LOC_BD_NAME_LEN+1);

  btsnd_hcic_change_name(p);
  return (BTM_CMD_STARTED);
}

/*******************************************************************************
 *
 * Function         BTM_ReadLocalDeviceName
 *
 * Description      This function is called to read the local device name.
 *
 * Returns          status of the operation
 *                  If success, BTM_SUCCESS is returned and p_name points stored
 *                              local device name
 *                  If BTM doesn't store local device name, BTM_NO_RESOURCES is
 *                              is returned and p_name is set to NULL
 *
 ******************************************************************************/
tBTM_STATUS BTM_ReadLocalDeviceName(char** p_name) {
  *p_name = btm_cb.cfg.bd_name;
  return (BTM_SUCCESS);
}

/*******************************************************************************
 *
 * Function         BTM_ReadLocalDeviceNameFromController
 *
 * Description      Get local device name from controller. Do not use cached
 *                  name (used to get chip-id prior to btm reset complete).
 *
 * Returns          BTM_CMD_STARTED if successful, otherwise an error
 *
 ******************************************************************************/
tBTM_STATUS BTM_ReadLocalDeviceNameFromController(
    tBTM_CMPL_CB* p_rln_cmpl_cback) {
  /* Check if rln already in progress */
  if (btm_cb.devcb.p_rln_cmpl_cb) return (BTM_NO_RESOURCES);

  /* Save callback */
  btm_cb.devcb.p_rln_cmpl_cb = p_rln_cmpl_cback;

  btsnd_hcic_read_name();
  alarm_set_on_mloop(btm_cb.devcb.read_local_name_timer,
                     BTM_DEV_NAME_REPLY_TIMEOUT_MS, btm_read_local_name_timeout,
                     NULL);

  return BTM_CMD_STARTED;
}

/*******************************************************************************
 *
 * Function         btm_read_local_name_complete
 *
 * Description      This function is called when local name read complete.
 *                  message is received from the HCI.
 *
 * Returns          void
 *
 ******************************************************************************/
void btm_read_local_name_complete(uint8_t* p, UNUSED_ATTR uint16_t evt_len) {
  tBTM_CMPL_CB* p_cb = btm_cb.devcb.p_rln_cmpl_cb;
  uint8_t status;

  alarm_cancel(btm_cb.devcb.read_local_name_timer);

  /* If there was a callback address for read local name, call it */
  btm_cb.devcb.p_rln_cmpl_cb = NULL;

  if (p_cb) {
    STREAM_TO_UINT8(status, p);

    if (status == HCI_SUCCESS)
      (*p_cb)(p);
    else
      (*p_cb)(NULL);
  }
}

/*******************************************************************************
 *
 * Function         BTM_SetDeviceClass
 *
 * Description      This function is called to set the local device class
 *
 * Returns          status of the operation
 *
 ******************************************************************************/
tBTM_STATUS BTM_SetDeviceClass(DEV_CLASS dev_class) {
  if (!memcmp(btm_cb.devcb.dev_class, dev_class, DEV_CLASS_LEN))
    return (BTM_SUCCESS);

  memcpy(btm_cb.devcb.dev_class, dev_class, DEV_CLASS_LEN);

  if (!controller_get_interface()->get_is_ready()) return (BTM_DEV_RESET);

  btsnd_hcic_write_dev_class(dev_class);

  return (BTM_SUCCESS);
}

/*******************************************************************************
 *
 * Function         BTM_ReadDeviceClass
 *
 * Description      This function is called to read the local device class
 *
 * Returns          pointer to the device class
 *
 ******************************************************************************/
uint8_t* BTM_ReadDeviceClass(void) {
  return ((uint8_t*)btm_cb.devcb.dev_class);
}

/*******************************************************************************
 *
 * Function         BTM_ReadLocalFeatures
 *
 * Description      This function is called to read the local features
 *
 * Returns          pointer to the local features string
 *
 ******************************************************************************/
// TODO(zachoverflow): get rid of this function
uint8_t* BTM_ReadLocalFeatures(void) {
  // Discarding const modifier for now, until this function dies
  return (uint8_t*)controller_get_interface()
      ->get_features_classic(0)
      ->as_array;
}

/*******************************************************************************
 *
 * Function         BTM_RegisterForDeviceStatusNotif
 *
 * Description      This function is called to register for device status
 *                  change notifications.
 *
 *                  If one registration is already there calling function should
 *                  save the pointer to the function that is return and
 *                  call it when processing of the event is complete
 *
 * Returns          status of the operation
 *
 ******************************************************************************/
tBTM_DEV_STATUS_CB* BTM_RegisterForDeviceStatusNotif(tBTM_DEV_STATUS_CB* p_cb) {
  tBTM_DEV_STATUS_CB* p_prev = btm_cb.devcb.p_dev_status_cb;

  btm_cb.devcb.p_dev_status_cb = p_cb;
  return (p_prev);
}


/*******************************************************************************
**
** Function         BTM_Hci_Raw_Command
**
** Description      Send  HCI raw command to the controller.
**
** Returns
**      BTM_SUCCESS         Command sent. Does not expect command complete
**                              event. (command cmpl callback param is NULL)
**      BTM_CMD_STARTED     Command sent. Waiting for command cmpl event.
**
**
*******************************************************************************/
tBTM_STATUS BTM_Hci_Raw_Command(uint16_t opcode, uint8_t param_len,
                              uint8_t *p_param_buf, tBTM_RAW_CMPL_CB *p_cb)
{
  void *p_buf;
#if HCI_RAW_CMD_INCLUDED == TRUE
  tBTM_DEVCB  *p_devcb = &btm_cb.devcb;
#endif

BTM_TRACE_EVENT ("BTM: BTM_Hci_Raw_Command: Opcode: 0x%04X, ParamLen: %i.",
                   opcode, param_len);

  /* Allocate a buffer to hold HCI command plus the callback function */
  p_buf = osi_malloc((uint16_t)(sizeof(BT_HDR) + sizeof (tBTM_CMPL_CB *) +
                          param_len + HCIC_PREAMBLE_SIZE));
  if (p_buf != NULL) {
    btsnd_hcic_raw_cmd (p_buf, opcode, param_len, p_param_buf, (void *)p_cb);

    /* Return value */
#if HCI_RAW_CMD_INCLUDED == TRUE
    if (p_cb != NULL) {
      if(p_cb != (p_devcb->p_hci_evt_cb)) {
        p_devcb->p_hci_evt_cb = p_cb;
      }
            return BTM_CMD_STARTED;
    }
#else
    if (p_cb != NULL)
      return BTM_CMD_STARTED;
#endif
    else
      return BTM_SUCCESS;
  }
  else
    return BTM_NO_RESOURCES;

}
/*******************************************************************************
 *
 * Function         BTM_VendorSpecificCommand
 *
 * Description      Send a vendor specific HCI command to the controller.
 *
 * Notes
 *      Opcode will be OR'd with HCI_GRP_VENDOR_SPECIFIC.
 *
 ******************************************************************************/
void BTM_VendorSpecificCommand(uint16_t opcode, uint8_t param_len,
                               uint8_t* p_param_buf, tBTM_VSC_CMPL_CB* p_cb) {
  /* Allocate a buffer to hold HCI command plus the callback function */
  void* p_buf = osi_malloc(sizeof(BT_HDR) + sizeof(tBTM_CMPL_CB*) + param_len +
                           HCIC_PREAMBLE_SIZE);

  BTM_TRACE_EVENT("BTM: %s: Opcode: 0x%04X, ParamLen: %i.", __func__, opcode,
                  param_len);

  /* Send the HCI command (opcode will be OR'd with HCI_GRP_VENDOR_SPECIFIC) */
  btsnd_hcic_vendor_spec_cmd(p_buf, opcode, param_len, p_param_buf,
                             (void*)p_cb);
}

#if HCI_RAW_CMD_INCLUDED == TRUE
/*******************************************************************************
**
** Function         btm_hci_event
**
** Description      This function is called when HCI event is received
**                  from the HCI layer.
**
** Returns          void
**
*******************************************************************************/
void btm_hci_event(uint8_t *p, uint8_t event_code, uint8_t param_len)
{
  tBTM_DEVCB     *p_devcb = &btm_cb.devcb;
  tBTM_RAW_CMPL  raw_cplt_params;

  /* If there was a callback address for raw cmd complete, call it */
  if (p_devcb->p_hci_evt_cb) {
    /* Pass paramters to the callback function */
    raw_cplt_params.event_code = event_code;   /* Number of bytes in return info */
    raw_cplt_params.param_len = param_len;    /* Number of bytes in return info */
    raw_cplt_params.p_param_buf = p;
    (p_devcb->p_hci_evt_cb) (&raw_cplt_params);  /* Call the cmd complete callback function */
  }
}
#endif
/*******************************************************************************
 *
 * Function         btm_vsc_complete
 *
 * Description      This function is called when local HCI Vendor Specific
 *                  Command complete message is received from the HCI.
 *
 * Returns          void
 *
 ******************************************************************************/
void btm_vsc_complete(uint8_t* p, uint16_t opcode, uint16_t evt_len,
                      tBTM_VSC_CMPL_CB* p_vsc_cplt_cback) {
  tBTM_VSC_CMPL vcs_cplt_params;

  /* If there was a callback address for vcs complete, call it */
  if (p_vsc_cplt_cback) {
    /* Pass paramters to the callback function */
    vcs_cplt_params.opcode = opcode;     /* Number of bytes in return info */
    vcs_cplt_params.param_len = evt_len; /* Number of bytes in return info */
    vcs_cplt_params.p_param_buf = p;
    (*p_vsc_cplt_cback)(
        &vcs_cplt_params); /* Call the VSC complete callback function */
  }
}

/*******************************************************************************
 *
 * Function         BTM_RegisterForVSEvents
 *
 * Description      This function is called to register/deregister for vendor
 *                  specific HCI events.
 *
 *                  If is_register=true, then the function will be registered;
 *                  otherwise, the the function will be deregistered.
 *
 * Returns          BTM_SUCCESS if successful,
 *                  BTM_BUSY if maximum number of callbacks have already been
 *                           registered.
 *
 ******************************************************************************/
tBTM_STATUS BTM_RegisterForVSEvents(tBTM_VS_EVT_CB* p_cb, bool is_register) {
  tBTM_STATUS retval = BTM_SUCCESS;
  uint8_t i, free_idx = BTM_MAX_VSE_CALLBACKS;

  /* See if callback is already registered */
  for (i = 0; i < BTM_MAX_VSE_CALLBACKS; i++) {
    if (btm_cb.devcb.p_vend_spec_cb[i] == NULL) {
      /* Found a free slot. Store index */
      free_idx = i;
    } else if (btm_cb.devcb.p_vend_spec_cb[i] == p_cb) {
      /* Found callback in lookup table. If deregistering, clear the entry. */
      if (is_register == false) {
        btm_cb.devcb.p_vend_spec_cb[i] = NULL;
        BTM_TRACE_EVENT("BTM Deregister For VSEvents is successfully");
      }
      return (BTM_SUCCESS);
    }
  }

  /* Didn't find callback. Add callback to free slot if registering */
  if (is_register) {
    if (free_idx < BTM_MAX_VSE_CALLBACKS) {
      btm_cb.devcb.p_vend_spec_cb[free_idx] = p_cb;
      BTM_TRACE_EVENT("BTM Register For VSEvents is successfully");
    } else {
      /* No free entries available */
      BTM_TRACE_ERROR("BTM_RegisterForVSEvents: too many callbacks registered");

      retval = BTM_NO_RESOURCES;
    }
  }

  return (retval);
}

/*******************************************************************************
**
** Function         btm_register_qle_cig_latency_change_cback
**
** Description      Register callback to process qle_cig_latency_changed event
**
** Returns          void
**
*******************************************************************************/
void btm_register_qle_cig_latency_changed_cback (tBTM_VS_EVT_CB *p_cb) {
    btm_cb.devcb.p_vnd_qle_cig_latency_changed_cb = p_cb;
}

/*******************************************************************************
**
** Function         btm_register_iot_info_cback
**
** Description      Register callback to process iot info report
**
** Returns          void
**
*******************************************************************************/
void btm_register_iot_info_cback (tBTM_VS_EVT_CB *p_cb) {
    btm_cb.devcb.p_vnd_iot_info_cb = p_cb;
}

/*******************************************************************************
**
** Function         btm_register_ssr_cback
**
** Description      Register callback to process SSR
**
** Returns          void
**
*******************************************************************************/
void btm_register_ssr_cback (tBTM_NOTIFY_SSR_CB *p_cb) {
    btm_cb.devcb.p_ssr_cb = p_cb;
}
/*******************************************************************************
 *
 * Function         btm_vendor_specific_evt
 *
 * Description      Process event HCI_VENDOR_SPECIFIC_EVT
 *
 *                  Note: Some controllers do not send command complete, so
 *                  the callback and busy flag are cleared here also.
 *
 * Returns          void
 *
 ******************************************************************************/
void btm_vendor_specific_evt(uint8_t* p, uint8_t evt_len) {
  uint8_t i;
  uint8_t *pp = p;
  uint8_t vse_subcode;

  if (evt_len >= 2) {
    STREAM_TO_UINT8 (vse_subcode, pp);

    if(HCI_VSE_INFO_REPORT == vse_subcode) {
      BTM_TRACE_DEBUG ("BTM Event: Vendor Specific iot info report event");
      if (btm_cb.devcb.p_vnd_iot_info_cb) {
        BTM_TRACE_DEBUG ("Calling bta_dm_vnd_info_report_cback");
        (*btm_cb.devcb.p_vnd_iot_info_cb)(evt_len, pp);
        return;
      }
    } else if (HCI_BT_SOC_CRASHED_OGF == vse_subcode) {
        STREAM_TO_UINT8 (vse_subcode, pp);
        if (HCI_BT_SOC_CRASHED_OCF == vse_subcode) {
          decode_crash_reason(pp, (evt_len - 2));
          return;
        }
    } else if (HCI_VSE_SUBCODE_QBCE == vse_subcode) {
      uint8_t vse_msg_type;

      STREAM_TO_UINT8(vse_msg_type, pp);
      BTM_TRACE_DEBUG("%s: QBCE VSE event received, msg = %x", __func__,
                       vse_msg_type);
      switch(vse_msg_type) {
        case MSG_QBCE_QLL_CONNECTION_COMPLETE:
          btm_ble_qll_connection_complete(pp);
          break;
        case MSG_QBCE_REMOTE_SUPPORTED_QLL_FEATURES_COMPLETE:
          btm_ble_read_remote_supported_qll_features_complete(pp);
          break;
        case MSG_QBCE_QCM_PHY_CHANGE:
          btm_acl_update_qcm_phy_state(pp);
          break;
        case MSG_QBCE_QLE_CIG_LATENCY_CHANGED:
          if (btm_cb.devcb.p_vnd_qle_cig_latency_changed_cb) {
            BTM_TRACE_DEBUG ("Calling qle_cig_latency_changed_cb");
            (*btm_cb.devcb.p_vnd_qle_cig_latency_changed_cb)((evt_len - 2), pp);
            return;
          }
          break;
        default:
          BTM_TRACE_ERROR("%s: unknown msg type: %d", __func__, vse_msg_type);
          break;
      }
      return;
    }
  }

  BTM_TRACE_DEBUG("BTM Event: Vendor Specific event from controller");

  for (i = 0; i < BTM_MAX_VSE_CALLBACKS; i++) {
    if (btm_cb.devcb.p_vend_spec_cb[i])
      (*btm_cb.devcb.p_vend_spec_cb[i])(evt_len, p);
  }
}

char *get_primary_reason_str(host_crash_reason_e reason)
{
  int i = 0;
  for(; i < (int)(sizeof(primary_crash_reason)/sizeof(primary_reason)); i++) {
    if (primary_crash_reason[i].reason == reason)
      return primary_crash_reason[i].reasonstr;
  }
  return NULL;
}

char *get_secondary_reason_str(soc_crash_reason_e reason)
{
  int i = 0;
  for(; i < (int)(sizeof(secondary_crash_reason)/sizeof(secondary_reason)); i++) {
    if (secondary_crash_reason[i].reason == reason)
      return secondary_crash_reason[i].reasonstr;
  }
  return NULL;
}

void decode_crash_reason(uint8_t* p, uint8_t evt_len)
{
  uint16_t primary_reason;
  uint16_t secondary_reason;
  uint8_t pp[HCI_CRASH_MESSAGE_SIZE];

  BTM_TRACE_ERROR("BTM Event: Vendor Specific crash event from controller");

  /* Crash reason frame formnat
   * Primary crash reason (2 bytes) | Secondary crash reason (2 bytes) | time stamp
   */
  STREAM_TO_UINT16(primary_reason, p);
  STREAM_TO_UINT16(secondary_reason, p);

  evt_len = evt_len - 4;
  memcpy(pp, p, evt_len);
  pp[evt_len] = '\0';
  BTM_TRACE_ERROR("%s: PrimaryCrashReason:%s", __func__,
                  get_primary_reason_str((host_crash_reason_e)primary_reason));
  BTM_TRACE_ERROR("%s: SecondaryCrashReason:%s at time %s", __func__,
                  get_secondary_reason_str((soc_crash_reason_e)secondary_reason),
                  (char *)pp);
}

/*******************************************************************************
**
** Function         btm_enable_soc_iot_info_report
**
** Description      enable/disable bt soc iot info report.
**
** Returns          void
**
*******************************************************************************/
void btm_enable_soc_iot_info_report(bool enable) {
  uint8_t param[40] = {0};
  uint8_t sub_opcode = 0x15;
  uint32_t event_mask = 0;
  uint8_t *p_param = param;

  BTM_TRACE_WARNING("%s, enable=%d", __func__, enable);

  if (enable) {
    event_mask = 1 << SOC_ERROR_AUDIO_GLITCH | 1 << SOC_ERROR_SCO_MISSES |
                 1 << SOC_ERROR_LSTO | 1 << SOC_ERROR_CONN_FAIL;
  }

  UINT8_TO_STREAM(p_param, sub_opcode);
  UINT32_TO_STREAM(p_param, event_mask);

  if (enable) {
    // A2dp glitch ID = 3
    UINT8_TO_STREAM(p_param, 3);
    // A2dp glitch config data length
    UINT8_TO_STREAM(p_param, 4);
    // A2dp glitch report interval
    UINT16_TO_STREAM(p_param, A2DP_GLITCH_REPORT_INTERVAL_MS);
    // A2dp glitch threshold
    UINT16_TO_STREAM(p_param, A2DP_GLITCH_THRESHOLD);

    // Sco glitch ID = 4
    UINT8_TO_STREAM(p_param, 4);
    // Sco glitch config data length
    UINT8_TO_STREAM(p_param, 4);
    // Sco glitch report interval
    UINT16_TO_STREAM(p_param, SCO_GLITCH_REPORT_INTERVAL_MS);
    // Sco glitch threshold
    UINT16_TO_STREAM(p_param, SCO_GLITCH_THRESHOLD);
  }

  BTM_VendorSpecificCommand(HCI_VS_HOST_LOG_OPCODE, p_param - param, param, NULL);
}

/*******************************************************************************
 **
 ** Function       btm_enable_link_lpa_enh_pwr_ctrl_cmpl
 **
 ** Description    btm_enable_link_lpa_enh_pwr_ctrl VSC complete event handler
 **
 ** Returns        void
 **
 ******************************************************************************/
static void btm_enable_link_lpa_enh_pwr_ctrl_cmpl(tBTM_VSC_CMPL *param)
{
  uint8_t *p = param->p_param_buf, status;
  uint16_t evt_len = param->param_len;

  /* Check status of command complete event */
  CHECK(evt_len > 0);
  status = *p;

  if (evt_len == HCI_VS_ENABLE_LPA_CONTROL_RES_PARAM_LEN) {
    BTM_TRACE_DEBUG("%s: opcode:%x, subopcode:%x, status:%d, handle: %04x", __func__,
            param->opcode, *(p+1), *p, *(uint16_t *)(p+2));
  } else {
    BTM_TRACE_DEBUG("%s: opcode:%x, status:%d", __func__, param->opcode, status);
    if (status == HCI_ERR_ILLEGAL_COMMAND) {
      BTM_TRACE_DEBUG("controller not support the feature");
    }
  }
}

/*******************************************************************************
 **
 ** Function        btm_enable_link_lpa_enh_pwr_ctrl
 **
 ** Description     enable/disable lpa enhanced power control
 **                 on completion btm_enable_link_lpa_enh_pwr_ctrl_cmpl callback
 **                 would be called
 **
 ** Returns         void
 **
 ******************************************************************************/
void btm_enable_link_lpa_enh_pwr_ctrl(uint16_t hci_handle, bool enable)
{
  uint8_t param[4] = {0};
  uint8_t *p_param = param;

  BTM_TRACE_DEBUG("%s, hci_handle=%d, enable=%d", __func__, hci_handle, enable);

  UINT8_TO_STREAM(p_param, HCI_VS_ENABLE_LPA_CONTROL_FOR_CONN_HANDLE);
  UINT16_TO_STREAM(p_param, hci_handle);
  UINT8_TO_STREAM(p_param, enable ? 1 : 0);

  BTM_VendorSpecificCommand(HCI_VS_LINK_POWER_CTRL_REQ_OPCODE,
      (p_param - param), param, btm_enable_link_lpa_enh_pwr_ctrl_cmpl);
}

/*******************************************************************************
 *
 * Function         BTM_WritePageTimeout
 *
 * Description      Send HCI Write Page Timeout.
 *
 ******************************************************************************/
void BTM_WritePageTimeout(uint16_t timeout) {
  BTM_TRACE_EVENT("BTM: BTM_WritePageTimeout: Timeout: %d.", timeout);

  /* Send the HCI command */
  btsnd_hcic_write_page_tout(timeout);
}

/*******************************************************************************
 *
 * Function         BTM_WriteVoiceSettings
 *
 * Description      Send HCI Write Voice Settings command.
 *                  See hcidefs.h for settings bitmask values.
 *
 ******************************************************************************/
void BTM_WriteVoiceSettings(uint16_t settings) {
  BTM_TRACE_EVENT("BTM: BTM_WriteVoiceSettings: Settings: 0x%04x.", settings);

  /* Send the HCI command */
  btsnd_hcic_write_voice_settings((uint16_t)(settings & 0x03ff));
}

/*******************************************************************************
 *
 * Function         BTM_EnableTestMode
 *
 * Description      Send HCI the enable device under test command.
 *
 *                  Note: Controller can only be taken out of this mode by
 *                      resetting the controller.
 *
 * Returns
 *      BTM_SUCCESS         Command sent.
 *      BTM_NO_RESOURCES    If out of resources to send the command.
 *
 *
 ******************************************************************************/
tBTM_STATUS BTM_EnableTestMode(void) {
  uint8_t cond;

  BTM_TRACE_EVENT("BTM: BTM_EnableTestMode");

  /* set auto accept connection as this is needed during test mode */
  /* Allocate a buffer to hold HCI command */
  cond = HCI_DO_AUTO_ACCEPT_CONNECT;
  btsnd_hcic_set_event_filter(HCI_FILTER_CONNECTION_SETUP,
                              HCI_FILTER_COND_NEW_DEVICE, &cond, sizeof(cond));

  /* put device to connectable mode */
  if (BTM_SetConnectability(BTM_CONNECTABLE, BTM_DEFAULT_CONN_WINDOW,
                            BTM_DEFAULT_CONN_INTERVAL) != BTM_SUCCESS) {
    return BTM_NO_RESOURCES;
  }

  /* put device to discoverable mode */
  if (BTM_SetDiscoverability(BTM_GENERAL_DISCOVERABLE, BTM_DEFAULT_DISC_WINDOW,
                             BTM_DEFAULT_DISC_INTERVAL) != BTM_SUCCESS) {
    return BTM_NO_RESOURCES;
  }

  /* mask off all of event from controller */
  hci_layer_get_interface()->transmit_command(
      hci_packet_factory_get_interface()->make_set_event_mask(
          (const bt_event_mask_t*)("\x00\x00\x00\x00\x00\x00\x00\x00")),
      NULL, NULL, NULL);

  /* Send the HCI command */
  btsnd_hcic_enable_test_mode();
  return (BTM_SUCCESS);
}

/*******************************************************************************
 *
 * Function         BTM_DeleteStoredLinkKey
 *
 * Description      This function is called to delete link key for the specified
 *                  device addresses from the NVRAM storage attached to the
 *                  Bluetooth controller.
 *
 * Parameters:      bd_addr      - Addresses of the devices
 *                  p_cb         - Call back function to be called to return
 *                                 the results
 *
 ******************************************************************************/
tBTM_STATUS BTM_DeleteStoredLinkKey(const RawAddress* bd_addr,
                                    tBTM_CMPL_CB* p_cb) {
  /* Check if the previous command is completed */
  if (btm_cb.devcb.p_stored_link_key_cmpl_cb) return (BTM_BUSY);

  bool delete_all_flag = !bd_addr;

  BTM_TRACE_EVENT("BTM: BTM_DeleteStoredLinkKey: delete_all_flag: %s",
                  delete_all_flag ? "true" : "false");

  btm_cb.devcb.p_stored_link_key_cmpl_cb = p_cb;
  if (!bd_addr) {
    /* This is to delete all link keys */
    /* We don't care the BD address. Just pass a non zero pointer */
    RawAddress local_bd_addr = RawAddress::kEmpty;
    btsnd_hcic_delete_stored_key(local_bd_addr, delete_all_flag);
  } else {
    btsnd_hcic_delete_stored_key(*bd_addr, delete_all_flag);
  }

  return (BTM_SUCCESS);
}

/*******************************************************************************
 *
 * Function         btm_delete_stored_link_key_complete
 *
 * Description      This function is called when the command complete message
 *                  is received from the HCI for the delete stored link key
 *                  command.
 *
 * Returns          void
 *
 ******************************************************************************/
void btm_delete_stored_link_key_complete(uint8_t* p) {
  tBTM_CMPL_CB* p_cb = btm_cb.devcb.p_stored_link_key_cmpl_cb;
  tBTM_DELETE_STORED_LINK_KEY_COMPLETE result;

  /* If there was a callback registered for read stored link key, call it */
  btm_cb.devcb.p_stored_link_key_cmpl_cb = NULL;

  if (p_cb) {
    /* Set the call back event to indicate command complete */
    result.event = BTM_CB_EVT_DELETE_STORED_LINK_KEYS;

    /* Extract the result fields from the HCI event */
    STREAM_TO_UINT8(result.status, p);
    STREAM_TO_UINT16(result.num_keys, p);

    /* Call the call back and pass the result */
    (*p_cb)(&result);
  }
}

/*******************************************************************************
 *
 * Function         btm_report_device_status
 *
 * Description      This function is called when there is a change in the device
 *                  status. This function will report the new device status to
 *                  the application
 *
 * Returns          void
 *
 ******************************************************************************/
void btm_report_device_status(tBTM_DEV_STATUS status) {
  tBTM_DEV_STATUS_CB* p_cb = btm_cb.devcb.p_dev_status_cb;

  /* Call the call back to pass the device status to application */
  if (p_cb) (*p_cb)(status);
}

/*******************************************************************************
 *
 * Function         btm_notify_ssr_trigger
 *
 * Description      This function is called when SSR triggered to notify
 *                  the application to handle SSR
 *
 * Returns          void
 *
 ******************************************************************************/
void btm_notify_ssr_trigger(void) {
  if (btm_cb.devcb.p_ssr_cb) {
    BTM_TRACE_DEBUG ("Calling bta_dm_process_ssr");
    (*btm_cb.devcb.p_ssr_cb)();
    return;
  }
}

/*******************************************************************************
 * Function         BTM_BT_Quality_Report_VSE_CBack
 *
 * Description      Callback invoked on receiving of Vendor Specific Events.
 *                  This function will call registered BQR report receiver if
 *                  Bluetooth Quality Report sub-event is identified.
 *
 * Parameters:      length - Lengths of all of the parameters contained in the
 *                    Vendor Specific Event.
 *                  p_stream - A pointer to the quality report which is sent
 *                    from the Bluetooth controller via Vendor Specific Event.
 *
 ******************************************************************************/
static void BTM_BT_Quality_Report_VSE_CBack(uint8_t length, uint8_t* p_stream) {
  if (length == 0) {
    LOG(WARNING) << __func__ << ": Lengths of all of the parameters are zero.";
    return;
  }

  uint8_t sub_event = 0;
  STREAM_TO_UINT8(sub_event, p_stream);
  length--;

  if (sub_event == HCI_VSE_SUBCODE_BQR_SUB_EVT) {
    LOG(INFO) << __func__
              << ": BQR sub event, report length: " << std::to_string(length);

    if (btm_cb.p_bqr_report_receiver == nullptr) {
      LOG(WARNING) << __func__ << ": No registered report receiver.";
      return;
    }

    btm_cb.p_bqr_report_receiver(length, p_stream);
  }
}

/*******************************************************************************
 *
 * Function         BTM_BT_Quality_Report_VSE_Register
 *
 * Description      Register/Deregister for Bluetooth Quality Report VSE sub
 *                  event Callback.
 *
 * Parameters:      is_register - True/False to register/unregister for VSE.
 *                  p_bqr_report_receiver - The receiver for receiving Bluetooth
 *                    Quality Report VSE sub event.
 *
 ******************************************************************************/
tBTM_STATUS BTM_BT_Quality_Report_VSE_Register(
    bool is_register, tBTM_BT_QUALITY_REPORT_RECEIVER* p_bqr_report_receiver) {
  tBTM_STATUS retval =
      BTM_RegisterForVSEvents(BTM_BT_Quality_Report_VSE_CBack, is_register);

  if (retval != BTM_SUCCESS) {
    LOG(WARNING) << __func__ << ": Fail to (un)register VSEvents: " << retval
                 << ", is_register: " << (is_register);
    return retval;
  }

  if (is_register) {
    btm_cb.p_bqr_report_receiver = p_bqr_report_receiver;
  } else {
    btm_cb.p_bqr_report_receiver = nullptr;
  }

  LOG(INFO) << __func__ << ": Success to (un)register VSEvents."
            << " is_register: " << (is_register);
  return retval;
}

/*******************************************************************************
 * Bluetooth Spec 5.2 HCI Commands: Parsing Command Complete Events.
 ******************************************************************************/
void btm_read_controller_delay_cmd_cmpl(uint8_t *param, uint16_t param_len) {
  uint8_t status;
  CONTROLLER_DELAY min_cont_delay = {0};
  CONTROLLER_DELAY max_cont_delay = {0};
  BTM_TRACE_API("%s: param_len = %d", __func__, param_len);

  if (param_len <= 0) {
    BTM_TRACE_WARNING("%s Insufficient return parameters.", __func__);
    return;
  }

  STREAM_TO_UINT8(status, param);
  if (status == HCI_SUCCESS) {
    STREAM_TO_ARRAY(min_cont_delay, param, CONTROLLER_DELAY_LEN);
    STREAM_TO_ARRAY(max_cont_delay, param, CONTROLLER_DELAY_LEN);
  }
  if (btm_cb.devcb.controller_delay_read_cb) {
    (*btm_cb.devcb.controller_delay_read_cb) (status, min_cont_delay, max_cont_delay);
  }

  // clear callback
  btm_cb.devcb.controller_delay_read_cb = NULL;
}

/* TODO: Parsing done through this API has to be tested once valid values in soc are known */
void btm_read_codec_capability_cmd_cmpl(uint8_t *param, uint16_t param_len) {
  tBTM_LOCAL_CAP_RET_PARAM ret_param = {};
  BTM_TRACE_API("%s: param_len = %d", __func__, param_len);

  if (param_len <= 0) {
    BTM_TRACE_WARNING("%s Insufficient return parameters.", __func__);
    return;
  }

  STREAM_TO_UINT8(ret_param.status, param);
  if (ret_param.status == HCI_SUCCESS) {
    STREAM_TO_UINT8(ret_param.num_codec_capabilities, param);

    ret_param.codec_capability_length =
        (uint8_t*)osi_malloc(ret_param.num_codec_capabilities);
    STREAM_TO_ARRAY(ret_param.codec_capability_length, param,
                    ret_param.num_codec_capabilities);

    ret_param.codec_capability =
        (uint8_t **)osi_malloc(ret_param.num_codec_capabilities * sizeof(uint8_t *));
    for (int i = 0; i < ret_param.num_codec_capabilities; i++) {
       ret_param.codec_capability[i] =
          (uint8_t *)malloc(ret_param.codec_capability_length[i] * sizeof(uint8_t));
       STREAM_TO_ARRAY(ret_param.codec_capability[i], param,
                       ret_param.codec_capability_length[i]);
    }

  }
  if (btm_cb.devcb.local_codec_cap_cmpl_cb) {
    (*btm_cb.devcb.local_codec_cap_cmpl_cb) (&ret_param);
  }

  // clear callback
  btm_cb.devcb.local_codec_cap_cmpl_cb = NULL;

  // clear allocated memory
  for (int i = 0; i < ret_param.num_codec_capabilities; i++) {
    osi_free(ret_param.codec_capability[i]);
  }
  osi_free(ret_param.codec_capability);
  osi_free(ret_param.codec_capability_length);
}

void btm_configure_datapath_cmd_cmpl(uint8_t *param, uint16_t param_len) {
  uint8_t status;
  BTM_TRACE_API("%s: param_len = %d", __func__, param_len);

  if (param_len <= 0) {
    BTM_TRACE_WARNING("%s Insufficient return parameters.", __func__);
    return;
  }

  STREAM_TO_UINT8(status, param);
  if (btm_cb.devcb.cfg_datapath_cmpl_cb) {
    (*btm_cb.devcb.cfg_datapath_cmpl_cb) (status);
  }

  // clear callback
  btm_cb.devcb.cfg_datapath_cmpl_cb = NULL;
}

void btm_set_ecosystem_base_interval_cmd_cmpl(uint8_t *param, uint16_t param_len) {
  uint8_t status;
  BTM_TRACE_API("%s: param_len = %d", __func__, param_len);

  if (param_len <= 0) {
    BTM_TRACE_WARNING("%s Insufficient return parameters.", __func__);
    return;
  }

  STREAM_TO_UINT8(status, param);
  if (btm_cb.devcb.set_eco_interval_cmpl_cb) {
    (*btm_cb.devcb.set_eco_interval_cmpl_cb) (status);
  }

  // clear callback
  btm_cb.devcb.set_eco_interval_cmpl_cb = NULL;
}

/*******************************************************************************
 * Bluetooth Spec 5.2 HCI Commands API Implementation
 ******************************************************************************/
void BTM_ReadLocalSupportedControllerDelay(
                                 tBTM_LOCAL_SUP_CONTROLLER_DELAY_PARAM* p_data) {
  BTM_TRACE_API("%s", __func__);

  btm_cb.devcb.controller_delay_read_cb = p_data->p_cb;
  btsnd_hcic_read_local_sup_controller_delay(p_data->codec_id,
                                   p_data->logical_transport_type,
                                   p_data->direction,
                                   p_data->codec_conf_length,
                                   p_data->codec_conf,
                                   base::Bind(&btm_read_controller_delay_cmd_cmpl));
}

void BTM_ReadLocalSupportedCodecCap(tBTM_LOCAL_CODEC_CAP_PARAM* p_data) {
  BTM_TRACE_API("%s", __func__);

  btm_cb.devcb.local_codec_cap_cmpl_cb = p_data->p_cb;
  btsnd_hcic_read_local_sup_codec_cap(p_data->codec_id,
                                      p_data->logical_transport_type,
                                      p_data->direction,
                                      base::Bind(&btm_read_codec_capability_cmd_cmpl));
}

void BTM_ConfigureDataPath(tBTM_CFG_DATA_PATH_PARAM* p_data) {
  BTM_TRACE_API("%s", __func__);

  btm_cb.devcb.cfg_datapath_cmpl_cb = p_data->p_cb;
  btsnd_hcic_configure_data_path(p_data->data_path_dir,
                                 p_data->data_path_id,
                                 p_data->vs_config_len,
                                 p_data->vs_config,
                                 base::Bind(&btm_configure_datapath_cmd_cmpl));
}

void BTM_SetEcosystemBaseInterval(uint16_t interval,
                                  tBTM_SET_ECOSYSTEM_BASE_INTERVAL_CB* p_cb) {
  BTM_TRACE_API("%s", __func__);

  btm_cb.devcb.set_eco_interval_cmpl_cb = p_cb;
  btsnd_hcic_set_ecosystem_base_interval(interval,
                                 base::Bind(&btm_set_ecosystem_base_interval_cmd_cmpl));
}