Unverified Commit bd3df9ff authored by Peter Ujfalusi's avatar Peter Ujfalusi Committed by Mark Brown
Browse files

ASoC: SOF: ipc4: Add set_core_state pm_ops implementation 



IPC4 uses the SET_DX message to enable/disable cores managed by the DSP.
The dx_state.core_mask indicates which core is going to change state,
the dx_state.dx_mask is to power on (1) or off (0) the core.
In the dx_mask only those bits (cores) checked which bit is set in the
core_mask, other bits (cores) ignored.

Signed-off-by: default avatarPeter Ujfalusi <peter.ujfalusi@linux.intel.com>
Reviewed-by: default avatarRanjani Sridharan <ranjani.sridharan@linux.intel.com>
Reviewed-by: default avatarBard Liao <yung-chuan.liao@linux.intel.com>
Reviewed-by: default avatarPierre-Louis Bossart <pierre-louis.bossart@linux.intel.com>
Link: https://lore.kernel.org/r/20220610083549.16773-5-peter.ujfalusi@linux.intel.com


Signed-off-by: default avatarMark Brown <broonie@kernel.org>
parent 0a047daf

include/sound/sof/ipc4/header.h

+8 −0
Original line number Diff line number Diff line
@@ -385,6 +385,14 @@ struct sof_ipc4_fw_version { 
	uint16_t build;

} __packed;



/* Payload data for SOF_IPC4_MOD_SET_DX */

struct sof_ipc4_dx_state_info {

	/* core(s) to apply the change */

	uint32_t core_mask;

	/* core state: 0: put core_id to D3; 1: put core_id to D0 */

	uint32_t dx_mask;

} __packed __aligned(4);



/* Reply messages */



/*

sound/soc/sof/ipc4.c

+26 −0
Original line number Diff line number Diff line
@@ -597,10 +597,36 @@ static void sof_ipc4_rx_msg(struct snd_sof_dev *sdev) 
	}

}



static int sof_ipc4_set_core_state(struct snd_sof_dev *sdev, int core_idx, bool on)

{

	struct sof_ipc4_dx_state_info dx_state;

	struct sof_ipc4_msg msg;



	dx_state.core_mask = BIT(core_idx);

	if (on)

		dx_state.dx_mask = BIT(core_idx);

	else

		dx_state.dx_mask = 0;



	msg.primary = SOF_IPC4_MSG_TYPE_SET(SOF_IPC4_MOD_SET_DX);

	msg.primary |= SOF_IPC4_MSG_DIR(SOF_IPC4_MSG_REQUEST);

	msg.primary |= SOF_IPC4_MSG_TARGET(SOF_IPC4_MODULE_MSG);

	msg.extension = 0;

	msg.data_ptr = &dx_state;

	msg.data_size = sizeof(dx_state);



	return sof_ipc4_tx_msg(sdev, &msg, msg.data_size, NULL, 0, false);

}



static const struct sof_ipc_pm_ops ipc4_pm_ops = {

	.set_core_state = sof_ipc4_set_core_state,

};



const struct sof_ipc_ops ipc4_ops = {

	.tx_msg = sof_ipc4_tx_msg,

	.rx_msg = sof_ipc4_rx_msg,

	.set_get_data = sof_ipc4_set_get_data,

	.get_reply = sof_ipc4_get_reply,

	.pm = &ipc4_pm_ops,

	.fw_loader = &ipc4_loader_ops,

};