[RFC PATCH 3/5] ASoC: SOF: Intel: hda: add SoundWire IP support

[Pierre-Louis Bossart]

The Core0 needs to be powered before the SoundWire IP is initialized.

Call sdw_intel_init/exit and store the context. We only have one
context, but depending on the hardware capabilities and BIOS settings
may enable multiple SoundWire links.

Signed-off-by: Pierre-Louis Bossart <pierre-louis.boss...@linux.intel.com>
---
 sound/soc/sof/intel/hda.c | 40 +++++++++++++++++++++++++++++++++------
 sound/soc/sof/intel/hda.h |  5 +++++
 2 files changed, 39 insertions(+), 6 deletions(-)

diff --git a/sound/soc/sof/intel/hda.c b/sound/soc/sof/intel/hda.c
index a968890d0754..e754058e3679 100644
--- a/sound/soc/sof/intel/hda.c
+++ b/sound/soc/sof/intel/hda.c
@@ -57,6 +57,8 @@ static int hda_sdw_init(struct snd_sof_dev *sdev)
 {
        acpi_handle handle;
        struct sdw_intel_res res;
+       struct sof_intel_hda_dev *hdev;
+       void *sdw;
 
        handle = ACPI_HANDLE(sdev->dev);
 
@@ -66,23 +68,32 @@ static int hda_sdw_init(struct snd_sof_dev *sdev)
        res.irq = sdev->ipc_irq;
        res.parent = sdev->dev;
 
-       hda_sdw_int_enable(sdev, true);
-
-       sdev->sdw = sdw_intel_init(handle, &res);
-       if (!sdev->sdw) {
+       sdw = sdw_intel_init(handle, &res);
+       if (!sdw) {
                dev_err(sdev->dev, "SDW Init failed\n");
                return -EIO;
        }
 
+       hda_sdw_int_enable(sdev, true);
+
+       /* save context */
+       hdev = sdev->pdata->hw_pdata;
+       hdev->sdw = sdw;
+
        return 0;
 }
 
 static int hda_sdw_exit(struct snd_sof_dev *sdev)
 {
+       struct sof_intel_hda_dev *hdev;
+
+       hdev = sdev->pdata->hw_pdata;
+
        hda_sdw_int_enable(sdev, false);
 
-       if (sdev->sdw)
-               sdw_intel_exit(sdev->sdw);
+       if (hdev->sdw)
+               sdw_intel_exit(hdev->sdw);
+       hdev->sdw = NULL;
 
        return 0;
 }
@@ -713,6 +724,21 @@ int hda_dsp_probe(struct snd_sof_dev *sdev)
        /* set default mailbox offset for FW ready message */
        sdev->dsp_box.offset = HDA_DSP_MBOX_UPLINK_OFFSET;
 
+       /* need to power-up core before setting-up capabilities */
+       ret = hda_dsp_core_power_up(sdev, HDA_DSP_CORE_MASK(0));
+       if (ret < 0) {
+               dev_err(sdev->dev, "error: could not power-up DSP subsystem\n");
+               goto free_ipc_irq;
+       }
+
+       /* initialize SoundWire capabilities */
+       ret = hda_sdw_init(sdev);
+       if (ret < 0) {
+               dev_err(sdev->dev, "error: SoundWire get caps error\n");
+               hda_dsp_core_power_down(sdev, HDA_DSP_CORE_MASK(0));
+               goto free_ipc_irq;
+       }
+
        return 0;
 
 free_ipc_irq:
@@ -744,6 +770,8 @@ int hda_dsp_remove(struct snd_sof_dev *sdev)
        snd_hdac_ext_bus_device_remove(bus);
 #endif
 
+       hda_sdw_exit(sdev);
+
        if (!IS_ERR_OR_NULL(hda->dmic_dev))
                platform_device_unregister(hda->dmic_dev);
 
diff --git a/sound/soc/sof/intel/hda.h b/sound/soc/sof/intel/hda.h
index c8f93317aeb4..48e09b7daf0a 100644
--- a/sound/soc/sof/intel/hda.h
+++ b/sound/soc/sof/intel/hda.h
@@ -399,6 +399,11 @@ struct sof_intel_hda_dev {
 
        /* DMIC device */
        struct platform_device *dmic_dev;
+
+#if IS_ENABLED(CONFIG_SOUNDWIRE_INTEL)
+       /* sdw context */
+       void *sdw;
+#endif
 };
 
 static inline struct hdac_bus *sof_to_bus(struct snd_sof_dev *s)
-- 
2.20.1