ASoC: soc_sdw_utils: skip the endpoint that doesn't present

A codec endpoint may not be used. We could check the present SDCA
functions to know if the endpoint is used or not. Skip the endpoint
which is not used.

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

Author: bardliao

sound/soc/sdw_utils/soc_sdw_utils.c

@@ -10,6 +10,7 @@
 #include <linux/module.h>
 #include <linux/soundwire/sdw.h>
 #include <linux/soundwire/sdw_type.h>
+#include <sound/sdca_function.h>
 #include <sound/soc_sdw_utils.h>
 
 static const struct snd_soc_dapm_widget generic_dmic_widgets[] = {
@@ -1132,6 +1133,24 @@ struct asoc_sdw_dailink *asoc_sdw_find_dailink(struct asoc_sdw_dailink *dailinks
 }
 EXPORT_SYMBOL_NS(asoc_sdw_find_dailink, "SND_SOC_SDW_UTILS");
 
+static int asoc_sdw_get_dai_type(u32 type) {
+	switch (type) {
+	case SDCA_FUNCTION_TYPE_SMART_AMP:
+	case SDCA_FUNCTION_TYPE_SIMPLE_AMP:
+		return SOC_SDW_DAI_TYPE_AMP;
+	case SDCA_FUNCTION_TYPE_SMART_MIC:
+	case SDCA_FUNCTION_TYPE_SIMPLE_MIC:
+	case SDCA_FUNCTION_TYPE_SPEAKER_MIC:
+		return SOC_SDW_DAI_TYPE_MIC;
+	case SDCA_FUNCTION_TYPE_UAJ:
+	case SDCA_FUNCTION_TYPE_RJ:
+	case SDCA_FUNCTION_TYPE_SIMPLE_JACK:
+		return SOC_SDW_DAI_TYPE_JACK;
+	default:
+		return -EINVAL;
+	}
+}
+
 int asoc_sdw_parse_sdw_endpoints(struct snd_soc_card *card,
 				 struct asoc_sdw_dailink *soc_dais,
 				 struct asoc_sdw_endpoint *soc_ends,
@@ -1143,8 +1162,10 @@ int asoc_sdw_parse_sdw_endpoints(struct snd_soc_card *card,
 	struct snd_soc_acpi_mach_params *mach_params = &mach->mach_params;
 	const struct snd_soc_acpi_link_adr *adr_link;
 	struct asoc_sdw_endpoint *soc_end = soc_ends;
+	struct snd_soc_dai_link_component dlc;
+	struct snd_soc_dai *codec_dai;
 	int num_dais = 0;
-	int i, j;
+	int i, j, k;
 	int ret;
 
 	for (adr_link = mach_params->links; adr_link->num_adr; adr_link++) {
@@ -1194,6 +1215,9 @@ int asoc_sdw_parse_sdw_endpoints(struct snd_soc_card *card,
 				const struct snd_soc_acpi_endpoint *adr_end;
 				const struct asoc_sdw_dai_info *dai_info;
 				struct asoc_sdw_dailink *soc_dai;
+				const char *sdw_codec_name;
+				struct sdw_slave *slave;
+				struct device *sdw_dev;
 				int stream;
 
 				adr_end = &adr_dev->endpoints[j];
@@ -1204,6 +1228,53 @@ int asoc_sdw_parse_sdw_endpoints(struct snd_soc_card *card,
 				    !(dai_info->quirk_exclude ^ !!(dai_info->quirk & ctx->mc_quirk)))
 					continue;
 
+				dlc.dai_name = dai_info->dai_name;
+				codec_dai = snd_soc_find_dai_with_mutex(&dlc);
+				if (!codec_dai) {
+					dev_err(dev, "codec dai %s not registered yet\n",
+						dlc.dai_name);
+					return -EPROBE_DEFER;
+				}
+
+				/* No need to check SDCA functions if there is only 1 endpoint present */
+				if (adr_dev->num_endpoints == 1)
+					goto skip_sdca_function_check;
+
+				sdw_codec_name = _asoc_sdw_get_codec_name(dev, codec_info, adr_link, i);
+				if (!sdw_codec_name)
+					return -ENOMEM;
+
+				sdw_dev = bus_find_device_by_name(&sdw_bus_type, NULL, sdw_codec_name);
+				if (!sdw_dev) {
+					dev_err(dev, "codec %s not found\n", sdw_codec_name);
+					return -EINVAL;
+				}
+
+				slave = dev_to_sdw_dev(sdw_dev);
+				if (!slave)
+					return -EINVAL;
+
+				/* Mack sure BIOS provides SDCA properties */
+				if (!slave->sdca_data.interface_revision)
+					goto skip_sdca_function_check;
+
+				for (k = 0; k < slave->sdca_data.num_functions; k++) {
+					int dai_type = asoc_sdw_get_dai_type(
+							slave->sdca_data.function[k].type);
+					dev_dbg(&slave->dev, "function: %s dai_type %d\n",
+						slave->sdca_data.function[k].name, dai_type);
+					if (dai_type == dai_info->dai_type) {
+						dev_dbg(&slave->dev, "DAI type %d found\n",
+							dai_type);
+						break;
+					}
+				}
+				if (k == slave->sdca_data.num_functions) {
+					dev_dbg(&slave->dev, "DAI type %d not found, skip endpoint\n",
+						dai_info->dai_type);
+					continue;
+				}
+skip_sdca_function_check:
 				dev_dbg(dev,
 					"Add dev: %d, 0x%llx end: %d, dai: %d, %c/%c to %s: %d\n",
 					ffs(adr_link->mask) - 1, adr_dev->adr,