pinebuds/services/bt_app/a2dp_codecs/lhdc/codec_lhdc.cpp

/***************************************************************************
 *
 * Copyright 2015-2019 BES.
 * All rights reserved. All unpublished rights reserved.
 *
 * No part of this work may be used or reproduced in any form or by any
 * means, or stored in a database or retrieval system, without prior written
 * permission of BES.
 *
 * Use of this work is governed by a license granted by BES.
 * This work contains confidential and proprietary information of
 * BES. which is protected by copyright, trade secret,
 * trademark and other intellectual property rights.
 *
 ****************************************************************************/
#ifdef A2DP_LHDC_ON

#include "analog.h"
#include "app_audio.h"
#include "app_bt_stream.h"
#include "audioflinger.h"
#include "bt_drv.h"
#include "bt_drv_interface.h"
#include "cmsis_os.h"
#include "hal_cmu.h"
#include "hal_timer.h"
#include "hal_trace.h"
#include "hal_uart.h"
#include "lockcqueue.h"
#include "nvrecord.h"
#include "nvrecord_env.h"
#include <stdio.h>

#include "app_bt.h"
#include "app_bt_media_manager.h"
#include "apps.h"
#include "besbt.h"
#include "bt_drv_reg_op.h"
#include "btapp.h"
#include "cqueue.h"
#include "hal_chipid.h"
#include "resources.h"
#include "spp_api.h"
#include "tgt_hardware.h"
#ifdef __TWS__
#include "app_bt.h"
#include "app_tws.h"
#include "app_tws_if.h"
#endif

#include "codec_lhdc.h"

void lhdc_info_parse(uint8_t *elements, lhdc_info_t *info) {
  info->vendor_id = (uint32_t)elements[0];
  info->vendor_id |= ((uint32_t)elements[1]) << 8;
  info->vendor_id |= ((uint32_t)elements[2]) << 16;
  info->vendor_id |= ((uint32_t)elements[3]) << 24;

  info->codec_id = (uint16_t)elements[4];
  info->codec_id |= ((uint16_t)elements[5]) << 8;
  uint8_t config = elements[6];

  if (info->vendor_id == A2DP_LHDC_VENDOR_ID &&
      info->codec_id == A2DP_LHDC_CODEC_ID) {

    TRACE(2, "Vendor ID = 0x%08x, Codec ID = 0x%04x, LHDC Codec\n",
          info->vendor_id, info->codec_id);
    switch (A2DP_LHDC_SR_DATA(config)) {
    case A2DP_LHDC_SR_96000:
      info->sample_rater = A2D_SBC_IE_SAMP_FREQ_96;
      TRACE(1, "%s:CodecCfg sample_rate 96000\n", __func__);
      break;
    case A2DP_LHDC_SR_48000:
      info->sample_rater = A2D_SBC_IE_SAMP_FREQ_48;
      TRACE(1, "%s:CodecCfg sample_rate 48000\n", __func__);
      break;
    case A2DP_LHDC_SR_44100:
      info->sample_rater = A2D_SBC_IE_SAMP_FREQ_44;
      TRACE(1, "%s:CodecCfg sample_rate 44100\n", __func__);
      break;
    }
    switch (A2DP_LHDC_FMT_DATA(config)) {
    case A2DP_LHDC_FMT_16:
      info->bits = 16;
      TRACE(1, "%s:CodecCfg bits per sampe = 16", __func__);
      break;
    case A2DP_LHDC_FMT_24:
      TRACE(1, "%s:CodecCfg bits per sampe = 24", __func__);
      info->bits = 24;
      break;
    }

    config = elements[7];
    info->version_num = 0x0f & config;
    TRACE(2, "%s:lhdc codec version num:%x\n", __func__, info->version_num);
    info->max_sample_rate = 0x30 & config;
    TRACE(2, "%s:lhdc codec max sample rate:%x\n", __func__,
          info->sample_rater);

    info->llc_enable = 0x40 & config;
    TRACE(2, "%s:lhdc codec llc enable:%x \n", __func__, info->llc_enable);

    config = elements[8];
    switch (A2DP_LHDC_COF_DATA(config)) {
    case A2DP_LHDC_COF_CSC_DISABLE:
      info->compress_output_format = LHDC_CHANNEL_SPLIT_DISABLE;
      TRACE(1, "%s:compress_output_format: LHDC_COF_CSC_DISABLE", __func__);
      break;
    case A2DP_LHDC_COF_CSC:
      TRACE(1, "%s:compress_output_format: LHDC_COF_CSC", __func__);
      info->compress_output_format = LHDC_CHANNEL_SPLIT;
      break;
    case A2DP_LHDC_COF_CSC_PRE:
      TRACE(1, "%s:compress_output_format: LHDC_COF_CSC_PRE", __func__);
      info->compress_output_format = LHDC_CHANNEL_SPLIT_FROM_ENCODER;
      break;
    }
  }
}

uint8_t a2dp_lhdc_get_sample_rate(uint8_t *elements) {
  uint32_t vendor_id = (uint32_t)elements[0];
  vendor_id |= ((uint32_t)elements[1]) << 8;
  vendor_id |= ((uint32_t)elements[2]) << 16;
  vendor_id |= ((uint32_t)elements[3]) << 24;
  uint16_t codec_id = (uint16_t)elements[4];
  codec_id |= ((uint16_t)elements[5]) << 8;

  uint8_t config = elements[6];
  if (vendor_id == A2DP_LHDC_VENDOR_ID && codec_id == A2DP_LHDC_CODEC_ID) {
    switch (A2DP_LHDC_SR_DATA(config)) {
    case A2DP_LHDC_SR_96000:
      return A2D_SBC_IE_SAMP_FREQ_96;
    case A2DP_LHDC_SR_48000:
      return A2D_SBC_IE_SAMP_FREQ_48;
    case A2DP_LHDC_SR_44100:
      return A2D_SBC_IE_SAMP_FREQ_44;
    }
  }
  return 0;
}

#endif