diff --git a/asoc/msm-dai-q6-v2.c b/asoc/msm-dai-q6-v2.c index 353c1b9772cb..6ab2455902c7 100755 --- a/asoc/msm-dai-q6-v2.c +++ b/asoc/msm-dai-q6-v2.c @@ -4325,6 +4325,9 @@ static const struct snd_kcontrol_new afe_dec_config_controls[] = { SOC_ENUM_EXT("AFE Output Bit Format", afe_bit_format_enum[0], msm_dai_q6_afe_output_bit_format_get, msm_dai_q6_afe_output_bit_format_put), + SOC_ENUM_EXT("AFE Output Channels SLIM7", afe_chs_enum[0], + msm_dai_q6_afe_output_channel_get, + msm_dai_q6_afe_output_channel_put), }; static const struct snd_kcontrol_new afe_ttp_config_controls[] = { @@ -4570,6 +4573,9 @@ static int msm_dai_q6_dai_probe(struct snd_soc_dai *dai) rc = snd_ctl_add(dai->component->card->snd_card, snd_ctl_new1(&afe_dec_config_controls[0], dai_data)); + rc = snd_ctl_add(dai->component->card->snd_card, + snd_ctl_new1(&afe_dec_config_controls[4], + dai_data)); break; case SLIMBUS_9_TX: rc = snd_ctl_add(dai->component->card->snd_card, diff --git a/dsp/q6afe.c b/dsp/q6afe.c index 2bdcc5008042..ac6bc11733b5 100755 --- a/dsp/q6afe.c +++ b/dsp/q6afe.c @@ -446,7 +446,6 @@ static int q6afe_load_avcs_modules(int num_modules, u16 port_id, if (format_id == ASM_MEDIA_FMT_LC3) { pm[i]->payload->load_unload_info[0].id1 = AVS_MODULE_ID_DEPACKETIZER_COP_V2; - goto load_unload; } pm[i]->payload->load_unload_info[1].module_type = @@ -4981,6 +4980,7 @@ static int q6afe_send_dec_config(u16 port_id, struct asm_aptx_ad_speech_mode_cfg_t speech_codec_init_param; struct param_hdr_v3 param_hdr; struct avs_cop_v2_param_id_stream_info_t lc3_enc_stream_info; + struct afe_lc3_dec_cfg_t lc3_dec_config_init; int ret; u32 dec_fmt; @@ -4991,6 +4991,7 @@ static int q6afe_send_dec_config(u16 port_id, memset(&matched_port_param, 0, sizeof(matched_port_param)); memset(&speech_codec_init_param, 0, sizeof(speech_codec_init_param)); memset(&lc3_enc_stream_info, 0, sizeof(lc3_enc_stream_info)); + memset(&lc3_dec_config_init, 0, sizeof(lc3_dec_config_init)); memset(¶m_hdr, 0, sizeof(param_hdr)); param_hdr.module_id = AFE_MODULE_ID_DECODER; @@ -5176,6 +5177,55 @@ static int q6afe_send_dec_config(u16 port_id, } if (format == ASM_MEDIA_FMT_LC3) { + if (cfg->data.lc3_dec_config.dec_codec.from_Air_cfg + .stream_map_size != 0) { + /* create LC3 deocder before sending init params */ + 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; + } + + pr_debug("%s: sending CAPI_V2_PARAM_LC3_DEC_MODULE_INIT to DSP\n", + __func__); + param_hdr.param_id = CAPI_V2_PARAM_LC3_DEC_MODULE_INIT; + param_hdr.param_size = sizeof(struct afe_lc3_dec_cfg_t); + lc3_dec_config_init = + cfg->data.lc3_dec_config.dec_codec.from_Air_cfg; + ret = q6afe_pack_and_set_param_in_band( + port_id, q6audio_get_port_index(port_id), + param_hdr, (u8 *)&lc3_dec_config_init); + if (ret) { + pr_err("%s: CAPI_V2_PARAM_LC3_DEC_MODULE_INIT for port 0x%x failed %d\n", + __func__, port_id, ret); + goto exit; + } + + pr_debug("%s: sending AVS_COP_V2_PARAM_ID_STREAM_INFO to DSP\n", + __func__); + param_hdr.param_id = AVS_COP_V2_PARAM_ID_STREAM_INFO; + param_hdr.param_size = sizeof( + struct avs_cop_v2_param_id_stream_info_t); + lc3_enc_stream_info = cfg->data.lc3_dec_config.dec_codec.streamMapFromAir; + ret = q6afe_pack_and_set_param_in_band( + port_id, q6audio_get_port_index(port_id), + param_hdr, (u8 *)&lc3_enc_stream_info); + if (ret) { + pr_err("%s: AVS_COP_V2_PARAM_ID_STREAM_INFO for port 0x%x failed %d\n", + __func__, port_id, ret); + goto exit; + } + } pr_debug("%s: sending AVS_COP_V2_PARAM_ID_STREAM_INFO to DSP\n", __func__); param_hdr.module_id = AFE_MODULE_ID_DECODER; diff --git a/include/dsp/apr_audio-v2.h b/include/dsp/apr_audio-v2.h index a13a01a81fa7..4fb7b49c41fa 100644 --- a/include/dsp/apr_audio-v2.h +++ b/include/dsp/apr_audio-v2.h @@ -4672,16 +4672,18 @@ struct afe_lc3_dec_cfg_t { struct afe_lc3_cfg_t FromAir; uint32_t decoder_output_channel; uint32_t stream_map_size; - struct afe_stream_map_t streamMapIn[16]; + struct afe_stream_map_t streamMapIn[2]; } __packed; struct avs_cop_v2_param_id_stream_info_t { uint32_t stream_map_size; - struct afe_lc3_stream_map_t streamMap[16]; + struct afe_lc3_stream_map_t streamMap[2]; } __packed; struct afe_lc3_dec_config_t { + struct afe_lc3_dec_cfg_t from_Air_cfg; struct avs_cop_v2_param_id_stream_info_t streamMapToAir; + struct avs_cop_v2_param_id_stream_info_t streamMapFromAir; } __packed; struct afe_lc3_enc_config_t {