ASoC: msm: set AFE_LOOPBACK_TX port id to EC ref port (92ca4634) · Commits · e / devices / android_kernel_xiaomi_markw

include/sound/q6adm-v2.h

+1 −1

Original line number	Diff line number	Diff line
		@@ -100,7 +100,7 @@ int adm_dolby_dap_send_params(int port_id, int copp_idx, char *params,

		int adm_open(int port, int path, int rate, int mode, int topology,
		int perf_mode, uint16_t bits_per_sample,
		int app_type, int acdbdev_id);
		int app_type, int acdbdev_id, int session_type);

		int adm_map_rtac_block(struct rtac_cal_block_data *cal_block);

sound/soc/msm/qdsp6v2/msm-pcm-routing-v2.c

+53 −54

Original line number	Diff line number	Diff line
		@@ -68,6 +68,7 @@ static uint32_t voc_session_id = ALL_SESSION_VSID;
		static int msm_route_ext_ec_ref;
		static bool is_custom_stereo_on;
		static bool is_ds2_on;
		static int msm_ec_ref_port_id;

		#define WEIGHT_0_DB 0x4000
		/* all the FEs which can support channel mixer */
		@@ -637,6 +638,11 @@ static int msm_pcm_routing_get_lsm_app_type_idx(int app_type)
		return 0;
		}

		static int get_port_id(int port_id)
		{
		return (port_id == AFE_LOOPBACK_TX ? msm_ec_ref_port_id : port_id);
		}

		static bool is_mm_lsm_fe_id(int fe_id)
		{
		bool rc = true;
		@@ -836,12 +842,12 @@ static void msm_pcm_routing_build_matrix(int fedai_id, int sess_type,
		(afe_get_port_type(msm_bedais[i].port_id) == port_type) &&
		(msm_bedais[i].active) &&
		(test_bit(fedai_id, &msm_bedais[i].fe_sessions))) {
		int port_id = get_port_id(msm_bedais[i].port_id);
		for (j = 0; j < MAX_COPPS_PER_PORT; j++) {
		unsigned long copp =
		session_copp_map[fedai_id][sess_type][i];
		if (test_bit(j, &copp)) {
		payload.port_id[num_copps] =
		msm_bedais[i].port_id;
		payload.port_id[num_copps] = port_id;
		payload.copp_idx[num_copps] = j;
		num_copps++;
		}
		@@ -978,6 +984,7 @@ int msm_pcm_routing_reg_phy_compr_stream(int fe_id, int perf_mode,
		(msm_bedais[i].active) &&
		(test_bit(fe_id, &msm_bedais[i].fe_sessions))) {
		int app_type, app_type_idx, copp_idx, acdb_dev_id;
		int port_id = get_port_id(msm_bedais[i].port_id);
		channels = msm_bedais[i].channel;

		bit_width = msm_routing_get_bit_width(
		@@ -1010,11 +1017,10 @@ int msm_pcm_routing_reg_phy_compr_stream(int fe_id, int perf_mode,
		pr_debug("%s: Before adm open topology %d\n", __func__,
		topology);

		copp_idx =
		adm_open(msm_bedais[i].port_id,
		path_type, sample_rate, channels,
		topology, perf_mode, bit_width,
		app_type, acdb_dev_id);
		copp_idx = adm_open(port_id, path_type, sample_rate,
		channels, topology, perf_mode,
		bit_width, app_type, acdb_dev_id,
		session_type);
		if ((copp_idx < 0) \|\|
		(copp_idx >= MAX_COPPS_PER_PORT)) {
		pr_err("%s:adm open failed coppid:%d\n",
		@@ -1030,22 +1036,20 @@ int msm_pcm_routing_reg_phy_compr_stream(int fe_id, int perf_mode,
		if (msm_is_fractional_resample_needed(
		sample_rate,
		msm_bedais[i].sample_rate))
		adm_copp_mfc_cfg(
		msm_bedais[i].port_id, copp_idx,
		adm_copp_mfc_cfg(port_id, copp_idx,
		msm_bedais[i].sample_rate);

		for (j = 0; j < MAX_COPPS_PER_PORT; j++) {
		unsigned long copp =
		session_copp_map[fe_id][session_type][i];
		if (test_bit(j, &copp)) {
		payload.port_id[num_copps] =
		msm_bedais[i].port_id;
		payload.port_id[num_copps] = port_id;
		payload.copp_idx[num_copps] = j;
		num_copps++;
		}
		}
		msm_routing_send_device_pp_params(msm_bedais[i].port_id,
		copp_idx, fe_id);
		msm_routing_send_device_pp_params(port_id, copp_idx,
		fe_id);
		}
		}
		if (num_copps) {
		@@ -1197,6 +1201,7 @@ int msm_pcm_routing_reg_phy_stream(int fedai_id, int perf_mode,
		(msm_bedais[i].active) &&
		(test_bit(fedai_id, &msm_bedais[i].fe_sessions))) {
		int app_type, app_type_idx, copp_idx, acdb_dev_id;
		int port_id = get_port_id(msm_bedais[i].port_id);
		channels = msm_bedais[i].channel;
		msm_bedais[i].passthr_mode[fedai_id] =
		LEGACY_PCM;
		@@ -1221,10 +1226,10 @@ int msm_pcm_routing_reg_phy_stream(int fedai_id, int perf_mode,
		fe_dai_app_type_cfg[fedai_id][session_type].acdb_dev_id;
		topology = msm_routing_get_adm_topology(path_type,
		fedai_id, session_type);
		copp_idx = adm_open(msm_bedais[i].port_id, path_type,
		sample_rate, channels, topology,
		perf_mode, bits_per_sample,
		app_type, acdb_dev_id);
		copp_idx = adm_open(port_id, path_type, sample_rate,
		channels, topology, perf_mode,
		bits_per_sample, app_type,
		acdb_dev_id, session_type);
		if ((copp_idx < 0) \|\|
		(copp_idx >= MAX_COPPS_PER_PORT)) {
		pr_err("%s: adm open failed copp_idx:%d\n",
		@@ -1240,16 +1245,14 @@ int msm_pcm_routing_reg_phy_stream(int fedai_id, int perf_mode,
		if (msm_is_fractional_resample_needed(
		sample_rate,
		msm_bedais[i].sample_rate))
		adm_copp_mfc_cfg(
		msm_bedais[i].port_id, copp_idx,
		adm_copp_mfc_cfg(port_id, copp_idx,
		msm_bedais[i].sample_rate);

		for (j = 0; j < MAX_COPPS_PER_PORT; j++) {
		unsigned long copp =
		session_copp_map[fedai_id][session_type][i];
		if (test_bit(j, &copp)) {
		payload.port_id[num_copps] =
		msm_bedais[i].port_id;
		payload.port_id[num_copps] = port_id;
		payload.copp_idx[num_copps] = j;
		num_copps++;
		}
		@@ -1257,9 +1260,8 @@ int msm_pcm_routing_reg_phy_stream(int fedai_id, int perf_mode,
		if ((perf_mode == LEGACY_PCM_MODE) &&
		(msm_bedais[i].passthr_mode[fedai_id] ==
		LEGACY_PCM))
		msm_pcm_routing_cfg_pp(msm_bedais[i].port_id,
		copp_idx, topology,
		channels);
		msm_pcm_routing_cfg_pp(port_id, copp_idx,
		topology, channels);
		}
		}
		if (num_copps) {
		@@ -1325,10 +1327,11 @@ void msm_pcm_routing_dereg_phy_stream(int fedai_id, int stream_type)
		(afe_get_port_type(msm_bedais[i].port_id) == port_type) &&
		(msm_bedais[i].active) &&
		(test_bit(fedai_id, &msm_bedais[i].fe_sessions))) {
		int idx;
		int idx, port_id;
		unsigned long copp =
		session_copp_map[fedai_id][session_type][i];
		fdai = &fe_dai_map[fedai_id][session_type];
		port_id = get_port_id(msm_bedais[i].port_id);

		for (idx = 0; idx < MAX_COPPS_PER_PORT; idx++)
		if (test_bit(idx, &copp))
		@@ -1340,8 +1343,8 @@ void msm_pcm_routing_dereg_phy_stream(int fedai_id, int stream_type)
		continue;
		}
		topology = adm_get_topology_for_port_copp_idx(
		msm_bedais[i].port_id, idx);
		adm_close(msm_bedais[i].port_id, fdai->perf_mode, idx);
		port_id, idx);
		adm_close(port_id, fdai->perf_mode, idx);
		pr_debug("%s:copp:%ld,idx bit fe:%d,type:%d,be:%d\n",
		__func__, copp, fedai_id, session_type, i);
		clear_bit(idx,
		@@ -1351,8 +1354,7 @@ void msm_pcm_routing_dereg_phy_stream(int fedai_id, int stream_type)
		(fdai->perf_mode == LEGACY_PCM_MODE) &&
		(msm_bedais[i].passthr_mode[fedai_id] ==
		LEGACY_PCM))
		msm_pcm_routing_deinit_pp(msm_bedais[i].port_id,
		topology);
		msm_pcm_routing_deinit_pp(port_id, topology);
		}
		}

		@@ -1428,6 +1430,7 @@ static void msm_pcm_routing_process_audio(u16 reg, u16 val, int set)
		if (msm_bedais[reg].active && fdai->strm_id !=
		INVALID_SESSION) {
		int app_type, app_type_idx, copp_idx, acdb_dev_id;
		int port_id = get_port_id(msm_bedais[reg].port_id);
		channels = msm_bedais[reg].channel;
		if (session_type == SESSION_TYPE_TX &&
		fdai->be_srate &&
		@@ -1470,10 +1473,10 @@ static void msm_pcm_routing_process_audio(u16 reg, u16 val, int set)
		session_type);
		acdb_dev_id =
		fe_dai_app_type_cfg[val][session_type].acdb_dev_id;
		copp_idx = adm_open(msm_bedais[reg].port_id, path_type,
		sample_rate, channels, topology,
		fdai->perf_mode, bits_per_sample,
		app_type, acdb_dev_id);
		copp_idx = adm_open(port_id, path_type, sample_rate,
		channels, topology, fdai->perf_mode,
		bits_per_sample, app_type,
		acdb_dev_id, session_type);
		if ((copp_idx < 0) \|\|
		(copp_idx >= MAX_COPPS_PER_PORT)) {
		pr_err("%s: adm open failed\n", __func__);
		@@ -1488,8 +1491,7 @@ static void msm_pcm_routing_process_audio(u16 reg, u16 val, int set)
		if (msm_is_fractional_resample_needed(
		sample_rate,
		msm_bedais[reg].sample_rate))
		adm_copp_mfc_cfg(
		msm_bedais[reg].port_id, copp_idx,
		adm_copp_mfc_cfg(port_id, copp_idx,
		msm_bedais[reg].sample_rate);

		if (session_type == SESSION_TYPE_RX &&
		@@ -1504,9 +1506,8 @@ static void msm_pcm_routing_process_audio(u16 reg, u16 val, int set)
		passthr_mode);
		if ((fdai->perf_mode == LEGACY_PCM_MODE) &&
		(passthr_mode == LEGACY_PCM))
		msm_pcm_routing_cfg_pp(msm_bedais[reg].port_id,
		copp_idx, topology,
		channels);
		msm_pcm_routing_cfg_pp(port_id, copp_idx,
		topology, channels);
		}
		} else {
		if (test_bit(val, &msm_bedais[reg].fe_sessions) &&
		@@ -1525,11 +1526,10 @@ static void msm_pcm_routing_process_audio(u16 reg, u16 val, int set)
		if (test_bit(idx, &copp))
		break;

		port_id = msm_bedais[reg].port_id;
		port_id = get_port_id(msm_bedais[reg].port_id);
		topology = adm_get_topology_for_port_copp_idx(port_id,
		idx);
		adm_close(msm_bedais[reg].port_id, fdai->perf_mode,
		idx);
		adm_close(port_id, fdai->perf_mode, idx);
		pr_debug("%s: copp: %ld, reset idx bit fe:%d, type: %d, be:%d topology=0x%x\n",
		__func__, copp, val, session_type, reg,
		topology);
		@@ -1539,9 +1539,7 @@ static void msm_pcm_routing_process_audio(u16 reg, u16 val, int set)
		DS2_ADM_COPP_TOPOLOGY_ID == topology) &&
		(fdai->perf_mode == LEGACY_PCM_MODE) &&
		(passthr_mode == LEGACY_PCM))
		msm_pcm_routing_deinit_pp(
		msm_bedais[reg].port_id,
		topology);
		msm_pcm_routing_deinit_pp(port_id, topology);
		msm_pcm_routing_build_matrix(val, session_type,
		path_type,
		fdai->perf_mode,
		@@ -3113,6 +3111,7 @@ static int msm_routing_ec_ref_rx_put(struct snd_kcontrol *kcontrol,
		ec_ref_port_id = AFE_PORT_INVALID;
		break;
		}
		msm_ec_ref_port_id = ec_ref_port_id;
		adm_ec_ref_rx_id(ec_ref_port_id);
		pr_debug("%s: msm_route_ec_ref_rx = %d\n",
		__func__, msm_route_ec_ref_rx);
		@@ -12600,10 +12599,10 @@ static int msm_pcm_routing_close(struct snd_pcm_substream *substream)
		if (test_bit(idx, &copp))
		break;
		fdai->be_srate = bedai->sample_rate;
		port_id = bedai->port_id;
		port_id = get_port_id(bedai->port_id);
		topology = adm_get_topology_for_port_copp_idx(port_id,
		idx);
		adm_close(bedai->port_id, fdai->perf_mode, idx);
		adm_close(port_id, fdai->perf_mode, idx);
		pr_debug("%s: copp:%ld,idx bit fe:%d, type:%d,be:%d topology=0x%x\n",
		__func__, copp, i, session_type, be_id,
		topology);
		@@ -12611,7 +12610,7 @@ static int msm_pcm_routing_close(struct snd_pcm_substream *substream)
		&session_copp_map[i][session_type][be_id]);
		if ((fdai->perf_mode == LEGACY_PCM_MODE) &&
		(bedai->passthr_mode[i] == LEGACY_PCM))
		msm_pcm_routing_deinit_pp(bedai->port_id,
		msm_pcm_routing_deinit_pp(port_id,
		topology);
		}
		}
		@@ -12678,6 +12677,7 @@ static int msm_pcm_routing_prepare(struct snd_pcm_substream *substream)
		fdai = &fe_dai_map[i][session_type];
		if (fdai->strm_id != INVALID_SESSION) {
		int app_type, app_type_idx, copp_idx, acdb_dev_id;
		int port_id = get_port_id(bedai->port_id);
		if (session_type == SESSION_TYPE_TX &&
		fdai->be_srate &&
		(fdai->be_srate != bedai->sample_rate)) {
		@@ -12719,10 +12719,10 @@ static int msm_pcm_routing_prepare(struct snd_pcm_substream *substream)
		fe_dai_app_type_cfg[i][session_type].acdb_dev_id;
		topology = msm_routing_get_adm_topology(path_type, i,
		session_type);
		copp_idx = adm_open(bedai->port_id, path_type,
		sample_rate, channels, topology,
		fdai->perf_mode, bits_per_sample,
		app_type, acdb_dev_id);
		copp_idx = adm_open(port_id, path_type, sample_rate,
		channels, topology, fdai->perf_mode,
		bits_per_sample, app_type,
		acdb_dev_id, session_type);
		if ((copp_idx < 0) \|\|
		(copp_idx >= MAX_COPPS_PER_PORT)) {
		pr_err("%s: adm open failed\n", __func__);
		@@ -12737,8 +12737,7 @@ static int msm_pcm_routing_prepare(struct snd_pcm_substream *substream)
		if (msm_is_fractional_resample_needed(
		sample_rate,
		bedai->sample_rate))
		adm_copp_mfc_cfg(
		bedai->port_id, copp_idx,
		adm_copp_mfc_cfg(port_id, copp_idx,
		bedai->sample_rate);

		msm_pcm_routing_build_matrix(i, session_type, path_type,
		@@ -12746,7 +12745,7 @@ static int msm_pcm_routing_prepare(struct snd_pcm_substream *substream)
		bedai->passthr_mode[i]);
		if ((fdai->perf_mode == LEGACY_PCM_MODE) &&
		(bedai->passthr_mode[i] == LEGACY_PCM))
		msm_pcm_routing_cfg_pp(bedai->port_id, copp_idx,
		msm_pcm_routing_cfg_pp(port_id, copp_idx,
		topology, channels);
		}
		}

sound/soc/msm/qdsp6v2/q6adm.c

+20 −4

Original line number	Diff line number	Diff line
		@@ -55,6 +55,7 @@ struct adm_copp {
		atomic_t channels[AFE_MAX_PORTS][MAX_COPPS_PER_PORT];
		atomic_t app_type[AFE_MAX_PORTS][MAX_COPPS_PER_PORT];
		atomic_t acdb_id[AFE_MAX_PORTS][MAX_COPPS_PER_PORT];
		atomic_t session_type[AFE_MAX_PORTS][MAX_COPPS_PER_PORT];
		wait_queue_head_t wait[AFE_MAX_PORTS][MAX_COPPS_PER_PORT];
		wait_queue_head_t adm_delay_wait[AFE_MAX_PORTS][MAX_COPPS_PER_PORT];
		atomic_t adm_delay_stat[AFE_MAX_PORTS][MAX_COPPS_PER_PORT];
		@@ -214,7 +215,8 @@ static int adm_get_copp_id(int port_idx, int copp_idx)
		}

		static int adm_get_idx_if_copp_exists(int port_idx, int topology, int mode,
		int rate, int bit_width, int app_type)
		int rate, int bit_width, int app_type,
		int session_type)
		{
		int idx;

		@@ -228,6 +230,9 @@ static int adm_get_idx_if_copp_exists(int port_idx, int topology, int mode,
		(rate == atomic_read(&this_adm.copp.rate[port_idx][idx])) &&
		(bit_width ==
		atomic_read(&this_adm.copp.bit_width[port_idx][idx])) &&
		(session_type ==
		atomic_read(
		&this_adm.copp.session_type[port_idx][idx])) &&
		(app_type ==
		atomic_read(&this_adm.copp.app_type[port_idx][idx])))
		return idx;
		@@ -1323,6 +1328,9 @@ static int32_t adm_callback(struct apr_client_data data, void priv)
		&this_adm.copp.app_type[i][j], 0);
		atomic_set(
		&this_adm.copp.acdb_id[i][j], 0);
		atomic_set(
		&this_adm.copp.session_type[i][j],
		0);
		this_adm.copp.adm_status[i][j] =
		ADM_STATUS_CALIBRATION_REQUIRED;
		}
		@@ -2367,7 +2375,8 @@ int adm_arrange_mch_ep2_map(struct adm_cmd_device_open_v6 *open_v6,
		}

		int adm_open(int port_id, int path, int rate, int channel_mode, int topology,
		int perf_mode, uint16_t bit_width, int app_type, int acdb_id)
		int perf_mode, uint16_t bit_width, int app_type, int acdb_id,
		int session_type)
		{
		struct adm_cmd_device_open_v5 open;
		struct adm_cmd_device_open_v6 open_v6;
		@@ -2426,7 +2435,8 @@ int adm_open(int port_id, int path, int rate, int channel_mode, int topology,
		rate = 16000;

		copp_idx = adm_get_idx_if_copp_exists(port_idx, topology, perf_mode,
		rate, bit_width, app_type);
		rate, bit_width, app_type,
		session_type);
		if (copp_idx < 0) {
		copp_idx = adm_get_next_available_copp(port_idx);
		if (copp_idx >= MAX_COPPS_PER_PORT) {
		@@ -2449,6 +2459,9 @@ int adm_open(int port_id, int path, int rate, int channel_mode, int topology,
		app_type);
		atomic_set(&this_adm.copp.acdb_id[port_idx][copp_idx],
		acdb_id);
		atomic_set(
		&this_adm.copp.session_type[port_idx][copp_idx],
		session_type);
		set_bit(ADM_STATUS_CALIBRATION_REQUIRED,
		(void *)&this_adm.copp.adm_status[port_idx][copp_idx]);
		if (path != ADM_PATH_COMPRESSED_RX)
		@@ -2498,7 +2511,8 @@ int adm_open(int port_id, int path, int rate, int channel_mode, int topology,
		open.endpoint_id_1 = tmp_port;
		open.endpoint_id_2 = 0xFFFF;

		if (this_adm.ec_ref_rx && (path != 1)) {
		if (this_adm.ec_ref_rx && (path != 1) &&
		(afe_get_port_type(tmp_port) == MSM_AFE_PORT_TYPE_TX)) {
		open.endpoint_id_2 = this_adm.ec_ref_rx;
		this_adm.ec_ref_rx = -1;
		}
		@@ -2980,6 +2994,7 @@ int adm_close(int port_id, int perf_mode, int copp_idx)
		atomic_set(&this_adm.copp.channels[port_idx][copp_idx], 0);
		atomic_set(&this_adm.copp.bit_width[port_idx][copp_idx], 0);
		atomic_set(&this_adm.copp.app_type[port_idx][copp_idx], 0);
		atomic_set(&this_adm.copp.session_type[port_idx][copp_idx], 0);

		clear_bit(ADM_STATUS_CALIBRATION_REQUIRED,
		(void *)&this_adm.copp.adm_status[port_idx][copp_idx]);
		@@ -4663,6 +4678,7 @@ static int __init adm_init(void)
		atomic_set(&this_adm.copp.bit_width[i][j], 0);
		atomic_set(&this_adm.copp.app_type[i][j], 0);
		atomic_set(&this_adm.copp.acdb_id[i][j], 0);
		atomic_set(&this_adm.copp.session_type[i][j], 0);
		init_waitqueue_head(&this_adm.copp.wait[i][j]);
		atomic_set(&this_adm.copp.adm_delay_stat[i][j], 0);
		init_waitqueue_head(