ASoC: SOF: topology: parse sof process mux/demux tokens

Currently sof process (dapm effect type) components have only binary
blob parameter parsing. Change sof mux/demux component to use tuples
arrays so that the parameters are easier to set in topology.

Signed-off-by: Jaska Uimonen <jaska.uimonen@linux.intel.com>

Author: Jaska Uimonen

include/sound/sof/topology.h

@@ -174,6 +174,22 @@ struct sof_ipc_comp_asrc {
 	uint32_t reserved[4];
 } __attribute__((packed));
 
+struct mux_stream_data {
+	uint32_t data_id;
+	uint32_t pipeline_id;
+	uint8_t num_channels;
+	uint8_t mask[8];
+	uint8_t reserved[3]; /* padding */
+} __packed;
+
+struct sof_mux_config {
+	uint16_t frame_format;
+	uint16_t num_channels;
+	uint16_t num_streams;
+	uint16_t reserved; /* padding to ensure proper alignment */
+	struct mux_stream_data streams[];
+} __packed;
+
 /* generic MUX component */
 struct sof_ipc_comp_mux {
 	struct sof_ipc_comp comp;

include/uapi/sound/sof/tokens.h

@@ -126,4 +126,9 @@
 #define SOF_TKN_MUTE_LED_USE			1300
 #define SOF_TKN_MUTE_LED_DIRECTION		1301
 
+#define SOF_TKN_MUX_NUM_STREAMS			1400
+#define SOF_TKN_MUX_NUM_CHANNELS		1401
+#define SOF_TKN_MUX_STREAM_PIPELINE_ID		1402
+#define SOF_TKN_MUX_STREAM_CHANNELS		1403
+
 #endif

sound/soc/sof/topology.c

@@ -486,6 +486,15 @@ static int get_token_u16(void *elem, void *object, u32 offset, u32 size)
 	return 0;
 }
 
+static int get_token_u8(void *elem, void *object, u32 offset, u32 size)
+{
+	struct snd_soc_tplg_vendor_value_elem *velem = elem;
+	u8 *val = (u8 *)object + offset;
+
+	*val = (u8)velem->value;
+	return 0;
+}
+
 static int get_token_comp_format(void *elem, void *object, u32 offset, u32 size)
 {
 	struct snd_soc_tplg_vendor_string_elem *velem = elem;
@@ -614,6 +623,22 @@ static const struct sof_topology_token stream_tokens[] = {
 		offsetof(struct snd_sof_pcm, stream[1].d0i3_compatible), 0},
 };
 
+/* Mux data */
+static const struct sof_topology_token mux_tokens[] = {
+	{SOF_TKN_MUX_NUM_CHANNELS, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
+		offsetof(struct sof_mux_config, num_channels), 0},
+	{SOF_TKN_MUX_NUM_STREAMS, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
+		offsetof(struct sof_mux_config, num_streams), 0},
+};
+
+/* Mux stream data */
+static const struct sof_topology_token mux_stream_tokens[] = {
+	{SOF_TKN_MUX_STREAM_PIPELINE_ID, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
+		offsetof(struct mux_stream_data, pipeline_id), 0},
+	{SOF_TKN_MUX_STREAM_CHANNELS, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u8,
+		offsetof(struct mux_stream_data, num_channels), 0},
+};
+
 /* Generic components */
 static const struct sof_topology_token comp_tokens[] = {
 	{SOF_TKN_COMP_PERIOD_SINK_COUNT,
@@ -2017,6 +2042,60 @@ static int sof_get_control_data(struct snd_soc_component *scomp,
 	return 0;
 }
 
+/*
+ * Sof mux/demux component
+ */
+static int sof_process_load_mux(struct snd_soc_component *scomp,
+				struct sof_ipc_comp_process *process,
+				struct snd_soc_tplg_private *private)
+{
+	struct sof_mux_config *mc = (struct sof_mux_config *)&process->data;
+	struct mux_stream_data *msd = (struct mux_stream_data *)
+		((u8 *)process->data + sizeof(struct sof_mux_config));
+	struct snd_soc_tplg_vendor_array *varray;
+	int pos = 0;
+	int ret;
+	int i;
+
+	/* parse mux config array */
+	ret = sof_parse_tokens(scomp, mc, mux_tokens,
+			       ARRAY_SIZE(mux_tokens), private->array,
+			       le32_to_cpu(private->size));
+	if (ret < 0) {
+		dev_err(scomp->dev, "error: parse mux tokens failed %d\n",
+			private->size);
+		return ret;
+	}
+
+	/* parse mux stream config arrays */
+	for (i = 0; i < mc->num_streams; i++) {
+		varray = (struct snd_soc_tplg_vendor_array *)
+			((u8 *)private->array  + pos);
+		ret = sof_parse_tokens(scomp, msd, mux_stream_tokens,
+				       ARRAY_SIZE(mux_stream_tokens),
+				       varray,
+				       le32_to_cpu(private->size) - pos);
+		if (ret < 0) {
+			dev_err(scomp->dev, "error: mux stream tokens %d\n",
+				private->size);
+			return ret;
+		}
+
+		/* track position for multiple same type arrays */
+		pos += ret;
+		msd++;
+	}
+
+	/* get the channel byte masks after stream arrays */
+	msd -= mc->num_streams;
+	for (i = 0; i < mc->num_streams; i++) {
+		memcpy(&msd->mask[0], (u8 *)private->array + pos + i * 8, 8);
+		msd++;
+	}
+
+	return ret;
+}
+
 static int sof_process_load(struct snd_soc_component *scomp, int index,
 			    struct snd_sof_widget *swidget,
 			    struct snd_soc_tplg_dapm_widget *tw,
@@ -2092,6 +2171,30 @@ static int sof_process_load(struct snd_soc_component *scomp, int index,
 
 	sof_dbg_comp_config(scomp, &process->config);
 
+	/* possible tuplet and data parsing for process components */
+	switch (type) {
+	case SOF_COMP_EQ_FIR:
+		/* fallthrough */
+	case SOF_COMP_EQ_IIR:
+		/* fallthrough */
+	case SOF_COMP_KEYWORD_DETECT:
+		/* fallthrough */
+	case SOF_COMP_KPB:
+		/* fallthrough */
+	case SOF_COMP_SELECTOR:
+		break;
+	case SOF_COMP_MUX:
+	case SOF_COMP_DEMUX:
+		offset = sof_process_load_mux(scomp, process, private);
+		break;
+	}
+
+	if (offset < 0) {
+		dev_err(scomp->dev, "error: parse process tokens failed %d\n",
+			le32_to_cpu(private->size));
+		goto err;
+	}
+
 	/*
 	 * found private data in control, so copy it.
 	 * get possible component controls - get size of all pdata,