ASoC: Intel: sof_sdw: get sdw dmic number

The commit get the sdca sdw dmic number form the
mipi-sdca-cluster-channel-id property.
The dai link name will be used to select the function topology with a
proper dmic channel number.

Signed-off-by: Bard Liao <yung-chuan.liao@linux.intel.com>

Author: bardliao

sound/soc/intel/boards/sof_sdw.c

@@ -14,6 +14,9 @@
 #include <linux/soundwire/sdw_type.h>
 #include <linux/soundwire/sdw_intel.h>
 #include <sound/core.h>
+#include <sound/sdca.h>
+#include <sound/sdca_function.h>
+#include <sound/soc.h>
 #include <sound/soc-acpi.h>
 #include "sof_sdw_common.h"
 #include "../../codecs/rt711.h"
@@ -900,6 +903,23 @@ static const struct snd_soc_ops sdw_ops = {
 
 static const char * const type_strings[] = {"SimpleJack", "SmartAmp", "SmartMic"};
 
+static struct sdw_slave *sof_sdw_get_peripheral_by_codec_name(const char *codec_name)
+{
+	struct snd_soc_component *component;
+
+	component = snd_soc_lookup_component_by_name(codec_name);
+	if (!component)
+		return NULL;
+
+	if (is_sdw_slave(component->dev))
+		return dev_to_sdw_dev(component->dev);
+
+	if (component->dev->parent && is_sdw_slave(component->dev->parent))
+		return dev_to_sdw_dev(component->dev->parent);
+
+	return NULL;
+}
+
 static int create_sdw_dailink(struct snd_soc_card *card,
 			      struct asoc_sdw_dailink *sof_dai,
 			      struct snd_soc_dai_link **dai_links,
@@ -1011,12 +1031,46 @@ static int create_sdw_dailink(struct snd_soc_card *card,
 
 			codecs[j].name = sof_end->codec_name;
 			codecs[j].dai_name = sof_end->dai_info->dai_name;
+
 			if (sof_end->dai_info->dai_type == SOC_SDW_DAI_TYPE_MIC &&
 			    mach_params->dmic_num > 0) {
 				dev_warn(dev,
 					 "Both SDW DMIC and PCH DMIC are present, if incorrect, please set kernel params snd_sof_intel_hda_generic dmic_num=0 to disable PCH DMIC\n");
 			}
 			j++;
+
+			if (sof_end->dai_info->dai_type == SOC_SDW_DAI_TYPE_MIC) {
+				struct sdw_slave *peripheral;
+				int sdw_mic_num;
+				int k;
+
+				peripheral = sof_sdw_get_peripheral_by_codec_name(sof_end->codec_name);
+				if (!peripheral) {
+					/* Component might not be registered yet; keep default link name */
+					dev_dbg(dev, "peripheral not available for codec %s\n",
+						sof_end->codec_name);
+					continue;
+				}
+
+				for (k = 0; k < peripheral->sdca_data.num_functions; k++) {
+					if (peripheral->sdca_data.function[k].type != SDCA_FUNCTION_TYPE_SMART_MIC)
+						continue;
+
+					sdw_mic_num = sdca_get_mic_count(peripheral, &peripheral->sdca_data.function[k]);
+					dev_dbg(dev, "%s mic num %d\n", sof_end->codec_name, sdw_mic_num);
+					if (sdw_mic_num > 0 && !strstr(name, "ch")) {
+						char *tmp = name;
+						name = devm_kasprintf(dev, GFP_KERNEL, "%s-%dch", name, sdw_mic_num);
+						if (!name)
+							return -ENOMEM;
+
+						devm_kfree(dev, tmp);
+						break;
+					}
+				}
+
+			}
+
 		}
 
 		WARN_ON(i != num_cpus || j != num_codecs);
@@ -1582,3 +1636,4 @@ MODULE_AUTHOR("Pierre-Louis Bossart <pierre-louis.bossart@linux.intel.com>");
 MODULE_LICENSE("GPL v2");
 MODULE_IMPORT_NS("SND_SOC_INTEL_HDA_DSP_COMMON");
 MODULE_IMPORT_NS("SND_SOC_SDW_UTILS");
+MODULE_IMPORT_NS("SND_SOC_SDCA");