ASoC: SOF: topology: load multiple topologies

Get device information from dai links and load topology for each device.
This allow user create a topology for single device. The driver will
select the needed topologies and we don't need to create topologies for
each product.

Signed-off-by: Bard Liao <[email protected]>

sound/soc/sof/topology.c

@@ -13,6 +13,7 @@
 #include <linux/errno.h>
 #include <linux/firmware.h>
 #include <linux/workqueue.h>
+#include <sound/soc_sdw_utils.h>
 #include <sound/tlv.h>
 #include <uapi/sound/sof/tokens.h>
 #include "sof-priv.h"
@@ -2286,7 +2287,7 @@ static const struct snd_soc_tplg_bytes_ext_ops sof_bytes_ext_ops[] = {
 	{SOF_TPLG_KCTL_BYTES_VOLATILE_RO, snd_sof_bytes_ext_volatile_get},
 };
 
-static const struct snd_soc_tplg_ops sof_tplg_ops = {
+static struct snd_soc_tplg_ops sof_tplg_ops = {
 	/* external kcontrol init - used for any driver specific init */
 	.control_load	= sof_control_load,
 	.control_unload	= sof_control_unload,
@@ -2309,7 +2310,7 @@ static const struct snd_soc_tplg_ops sof_tplg_ops = {
 	.link_unload	= sof_link_unload,
 
 	/* completion - called at completion of firmware loading */
-	.complete	= sof_complete,
+	/* complete will be added in the last tplg ops */
 
 	/* manifest - optional to inform component of manifest */
 	.manifest	= sof_manifest,
@@ -2462,14 +2463,138 @@ static const struct snd_soc_tplg_ops sof_dspless_tplg_ops = {
 	.bytes_ext_ops_count = ARRAY_SIZE(sof_dspless_bytes_ext_ops),
 };
 
+#define MAX_TPLG_NUM 5
+
+enum tplg_device_id {
+	TPLG_DEVICE_SDW_JACK,
+	TPLG_DEVICE_SDW_AMP,
+	TPLG_DEVICE_SDW_MIC,
+	TPLG_DEVICE_HOST_DMIC,
+	TPLG_DEVICE_HDMI,
+};
+
+struct topology_file {
+	char *device;
+	char *file;
+	int be_id;
+};
+
 int snd_sof_load_topology(struct snd_soc_component *scomp, const char *file)
 {
 	struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
+	struct snd_sof_pdata *sof_pdata = sdev->pdata;
+	struct topology_file tplg_files[MAX_TPLG_NUM];
+	struct snd_soc_dai_link *dai_link;
+	char platform[4];
+	bool load_default_tplg = false;
+	unsigned long tplg_mask = 0;
 	const struct firmware *fw;
+	int tplg_num = 0;
+	int tplg_dev;
 	int ret;
+	int i;
 
 	dev_dbg(scomp->dev, "loading topology:%s\n", file);
 
+	sscanf(sof_pdata->tplg_filename, "sof-%3s-*.tplg", platform);
+
+	if (sdev->pdata->ipc_type == SOF_IPC_TYPE_3)
+		goto legacy_tplg;
+
+	for_each_card_prelinks(scomp->card, i, dai_link) {
+		char *tplg_device;
+
+		dev_dbg(scomp->dev, "dai_link %s id %d\n", dai_link->name, dai_link->id);
+		if (strstr(dai_link->name, "SimpleJack")) {
+			tplg_dev = TPLG_DEVICE_SDW_JACK;
+			tplg_device = "sdca-jack";
+		} else if (strstr(dai_link->name, "SmartAmp")) {
+			tplg_dev = TPLG_DEVICE_SDW_AMP;
+			tplg_device = "sdca-amp";
+		} else if (strstr(dai_link->name, "SmartMic")) {
+			tplg_dev |= TPLG_DEVICE_SDW_MIC;
+			tplg_device = "sdca-mic";
+		} else if (strstr(dai_link->name, "SDW")) {
+			int sdw_link;
+
+			sscanf(dai_link->name, "SDW%d", &sdw_link);
+			/* detect SDW device by dai_link id */
+			switch (dai_link->id) {
+			case SOC_SDW_JACK_OUT_DAI_ID:
+			case SOC_SDW_JACK_IN_DAI_ID:
+				tplg_dev = TPLG_DEVICE_SDW_JACK;
+				tplg_device = devm_kasprintf(sdev->dev, GFP_KERNEL,
+							     "sdw%d-jack", sdw_link);
+				break;
+			case SOC_SDW_AMP_OUT_DAI_ID:
+			case SOC_SDW_AMP_IN_DAI_ID:
+				tplg_dev = TPLG_DEVICE_SDW_AMP;
+				tplg_device = devm_kasprintf(sdev->dev, GFP_KERNEL,
+							     "sdw%d-amp", sdw_link);
+				break;
+			case SOC_SDW_DMIC_DAI_ID:
+				tplg_dev = TPLG_DEVICE_SDW_MIC;
+				tplg_device = devm_kasprintf(sdev->dev, GFP_KERNEL,
+							     "sdw%d-mic", sdw_link);
+				break;
+
+			}
+		} else if (strstr(dai_link->name, "DMIC")) {
+			tplg_mask = TPLG_DEVICE_HOST_DMIC;
+			tplg_device = "host-dmic";
+		} else if (strstr(dai_link->name, "iDisp")) {
+			tplg_dev = TPLG_DEVICE_HDMI;
+			tplg_device = "hdmi";
+		} else {
+			/* The dai link is not supported by sperated tplg yet */
+			load_default_tplg = true;
+			continue;
+		}
+		if (tplg_mask & BIT(tplg_dev))
+			continue;
+		tplg_mask |= BIT(tplg_dev);
+		tplg_files[tplg_num].be_id = dai_link->id;
+		tplg_files[tplg_num].device = tplg_device;
+		tplg_num++;
+	}
+	dev_dbg(scomp->dev, "tplg_mask %#lx tplg_num %d\n", tplg_mask, tplg_num);
+
+	for (i = 0; i < tplg_num; i++) {
+		tplg_files[i].file = devm_kasprintf(sdev->dev, GFP_KERNEL,
+						    "%s/sof-%s-%s-id%d.tplg",
+						    sof_pdata->tplg_filename_prefix, platform,
+						    tplg_files[i].device,
+						    tplg_files[i].be_id);
+		ret = request_firmware(&fw, tplg_files[i].file, scomp->dev);
+		dev_dbg(scomp->dev, "Requesting %d %s\n", i, tplg_files[i].file);
+		if (ret < 0) {
+			dev_warn(scomp->dev, "error: tplg request firmware %s failed err: %d\n",
+				tplg_files[i].file, ret);
+			dev_warn(scomp->dev,"Fail back to the default topology\n");
+			goto legacy_tplg;
+		}
+		/* set complete = sof_complete if it is the last topology */
+		if (!load_default_tplg && i == tplg_num - 1)
+			sof_tplg_ops.complete = sof_complete;
+		if (sdev->dspless_mode_selected)
+			ret = snd_soc_tplg_component_load(scomp, &sof_dspless_tplg_ops, fw);
+		else
+			ret = snd_soc_tplg_component_load(scomp, &sof_tplg_ops, fw);
+
+		if (ret < 0) {
+			dev_err(scomp->dev, "error: tplg component load failed %d\n",
+				ret);
+			release_firmware(fw);
+			return -EINVAL;
+		}
+
+		release_firmware(fw);
+	}
+	/* Load topology successfully, goto out */
+	if (!load_default_tplg)
+		goto out;
+
+legacy_tplg:
 	ret = request_firmware(&fw, file, scomp->dev);
 	if (ret < 0) {
 		dev_err(scomp->dev, "error: tplg request firmware %s failed err: %d\n",
@@ -2479,6 +2604,7 @@ int snd_sof_load_topology(struct snd_soc_component *scomp, const char *file)
 		return ret;
 	}
 
+	sof_tplg_ops.complete = sof_complete;
 	if (sdev->dspless_mode_selected)
 		ret = snd_soc_tplg_component_load(scomp, &sof_dspless_tplg_ops, fw);
 	else
@@ -2492,6 +2618,7 @@ int snd_sof_load_topology(struct snd_soc_component *scomp, const char *file)
 
 	release_firmware(fw);
 
+out:
 	if (ret >= 0 && sdev->led_present)
 		ret = snd_ctl_led_request();