ASoC: SOF: Probe client devices

Once FW boot is complete and the SOF PCI device probe
is complete, probe all the registered client devices.

Signed-off-by: Ranjani Sridharan <ranjani.sridharan@linux.intel.com>

Author: ranj063

sound/soc/sof/core.c

@@ -12,6 +12,7 @@
 #include <linux/module.h>
 #include <sound/soc.h>
 #include <sound/sof.h>
+#include "sof-client.h"
 #include "sof-priv.h"
 #include "ops.h"
 #if IS_ENABLED(CONFIG_SND_SOC_SOF_DEBUG_PROBES)
@@ -262,6 +263,9 @@ static int sof_probe_continue(struct snd_sof_dev *sdev)
 	if (!sof_ops(sdev)->runtime_suspend || !sof_ops(sdev)->runtime_resume)
 		pm_runtime_get_noresume(sdev->dev);
 
+	/* register SOF client devices now that FW is booted */
+	sof_client_register_devices(sdev);
+
 	if (plat_data->sof_probe_complete)
 		plat_data->sof_probe_complete(sdev->dev);
 
@@ -373,6 +377,9 @@ int snd_sof_device_remove(struct device *dev)
 		snd_sof_free_trace(sdev);
 	}
 
+	/* unregister client devices */
+	sof_client_unregister_devices(sdev);
+
 	/* unregister virtbus devices */
 	if (sdev->vdev)
 		virtbus_dev_unregister(sdev->vdev);

sound/soc/sof/sof-client.c

@@ -52,3 +52,34 @@ void sof_client_drv_unregister(const struct sof_client_drv *drv)
 	mutex_unlock(&sof_client_mutex);
 }
 EXPORT_SYMBOL_NS(sof_client_drv_unregister, SND_SOC_SOF_CLIENT);
+
+void sof_client_register_devices(struct snd_sof_dev *sdev)
+{
+	struct sof_client_dev *cdev;
+	struct sof_client_ops *ops;
+	int ret;
+
+	list_for_each_entry(cdev, &client_list, list) {
+		ops = cdev->drv->ops;
+		cdev->sdev = sdev;
+
+		/* this can fail but error cannot be propagated */
+		ret = ops->probe(cdev);
+		if (ret < 0)
+			dev_err(sdev->dev, "error: registering client device %d\n",
+				ret);
+	}
+}
+
+void sof_client_unregister_devices(struct snd_sof_dev *sdev)
+{
+	struct sof_client_dev *cdev;
+	struct sof_client_ops *ops;
+	int ret;
+
+	list_for_each_entry(cdev, &client_list, list) {
+		ops = cdev->drv->ops;
+		if (ops->remove)
+			ops->remove(cdev);
+	}
+}

sound/soc/sof/sof-client.h

@@ -42,5 +42,7 @@ struct sof_client_drv {
 int sof_client_drv_register(struct device *dev,
 			    const struct sof_client_drv *drv);
 void sof_client_drv_unregister(const struct sof_client_drv *drv);
+void sof_client_register_devices(struct snd_sof_dev *sdev);
+void sof_client_unregister_devices(struct snd_sof_dev *sdev);
 
 #endif