ASoC: SOF: handle paused streams during system suspend

During system suspend, paused streams do not get suspended.
Therefore, we need to explicitly free these PCMs in the DSP
and free the associated DAPM widgets so that they can be set
up again during resume.

Fixes: 5fcdbb2d45df ("ASoC: SOF: Add support for dynamic pipelines")
Signed-off-by: Ranjani Sridharan <ranjani.sridharan@linux.intel.com>
Reviewed-by: Paul Olaru <paul.olaru@oss.nxp.com>
Reviewed-by: Bard Liao <bard.liao@intel.com>
Reviewed-by: Pierre-Louis Bossart <pierre-louis.bossart@linux.intel.com>
Signed-off-by: Kai Vehmanen <kai.vehmanen@linux.intel.com>
Link: https://lore.kernel.org/r/20211123171606.129350-3-kai.vehmanen@linux.intel.com
Signed-off-by: Mark Brown <broonie@kernel.org>

diff --git a/sound/soc/sof/pcm.c b/sound/soc/sof/pcm.c
index 31dd79b794f15657b6755659b3494ded957192c2..0ceb1a9cbf73028f60a6e1baaa3ded10bed0eb01 100644 (file)
--- a/sound/soc/sof/pcm.c
+++ b/sound/soc/sof/pcm.c
@@ -100,9 +100,8 @@ void snd_sof_pcm_period_elapsed(struct snd_pcm_substream *substream)
 }
 EXPORT_SYMBOL(snd_sof_pcm_period_elapsed);
 
-static int sof_pcm_dsp_pcm_free(struct snd_pcm_substream *substream,
-                               struct snd_sof_dev *sdev,
-                               struct snd_sof_pcm *spcm)
+int sof_pcm_dsp_pcm_free(struct snd_pcm_substream *substream, struct snd_sof_dev *sdev,
+                        struct snd_sof_pcm *spcm)
 {
        struct sof_ipc_stream stream;
        struct sof_ipc_reply reply;

diff --git a/sound/soc/sof/sof-audio.c b/sound/soc/sof/sof-audio.c
index f4e142ec0fbd51fa4f2d4c8dbb188031d5da995f..e00ce275052f9ef3bde44b5cc2d27acea16f345a 100644 (file)
--- a/sound/soc/sof/sof-audio.c
+++ b/sound/soc/sof/sof-audio.c
@@ -129,6 +129,14 @@ int sof_widget_free(struct snd_sof_dev *sdev, struct snd_sof_widget *swidget)
        case snd_soc_dapm_buffer:
                ipc_free.hdr.cmd |= SOF_IPC_TPLG_BUFFER_FREE;
                break;
+       case snd_soc_dapm_dai_in:
+       case snd_soc_dapm_dai_out:
+       {
+               struct snd_sof_dai *dai = swidget->private;
+
+               dai->configured = false;
+               fallthrough;
+       }
        default:
                ipc_free.hdr.cmd |= SOF_IPC_TPLG_COMP_FREE;
                break;
@@ -720,6 +728,55 @@ int sof_set_up_pipelines(struct snd_sof_dev *sdev, bool verify)
        return 0;
 }
 
+/*
+ * Free the PCM, its associated widgets and set the prepared flag to false for all PCMs that
+ * did not get suspended(ex: paused streams) so the widgets can be set up again during resume.
+ */
+static int sof_tear_down_left_over_pipelines(struct snd_sof_dev *sdev)
+{
+       struct snd_sof_widget *swidget;
+       struct snd_sof_pcm *spcm;
+       int dir, ret;
+
+       /*
+        * free all PCMs and their associated DAPM widgets if their connected DAPM widget
+        * list is not NULL. This should only be true for paused streams at this point.
+        * This is equivalent to the handling of FE DAI suspend trigger for running streams.
+        */
+       list_for_each_entry(spcm, &sdev->pcm_list, list)
+               for_each_pcm_streams(dir) {
+                       struct snd_pcm_substream *substream = spcm->stream[dir].substream;
+
+                       if (!substream || !substream->runtime)
+                               continue;
+
+                       if (spcm->stream[dir].list) {
+                               ret = sof_pcm_dsp_pcm_free(substream, sdev, spcm);
+                               if (ret < 0)
+                                       return ret;
+
+                               ret = sof_widget_list_free(sdev, spcm, dir);
+                               if (ret < 0) {
+                                       dev_err(sdev->dev, "failed to free widgets during suspend\n");
+                                       return ret;
+                               }
+                       }
+               }
+
+       /*
+        * free any left over DAI widgets. This is equivalent to the handling of suspend trigger
+        * for the BE DAI for running streams.
+        */
+       list_for_each_entry(swidget, &sdev->widget_list, list)
+               if (WIDGET_IS_DAI(swidget->id) && swidget->use_count == 1) {
+                       ret = sof_widget_free(sdev, swidget);
+                       if (ret < 0)
+                               return ret;
+               }
+
+       return 0;
+}
+
 /*
  * For older firmware, this function doesn't free widgets for static pipelines during suspend.
  * It only resets use_count for all widgets.
@@ -734,8 +791,8 @@ int sof_tear_down_pipelines(struct snd_sof_dev *sdev, bool verify)
        /*
         * This function is called during suspend and for one-time topology verification during
         * first boot. In both cases, there is no need to protect swidget->use_count and
-        * sroute->setup because during suspend all streams are suspended and during topology
-        * loading the sound card unavailable to open PCMs.
+        * sroute->setup because during suspend all running streams are suspended and during
+        * topology loading the sound card unavailable to open PCMs.
         */
        list_for_each_entry(swidget, &sdev->widget_list, list) {
                if (swidget->dynamic_pipeline_widget)
@@ -754,6 +811,19 @@ int sof_tear_down_pipelines(struct snd_sof_dev *sdev, bool verify)
                        return ret;
        }
 
+       /*
+        * Tear down all pipelines associated with PCMs that did not get suspended
+        * and unset the prepare flag so that they can be set up again during resume.
+        * Skip this step for older firmware.
+        */
+       if (!verify && v->abi_version >= SOF_ABI_VER(3, 19, 0)) {
+               ret = sof_tear_down_left_over_pipelines(sdev);
+               if (ret < 0) {
+                       dev_err(sdev->dev, "failed to tear down paused pipelines\n");
+                       return ret;
+               }
+       }
+
        list_for_each_entry(sroute, &sdev->route_list, list)
                sroute->setup = false;
 

diff --git a/sound/soc/sof/sof-audio.h b/sound/soc/sof/sof-audio.h
index 389d56ac3aba528f78159c9b78d4e4772cff89fd..1c4f59d347177ac33ac26e4f82fef90077fe25cc 100644 (file)
--- a/sound/soc/sof/sof-audio.h
+++ b/sound/soc/sof/sof-audio.h
@@ -265,4 +265,6 @@ int sof_widget_free(struct snd_sof_dev *sdev, struct snd_sof_widget *swidget);
 /* PCM */
 int sof_widget_list_setup(struct snd_sof_dev *sdev, struct snd_sof_pcm *spcm, int dir);
 int sof_widget_list_free(struct snd_sof_dev *sdev, struct snd_sof_pcm *spcm, int dir);
+int sof_pcm_dsp_pcm_free(struct snd_pcm_substream *substream, struct snd_sof_dev *sdev,
+                        struct snd_sof_pcm *spcm);
 #endif