dsp: add BT sink support in AFE driver

Add different media format support in AFE decoder.

Change-Id: Icdc3884882c34236f5ab02355dfbabdd2a1becd2
Signed-off-by: Florian Pfister <fpfister@codeaurora.org>
Signed-off-by: Surendar Karka <skarka@codeaurora.org>
This commit is contained in:
Florian Pfister
2018-09-26 15:45:18 +02:00
committed by Gerrit - the friendly Code Review server
parent 1ab95845cf
commit f1b8d5bdea
2 changed files with 268 additions and 24 deletions

View File

@@ -3442,15 +3442,21 @@ exit:
static int q6afe_send_dec_config(u16 port_id, static int q6afe_send_dec_config(u16 port_id,
union afe_port_config afe_config, union afe_port_config afe_config,
struct afe_dec_config *cfg) struct afe_dec_config *cfg,
u32 format,
u16 afe_in_channels, u16 afe_in_bit_width)
{ {
struct afe_dec_media_fmt_t dec_media_fmt;
struct avs_dec_depacketizer_id_param_t dec_depkt_id_param; struct avs_dec_depacketizer_id_param_t dec_depkt_id_param;
struct avs_dec_congestion_buffer_param_t dec_buffer_id_param;
struct afe_enc_dec_imc_info_param_t imc_info_param; struct afe_enc_dec_imc_info_param_t imc_info_param;
struct afe_port_media_type_t media_type; struct afe_port_media_type_t media_type;
struct param_hdr_v3 param_hdr; struct param_hdr_v3 param_hdr;
int ret; int ret;
u32 dec_fmt;
memset(&dec_depkt_id_param, 0, sizeof(dec_depkt_id_param)); memset(&dec_depkt_id_param, 0, sizeof(dec_depkt_id_param));
memset(&dec_media_fmt, 0, sizeof(dec_media_fmt));
memset(&imc_info_param, 0, sizeof(imc_info_param)); memset(&imc_info_param, 0, sizeof(imc_info_param));
memset(&media_type, 0, sizeof(media_type)); memset(&media_type, 0, sizeof(media_type));
memset(&param_hdr, 0, sizeof(param_hdr)); memset(&param_hdr, 0, sizeof(param_hdr));
@@ -3463,10 +3469,10 @@ static int q6afe_send_dec_config(u16 port_id,
param_hdr.param_id = AFE_DECODER_PARAM_ID_DEPACKETIZER_ID; param_hdr.param_id = AFE_DECODER_PARAM_ID_DEPACKETIZER_ID;
param_hdr.param_size = sizeof(struct avs_dec_depacketizer_id_param_t); param_hdr.param_size = sizeof(struct avs_dec_depacketizer_id_param_t);
dec_depkt_id_param.dec_depacketizer_id = dec_depkt_id_param.dec_depacketizer_id =
AFE_MODULE_ID_DEPACKETIZER_COP;
if (cfg->format == ASM_MEDIA_FMT_APTX_ADAPTIVE)
dec_depkt_id_param.dec_depacketizer_id =
AFE_MODULE_ID_DEPACKETIZER_COP_V1; AFE_MODULE_ID_DEPACKETIZER_COP_V1;
if (cfg->format == ENC_CODEC_TYPE_LDAC)
dec_depkt_id_param.dec_depacketizer_id =
AFE_MODULE_ID_DEPACKETIZER_COP;
ret = q6afe_pack_and_set_param_in_band(port_id, ret = q6afe_pack_and_set_param_in_band(port_id,
q6audio_get_port_index(port_id), q6audio_get_port_index(port_id),
param_hdr, param_hdr,
@@ -3477,19 +3483,52 @@ static int q6afe_send_dec_config(u16 port_id,
goto exit; goto exit;
} }
pr_debug("%s:sending AFE_ENCDEC_PARAM_ID_DEC_TO_ENC_COMMUNICATION to DSP payload\n", switch (cfg->format) {
__func__); case ASM_MEDIA_FMT_SBC:
param_hdr.param_id = AFE_ENCDEC_PARAM_ID_DEC_TO_ENC_COMMUNICATION; case ASM_MEDIA_FMT_AAC_V2:
param_hdr.param_size = sizeof(struct afe_enc_dec_imc_info_param_t); case ASM_MEDIA_FMT_MP3:
imc_info_param.imc_info = cfg->abr_dec_cfg.imc_info; if (port_id == SLIMBUS_9_TX) {
ret = q6afe_pack_and_set_param_in_band(port_id, dec_buffer_id_param.max_nr_buffers = 200;
q6audio_get_port_index(port_id), dec_buffer_id_param.pre_buffer_size = 200;
param_hdr, } else {
(u8 *) &imc_info_param); dec_buffer_id_param.max_nr_buffers = 0;
if (ret) { dec_buffer_id_param.pre_buffer_size = 0;
pr_err("%s: AFE_ENCDEC_PARAM_ID_DEC_TO_ENC_COMMUNICATION for port 0x%x failed %d\n", }
__func__, port_id, ret); pr_debug("%s: sending AFE_DECODER_PARAM_ID_CONGESTION_BUFFER_SIZE to DSP payload\n",
goto exit; __func__);
param_hdr.param_id =
AFE_DECODER_PARAM_ID_CONGESTION_BUFFER_SIZE;
param_hdr.param_size =
sizeof(struct avs_dec_congestion_buffer_param_t);
dec_buffer_id_param.version = 0;
ret = q6afe_pack_and_set_param_in_band(port_id,
q6audio_get_port_index(port_id),
param_hdr,
(u8 *) &dec_buffer_id_param);
if (ret) {
pr_err("%s: AFE_DECODER_PARAM_ID_CONGESTION_BUFFER_SIZE for port 0x%x failed %d\n",
__func__, port_id, ret);
goto exit;
}
break;
default:
pr_debug("%s:sending AFE_ENCDEC_PARAM_ID_DEC_TO_ENC_COMMUNICATION to DSP payload\n",
__func__);
param_hdr.param_id =
AFE_ENCDEC_PARAM_ID_DEC_TO_ENC_COMMUNICATION;
param_hdr.param_size =
sizeof(struct afe_enc_dec_imc_info_param_t);
imc_info_param.imc_info = cfg->abr_dec_cfg.imc_info;
ret = q6afe_pack_and_set_param_in_band(port_id,
q6audio_get_port_index(port_id),
param_hdr,
(u8 *) &imc_info_param);
if (ret) {
pr_err("%s: AFE_ENCDEC_PARAM_ID_DEC_TO_ENC_COMMUNICATION for port 0x%x failed %d\n",
__func__, port_id, ret);
goto exit;
}
break;
} }
pr_debug("%s:Sending AFE_API_VERSION_PORT_MEDIA_TYPE to DSP", __func__); pr_debug("%s:Sending AFE_API_VERSION_PORT_MEDIA_TYPE to DSP", __func__);
@@ -3497,9 +3536,24 @@ static int q6afe_send_dec_config(u16 port_id,
param_hdr.param_id = AFE_PARAM_ID_PORT_MEDIA_TYPE; param_hdr.param_id = AFE_PARAM_ID_PORT_MEDIA_TYPE;
param_hdr.param_size = sizeof(struct afe_port_media_type_t); param_hdr.param_size = sizeof(struct afe_port_media_type_t);
media_type.minor_version = AFE_API_VERSION_PORT_MEDIA_TYPE; media_type.minor_version = AFE_API_VERSION_PORT_MEDIA_TYPE;
media_type.sample_rate = afe_config.slim_sch.sample_rate; switch (cfg->format) {
media_type.bit_width = afe_config.slim_sch.bit_width; case ASM_MEDIA_FMT_AAC_V2:
media_type.num_channels = afe_config.slim_sch.num_channels; media_type.sample_rate =
cfg->data.aac_config.sample_rate;
break;
default:
media_type.sample_rate =
afe_config.slim_sch.sample_rate;
}
if (afe_in_bit_width)
media_type.bit_width = afe_in_bit_width;
else
media_type.bit_width = afe_config.slim_sch.bit_width;
if (afe_in_channels)
media_type.num_channels = afe_in_channels;
else
media_type.num_channels = afe_config.slim_sch.num_channels;
media_type.data_format = AFE_PORT_DATA_FORMAT_PCM; media_type.data_format = AFE_PORT_DATA_FORMAT_PCM;
media_type.reserved = 0; media_type.reserved = 0;
@@ -3512,6 +3566,50 @@ static int q6afe_send_dec_config(u16 port_id,
goto exit; goto exit;
} }
if (format != ASM_MEDIA_FMT_SBC && format != ASM_MEDIA_FMT_AAC_V2) {
pr_debug("%s:Unsuppported dec format. Ignore AFE config %u\n",
__func__, format);
goto exit;
}
pr_debug("%s: sending AFE_DECODER_PARAM_ID_DEC_MEDIA_FMT to DSP payload\n",
__func__);
param_hdr.module_id = AFE_MODULE_ID_DECODER;
param_hdr.instance_id = INSTANCE_ID_0;
param_hdr.param_id = AFE_DECODER_PARAM_ID_DEC_FMT_ID;
param_hdr.param_size = sizeof(dec_fmt);
dec_fmt = format;
ret = q6afe_pack_and_set_param_in_band(port_id,
q6audio_get_port_index(port_id),
param_hdr, (u8 *) &dec_fmt);
if (ret) {
pr_err("%s: AFE_DECODER_PARAM_ID_DEC_MEDIA_FMT for port 0x%x failed %d\n",
__func__, port_id, ret);
goto exit;
}
switch (cfg->format) {
case ASM_MEDIA_FMT_AAC_V2:
param_hdr.param_size = sizeof(struct afe_dec_media_fmt_t);
pr_debug("%s:send AFE_DECODER_PARAM_ID DEC_MEDIA_FMT to DSP payload\n",
__func__);
param_hdr.param_id = AVS_DECODER_PARAM_ID_DEC_MEDIA_FMT;
dec_media_fmt.dec_media_config = cfg->data;
ret = q6afe_pack_and_set_param_in_band(port_id,
q6audio_get_port_index(port_id),
param_hdr,
(u8 *) &dec_media_fmt);
if (ret) {
pr_err("%s: AFE_DECODER_PARAM_ID DEC_MEDIA_FMT for port 0x%x failed %d\n",
__func__, port_id, ret);
goto exit;
}
break;
default:
pr_debug("%s:No need to send DEC_MEDIA_FMT to DSP payload\n",
__func__);
}
exit: exit:
return ret; return ret;
} }
@@ -3550,7 +3648,8 @@ static int q6afe_send_enc_config(u16 port_id,
format != ASM_MEDIA_FMT_APTX && format != ASM_MEDIA_FMT_APTX_HD && format != ASM_MEDIA_FMT_APTX && format != ASM_MEDIA_FMT_APTX_HD &&
format != ASM_MEDIA_FMT_CELT && format != ASM_MEDIA_FMT_LDAC && format != ASM_MEDIA_FMT_CELT && format != ASM_MEDIA_FMT_LDAC &&
format != ASM_MEDIA_FMT_APTX_ADAPTIVE) { format != ASM_MEDIA_FMT_APTX_ADAPTIVE) {
pr_err("%s:Unsuppported format Ignore AFE config\n", __func__); pr_err("%s:Unsuppported enc format. Ignore AFE config\n",
__func__);
return 0; return 0;
} }
@@ -3582,7 +3681,7 @@ static int q6afe_send_enc_config(u16 port_id,
enc_blk_param.enc_cfg_blk_size = enc_blk_param.enc_cfg_blk_size =
sizeof(union afe_enc_config_data); sizeof(union afe_enc_config_data);
} }
pr_debug("%s:send AFE_ENCODER_PARAM_ID_ENC_CFG_BLK to DSP payloadn", pr_debug("%s:send AFE_ENCODER_PARAM_ID_ENC_CFG_BLK to DSP payload\n",
__func__); __func__);
param_hdr.param_id = AFE_ENCODER_PARAM_ID_ENC_CFG_BLK; param_hdr.param_id = AFE_ENCODER_PARAM_ID_ENC_CFG_BLK;
enc_blk_param.enc_blk_config = *cfg; enc_blk_param.enc_blk_config = *cfg;
@@ -4064,7 +4163,9 @@ static int __afe_port_start(u16 port_id, union afe_port_config *afe_config,
pr_debug("%s: Found AFE decoder support for SLIMBUS format = %d\n", pr_debug("%s: Found AFE decoder support for SLIMBUS format = %d\n",
__func__, codec_format); __func__, codec_format);
ret = q6afe_send_dec_config(port_id, *afe_config, ret = q6afe_send_dec_config(port_id, *afe_config,
dec_cfg); dec_cfg, codec_format,
afe_in_channels,
afe_in_bit_width);
if (ret) { if (ret) {
pr_err("%s: AFE decoder config for port 0x%x failed %d\n", pr_err("%s: AFE decoder config for port 0x%x failed %d\n",
__func__, port_id, ret); __func__, port_id, ret);

View File

@@ -3875,6 +3875,12 @@ struct afe_id_aptx_adaptive_enc_init
*/ */
#define AFE_ENCODER_PARAM_ID_ENC_FMT_ID 0x0001322B #define AFE_ENCODER_PARAM_ID_ENC_FMT_ID 0x0001322B
/*
* Decoder format ID parameter for the #AVS_MODULE_ID_DECODER module.
* This parameter cannot be set runtime.
*/
#define AFE_DECODER_PARAM_ID_DEC_FMT_ID 0x00013234
/* /*
* Encoder scrambler parameter for the #AVS_MODULE_ID_ENCODER module. * Encoder scrambler parameter for the #AVS_MODULE_ID_ENCODER module.
* This parameter cannot be set runtime. * This parameter cannot be set runtime.
@@ -3915,6 +3921,12 @@ struct afe_id_aptx_adaptive_enc_init
*/ */
#define AFE_DECODER_PARAM_ID_DEPACKETIZER_ID 0x00013235 #define AFE_DECODER_PARAM_ID_DEPACKETIZER_ID 0x00013235
/*
* Decoder buffer ID parameter for the #AVS_MODULE_ID_DECODER module.
* This parameter cannot be set runtime.
*/
#define AFE_DECODER_PARAM_ID_CONGESTION_BUFFER_SIZE 0x000132ec
/* /*
* Data format to send compressed data * Data format to send compressed data
* is transmitted/received over Slimbus lines. * is transmitted/received over Slimbus lines.
@@ -4185,6 +4197,7 @@ struct asm_celt_enc_cfg_t {
} __packed; } __packed;
#define ASM_MEDIA_FMT_LDAC 0x00013224 #define ASM_MEDIA_FMT_LDAC 0x00013224
#define ENC_CODEC_TYPE_LDAC 0x23000000
struct asm_ldac_specific_enc_cfg_t { struct asm_ldac_specific_enc_cfg_t {
/* /*
* This is used to calculate the encoder output * This is used to calculate the encoder output
@@ -4293,6 +4306,98 @@ struct afe_port_media_type_t {
uint16_t reserved; uint16_t reserved;
} __packed; } __packed;
/*
* Payload of the SBC decoder configuration parameters in the
* #ASM_MEDIA_FMT_SBC media format.
*/
struct asm_sbc_dec_cfg_t {
/* All configuration is extracted from the stream */
} __packed;
/*
* Payload of the MP3 decoder configuration parameters in the
* #ASM_MEDIA_FMT_MP3 media format.
*/
struct asm_mp3_dec_cfg_t {
/* All configuration is extracted from the stream */
} __packed;
struct asm_aac_dec_cfg_v2_t {
uint16_t aac_fmt_flag;
/*
* Bit stream format option.
*
* @values
* - #ASM_MEDIA_FMT_AAC_FORMAT_FLAG_ADTS
* - #ASM_MEDIA_FMT_AAC_FORMAT_FLAG_LOAS
* - #ASM_MEDIA_FMT_AAC_FORMAT_FLAG_ADIF
* - #ASM_MEDIA_FMT_AAC_FORMAT_FLAG_RAW
* - #ASM_MEDIA_FMT_AAC_FORMAT_FLAG_LATM
*/
uint16_t audio_obj_type;
/*
* Audio Object Type (AOT) present in the AAC stream.
*
* @values
* - #ASM_MEDIA_FMT_AAC_AOT_LC
* - #ASM_MEDIA_FMT_AAC_AOT_SBR
* - #ASM_MEDIA_FMT_AAC_AOT_BSAC
* - #ASM_MEDIA_FMT_AAC_AOT_PS
*
* Other values are not supported.
*/
uint16_t channel_config;
/*
* Number of channels present in the AAC stream.
*
* @values
* - 0 -- PCE
* - 1 -- Mono
* - 2 -- Stereo
* - 6 -- 5.1 content
*/
uint16_t total_size_of_PCE_bits;
/*
* For RAW formats and if channel_config=0 (PCE),
* the client can send the bit stream containing PCE
* immediately following this structure (in band).
*
* @values @ge 0 (does not include the bits required
* for 32-bit alignment)
*
* If this field is set to 0, the PCE information is
* assumed to be available in the audio bit stream
* and not in band.
*
* If this field is greater than 0, the PCE information
* follows this structure. Additional bits might
* be required for 32-bit alignment.
*/
uint32_t sample_rate;
/*
* Number of samples per second.
*
* @values 8000, 11025, 12000, 16000, 22050, 24000, 32000,
* 44100, 48000, 64000, 88200, 96000 Hz
*
* This field must be equal to the sample rate of the
* AAC-LC decoder output.
* - For MP4 or 3GP containers, this sample rate
* is indicated by the
* samplingFrequencyIndex field in the
* AudioSpecificConfig element.
* - For ADTS format, this sample rate is indicated by the
* samplingFrequencyIndex in the ADTS fixed header.
* - For ADIF format, this sample rate is indicated by the
* samplingFrequencyIndex in the program_config_element
* present in the ADIF header.
*/
} __packed;
union afe_enc_config_data { union afe_enc_config_data {
struct asm_sbc_enc_cfg_t sbc_config; struct asm_sbc_enc_cfg_t sbc_config;
struct asm_aac_enc_cfg_v2_t aac_config; struct asm_aac_enc_cfg_v2_t aac_config;
@@ -4309,9 +4414,16 @@ struct afe_enc_config {
union afe_enc_config_data data; union afe_enc_config_data data;
}; };
union afe_dec_config_data {
struct asm_sbc_dec_cfg_t sbc_config;
struct asm_aac_dec_cfg_v2_t aac_config;
struct asm_mp3_dec_cfg_t mp3_config;
};
struct afe_dec_config { struct afe_dec_config {
u32 format; u32 format;
struct afe_abr_dec_cfg_t abr_dec_cfg; struct afe_abr_dec_cfg_t abr_dec_cfg;
union afe_dec_config_data data;
}; };
struct afe_enc_cfg_blk_param_t { struct afe_enc_cfg_blk_param_t {
@@ -4322,6 +4434,14 @@ struct afe_enc_cfg_blk_param_t {
union afe_enc_config_data enc_blk_config; union afe_enc_config_data enc_blk_config;
}; };
/*
* Payload of the AVS_DECODER_PARAM_ID_DEC_MEDIA_FMT parameter used by
* AVS_MODULE_ID_DECODER.
*/
struct afe_dec_media_fmt_t {
union afe_dec_config_data dec_media_config;
} __packed;
/* /*
* Payload of the AVS_ENCODER_PARAM_ID_PACKETIZER_ID parameter. * Payload of the AVS_ENCODER_PARAM_ID_PACKETIZER_ID parameter.
*/ */
@@ -4373,12 +4493,34 @@ struct afe_enc_dec_imc_info_param_t {
struct avs_dec_depacketizer_id_param_t { struct avs_dec_depacketizer_id_param_t {
/* /*
* Supported values: * Supported values:
* #AVS_MODULE_ID_DEPACKETIZER_COP * #AFE_MODULE_ID_DEPACKETIZER_COP
* #AFE_MODULE_ID_DEPACKETIZER_COP_V1
* Any OpenDSP supported values * Any OpenDSP supported values
*/ */
uint32_t dec_depacketizer_id; uint32_t dec_depacketizer_id;
}; };
struct avs_dec_congestion_buffer_param_t {
uint32_t version;
uint16_t max_nr_buffers;
/*
* Maximum number of 1ms buffers:
* 0 - 256
*/
uint16_t pre_buffer_size;
/*
* Pre-buffering size in 1ms:
* 1 - 128
*/
};
/*
* ID of the parameter used by #AVS_MODULE_ID_DECODER to configure
* the decoder mode for the AFE module.
* This parameter cannot be set at runtime.
*/
#define AVS_DECODER_PARAM_ID_DEC_MEDIA_FMT 0x00013232
/* ID of the parameter used by #AFE_MODULE_AUDIO_DEV_INTERFACE to configure /* ID of the parameter used by #AFE_MODULE_AUDIO_DEV_INTERFACE to configure
* the island mode for a given AFE port. * the island mode for a given AFE port.
*/ */
@@ -4492,6 +4634,7 @@ union afe_port_config {
struct avs_enc_packetizer_id_param_t enc_pkt_id_param; struct avs_enc_packetizer_id_param_t enc_pkt_id_param;
struct avs_enc_set_scrambler_param_t enc_set_scrambler_param; struct avs_enc_set_scrambler_param_t enc_set_scrambler_param;
struct avs_dec_depacketizer_id_param_t dec_depkt_id_param; struct avs_dec_depacketizer_id_param_t dec_depkt_id_param;
struct afe_dec_media_fmt_t dec_media_fmt;
struct afe_enc_level_to_bitrate_map_param_t map_param; struct afe_enc_level_to_bitrate_map_param_t map_param;
struct afe_enc_dec_imc_info_param_t imc_info_param; struct afe_enc_dec_imc_info_param_t imc_info_param;
struct afe_param_id_cdc_dma_cfg_t cdc_dma; struct afe_param_id_cdc_dma_cfg_t cdc_dma;