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

145 lines
4.8 KiB
C++
Raw Normal View History

2022-08-15 04:20:27 -05:00
/***************************************************************************
*
* 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 <stdio.h>
#include "cmsis_os.h"
#include "hal_uart.h"
#include "hal_timer.h"
#include "audioflinger.h"
#include "lockcqueue.h"
#include "hal_trace.h"
#include "hal_cmu.h"
#include "analog.h"
#include "bt_drv.h"
#include "app_audio.h"
#include "bt_drv_interface.h"
#include "app_bt_stream.h"
#include "nvrecord.h"
#include "nvrecord_env.h"
#include "spp_api.h"
#include "hal_chipid.h"
#include "bt_drv_reg_op.h"
#include "besbt.h"
#include "cqueue.h"
#include "btapp.h"
#include "app_bt.h"
#include "apps.h"
#include "resources.h"
#include "app_bt_media_manager.h"
#include "tgt_hardware.h"
#ifdef __TWS__
#include "app_tws.h"
#include "app_bt.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