ASoC: SOF: ipc4-compress: Implement get_caps callback

Parse the codec_info from fw_config message if present and return the
supported codecs by the booted firmware.
If the codec_info is missing then only set the information regarding to
fragment sizes, numbers.

Signed-off-by: Peter Ujfalusi <peter.ujfalusi@linux.intel.com>

Author: ujfalusi

sound/soc/sof/ipc4-compress.c

@@ -157,6 +157,57 @@ static int sof_ipc4_compr_free(struct snd_soc_component *component,
 	return err;
 }
 
+#define SOF_IPC4_CODEC_INFO_GET_ID(value)	((value) & 0xff)
+#define SOF_IPC4_CODEC_INFO_GET_DIR(value)	(((value) >> 16) & 0xff)
+
+struct sof_ipc4_codec_info_data {
+	u32 count;
+	u32 items[];
+} __packed __aligned(4);
+
+static int sof_ipc4_compr_get_caps(struct snd_soc_component *component,
+				    struct snd_compr_stream *cstream,
+				    struct snd_compr_caps *caps)
+{
+	struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(component);
+	struct snd_soc_pcm_runtime *rtd = cstream->private_data;
+	struct sof_ipc4_fw_data *ipc4_data = sdev->private;
+	struct sof_ipc4_codec_info_data *fw_caps = ipc4_data->codec_info;
+	struct snd_sof_pcm *spcm;
+	int i;
+
+	spcm = snd_sof_find_spcm_dai(component, rtd);
+	if (!spcm)
+		return -EINVAL;
+
+	spcm_dbg(spcm, cstream->direction, "Entry: get_caps\n");
+
+	/* No codec information available, only fill the fragment information */
+	if (!fw_caps)
+		goto out;
+
+	for (i = 0; i < fw_caps->count; i++) {
+		int dir = SOF_IPC4_CODEC_INFO_GET_DIR(fw_caps->items[i]);
+
+		if (dir == cstream->direction) {
+			int id = SOF_IPC4_CODEC_INFO_GET_ID(fw_caps->items[i]);
+
+			spcm_dbg(spcm, cstream->direction, "codec#%d: %d\n",
+				 caps->num_codecs, id);
+			caps->codecs[caps->num_codecs++] = id;
+		}
+	}
+
+out:
+	caps->direction = cstream->direction;
+	caps->min_fragment_size = 3 * 1024;
+	caps->max_fragment_size = 16 * 1024;
+	caps->min_fragments = 4;
+	caps->max_fragments = 8;
+
+	return 0;
+}
+
 static int sof_ipc4_compr_alloc_pages(struct device *dev,
 				      struct snd_soc_component *component,
 				      struct snd_compr_stream *cstream)
@@ -535,6 +586,7 @@ static int sof_ipc4_compr_pointer(struct snd_soc_component *component,
 const struct snd_compress_ops sof_ipc4_compressed_ops = {
 	.open		= sof_ipc4_compr_open,
 	.free		= sof_ipc4_compr_free,
+	.get_caps	= sof_ipc4_compr_get_caps,
 	.set_params	= sof_ipc4_compr_set_params,
 	.get_params	= sof_ipc4_compr_get_params,
 	.trigger	= sof_ipc4_compr_trigger,