sound/soc/sof/pm.c

   1 // SPDX-License-Identifier: (GPL-2.0-only OR BSD-3-Clause)
   2 //
   3 // This file is provided under a dual BSD/GPLv2 license.  When using or
   4 // redistributing this file, you may do so under either license.
   5 //
   6 // Copyright(c) 2018 Intel Corporation. All rights reserved.
   7 //
   8 // Author: Liam Girdwood <[email protected]>
   9 //
  10
  11 #include "ops.h"
  12 #include "sof-priv.h"
  13 #include "sof-audio.h"
  14
  15 /*
  16  * Helper function to determine the target DSP state during
  17  * system suspend. This function only cares about the device
  18  * D-states. Platform-specific substates, if any, should be
  19  * handled by the platform-specific parts.
  20  */
  21 static u32 snd_sof_dsp_power_target(struct snd_sof_dev *sdev)
  22 {
  23         u32 target_dsp_state;
  24
  25         switch (sdev->system_suspend_target) {
  26         case SOF_SUSPEND_S5:
  27         case SOF_SUSPEND_S4:
  28                 /* DSP should be in D3 if the system is suspending to S3+ */
  29         case SOF_SUSPEND_S3:
  30                 /* DSP should be in D3 if the system is suspending to S3 */
  31                 target_dsp_state = SOF_DSP_PM_D3;
  32                 break;
  33         case SOF_SUSPEND_S0IX:
  34                 /*
  35                  * Currently, the only criterion for retaining the DSP in D0
  36                  * is that there are streams that ignored the suspend trigger.
  37                  * Additional criteria such Soundwire clock-stop mode and
  38                  * device suspend latency considerations will be added later.
  39                  */
  40                 if (snd_sof_stream_suspend_ignored(sdev))
  41                         target_dsp_state = SOF_DSP_PM_D0;
  42                 else
  43                         target_dsp_state = SOF_DSP_PM_D3;
  44                 break;
  45         default:
  46                 /* This case would be during runtime suspend */
  47                 target_dsp_state = SOF_DSP_PM_D3;
  48                 break;
  49         }
  50
  51         return target_dsp_state;
  52 }
  53
  54 #if IS_ENABLED(CONFIG_SND_SOC_SOF_DEBUG_ENABLE_DEBUGFS_CACHE)
  55 static void sof_cache_debugfs(struct snd_sof_dev *sdev)
  56 {
  57         struct snd_sof_dfsentry *dfse;
  58
  59         list_for_each_entry(dfse, &sdev->dfsentry_list, list) {
  60
  61                 /* nothing to do if debugfs buffer is not IO mem */
  62                 if (dfse->type == SOF_DFSENTRY_TYPE_BUF)
  63                         continue;
  64
  65                 /* cache memory that is only accessible in D0 */
  66                 if (dfse->access_type == SOF_DEBUGFS_ACCESS_D0_ONLY)
  67                         memcpy_fromio(dfse->cache_buf, dfse->io_mem,
  68                                       dfse->size);
  69         }
  70 }
  71 #endif
  72
  73 static int sof_resume(struct device *dev, bool runtime_resume)
  74 {
  75         struct snd_sof_dev *sdev = dev_get_drvdata(dev);
  76         const struct sof_ipc_pm_ops *pm_ops = sof_ipc_get_ops(sdev, pm);
  77         const struct sof_ipc_tplg_ops *tplg_ops = sof_ipc_get_ops(sdev, tplg);
  78         u32 old_state = sdev->dsp_power_state.state;
  79         int ret;
  80
  81         /* do nothing if dsp resume callbacks are not set */
  82         if (!runtime_resume && !sof_ops(sdev)->resume)
  83                 return 0;
  84
  85         if (runtime_resume && !sof_ops(sdev)->runtime_resume)
  86                 return 0;
  87
  88         /* DSP was never successfully started, nothing to resume */
  89         if (sdev->first_boot)
  90                 return 0;
  91
  92         /*
  93          * if the runtime_resume flag is set, call the runtime_resume routine
  94          * or else call the system resume routine
  95          */
  96         if (runtime_resume)
  97                 ret = snd_sof_dsp_runtime_resume(sdev);
  98         else
  99                 ret = snd_sof_dsp_resume(sdev);
 100         if (ret < 0) {
 101                 dev_err(sdev->dev,
 102                         "error: failed to power up DSP after resume\n");
 103                 return ret;
 104         }
 105
 106         if (sdev->dspless_mode_selected) {
 107                 sof_set_fw_state(sdev, SOF_DSPLESS_MODE);
 108                 return 0;
 109         }
 110
 111         /*
 112          * Nothing further to be done for platforms that support the low power
 113          * D0 substate. Resume trace and return when resuming from
 114          * low-power D0 substate
 115          */
 116         if (!runtime_resume && sof_ops(sdev)->set_power_state &&
 117             old_state == SOF_DSP_PM_D0) {
 118                 ret = sof_fw_trace_resume(sdev);
 119                 if (ret < 0)
 120                         /* non fatal */
 121                         dev_warn(sdev->dev,
 122                                  "failed to enable trace after resume %d\n", ret);
 123                 return 0;
 124         }
 125
 126         sof_set_fw_state(sdev, SOF_FW_BOOT_PREPARE);
 127
 128         /* load the firmware */
 129         ret = snd_sof_load_firmware(sdev);
 130         if (ret < 0) {
 131                 dev_err(sdev->dev,
 132                         "error: failed to load DSP firmware after resume %d\n",
 133                         ret);
 134                 sof_set_fw_state(sdev, SOF_FW_BOOT_FAILED);
 135                 return ret;
 136         }
 137
 138         sof_set_fw_state(sdev, SOF_FW_BOOT_IN_PROGRESS);
 139
 140         /*
 141          * Boot the firmware. The FW boot status will be modified
 142          * in snd_sof_run_firmware() depending on the outcome.
 143          */
 144         ret = snd_sof_run_firmware(sdev);
 145         if (ret < 0) {
 146                 dev_err(sdev->dev,
 147                         "error: failed to boot DSP firmware after resume %d\n",
 148                         ret);
 149                 sof_set_fw_state(sdev, SOF_FW_BOOT_FAILED);
 150                 return ret;
 151         }
 152
 153         /* resume DMA trace */
 154         ret = sof_fw_trace_resume(sdev);
 155         if (ret < 0) {
 156                 /* non fatal */
 157                 dev_warn(sdev->dev,
 158                          "warning: failed to init trace after resume %d\n",
 159                          ret);
 160         }
 161
 162         /* restore pipelines */
 163         if (tplg_ops && tplg_ops->set_up_all_pipelines) {
 164                 ret = tplg_ops->set_up_all_pipelines(sdev, false);
 165                 if (ret < 0) {
 166                         dev_err(sdev->dev, "Failed to restore pipeline after resume %d\n", ret);
 167                         return ret;
 168                 }
 169         }
 170
 171         /* Notify clients not managed by pm framework about core resume */
 172         sof_resume_clients(sdev);
 173
 174         /* notify DSP of system resume */
 175         if (pm_ops && pm_ops->ctx_restore) {
 176                 ret = pm_ops->ctx_restore(sdev);
 177                 if (ret < 0)
 178                         dev_err(sdev->dev, "ctx_restore IPC error during resume: %d\n", ret);
 179         }
 180
 181         return ret;
 182 }
 183
 184 static int sof_suspend(struct device *dev, bool runtime_suspend)
 185 {
 186         struct snd_sof_dev *sdev = dev_get_drvdata(dev);
 187         const struct sof_ipc_pm_ops *pm_ops = sof_ipc_get_ops(sdev, pm);
 188         const struct sof_ipc_tplg_ops *tplg_ops = sof_ipc_get_ops(sdev, tplg);
 189         pm_message_t pm_state;
 190         u32 target_state = snd_sof_dsp_power_target(sdev);
 191         u32 old_state = sdev->dsp_power_state.state;
 192         int ret;
 193
 194         /* do nothing if dsp suspend callback is not set */
 195         if (!runtime_suspend && !sof_ops(sdev)->suspend)
 196                 return 0;
 197
 198         if (runtime_suspend && !sof_ops(sdev)->runtime_suspend)
 199                 return 0;
 200
 201         /* we need to tear down pipelines only if the DSP hardware is
 202          * active, which happens for PCI devices. if the device is
 203          * suspended, it is brought back to full power and then
 204          * suspended again
 205          */
 206         if (tplg_ops && tplg_ops->tear_down_all_pipelines && (old_state == SOF_DSP_PM_D0))
 207                 tplg_ops->tear_down_all_pipelines(sdev, false);
 208
 209         if (sdev->fw_state != SOF_FW_BOOT_COMPLETE)
 210                 goto suspend;
 211
 212         /* prepare for streams to be resumed properly upon resume */
 213         if (!runtime_suspend) {
 214                 ret = snd_sof_dsp_hw_params_upon_resume(sdev);
 215                 if (ret < 0) {
 216                         dev_err(sdev->dev,
 217                                 "error: setting hw_params flag during suspend %d\n",
 218                                 ret);
 219                         return ret;
 220                 }
 221         }
 222
 223         pm_state.event = target_state;
 224
 225         /* Skip to platform-specific suspend if DSP is entering D0 */
 226         if (target_state == SOF_DSP_PM_D0) {
 227                 sof_fw_trace_suspend(sdev, pm_state);
 228                 /* Notify clients not managed by pm framework about core suspend */
 229                 sof_suspend_clients(sdev, pm_state);
 230                 goto suspend;
 231         }
 232
 233         /* suspend DMA trace */
 234         sof_fw_trace_suspend(sdev, pm_state);
 235
 236         /* Notify clients not managed by pm framework about core suspend */
 237         sof_suspend_clients(sdev, pm_state);
 238
 239 #if IS_ENABLED(CONFIG_SND_SOC_SOF_DEBUG_ENABLE_DEBUGFS_CACHE)
 240         /* cache debugfs contents during runtime suspend */
 241         if (runtime_suspend)
 242                 sof_cache_debugfs(sdev);
 243 #endif
 244         /* notify DSP of upcoming power down */
 245         if (pm_ops && pm_ops->ctx_save) {
 246                 ret = pm_ops->ctx_save(sdev);
 247                 if (ret == -EBUSY || ret == -EAGAIN) {
 248                         /*
 249                          * runtime PM has logic to handle -EBUSY/-EAGAIN so
 250                          * pass these errors up
 251                          */
 252                         dev_err(sdev->dev, "ctx_save IPC error during suspend: %d\n", ret);
 253                         return ret;
 254                 } else if (ret < 0) {
 255                         /* FW in unexpected state, continue to power down */
 256                         dev_warn(sdev->dev, "ctx_save IPC error: %d, proceeding with suspend\n",
 257                                  ret);
 258                 }
 259         }
 260
 261 suspend:
 262
 263         /* return if the DSP was not probed successfully */
 264         if (sdev->fw_state == SOF_FW_BOOT_NOT_STARTED)
 265                 return 0;
 266
 267         /* platform-specific suspend */
 268         if (runtime_suspend)
 269                 ret = snd_sof_dsp_runtime_suspend(sdev);
 270         else
 271                 ret = snd_sof_dsp_suspend(sdev, target_state);
 272         if (ret < 0)
 273                 dev_err(sdev->dev,
 274                         "error: failed to power down DSP during suspend %d\n",
 275                         ret);
 276
 277         /* Do not reset FW state if DSP is in D0 */
 278         if (target_state == SOF_DSP_PM_D0)
 279                 return ret;
 280
 281         /* reset FW state */
 282         sof_set_fw_state(sdev, SOF_FW_BOOT_NOT_STARTED);
 283         sdev->enabled_cores_mask = 0;
 284
 285         return ret;
 286 }
 287
 288 int snd_sof_dsp_power_down_notify(struct snd_sof_dev *sdev)
 289 {
 290         const struct sof_ipc_pm_ops *pm_ops = sof_ipc_get_ops(sdev, pm);
 291
 292         /* Notify DSP of upcoming power down */
 293         if (sof_ops(sdev)->remove && pm_ops && pm_ops->ctx_save)
 294                 return pm_ops->ctx_save(sdev);
 295
 296         return 0;
 297 }
 298
 299 int snd_sof_runtime_suspend(struct device *dev)
 300 {
 301         return sof_suspend(dev, true);
 302 }
 303 EXPORT_SYMBOL(snd_sof_runtime_suspend);
 304
 305 int snd_sof_runtime_idle(struct device *dev)
 306 {
 307         struct snd_sof_dev *sdev = dev_get_drvdata(dev);
 308
 309         return snd_sof_dsp_runtime_idle(sdev);
 310 }
 311 EXPORT_SYMBOL(snd_sof_runtime_idle);
 312
 313 int snd_sof_runtime_resume(struct device *dev)
 314 {
 315         return sof_resume(dev, true);
 316 }
 317 EXPORT_SYMBOL(snd_sof_runtime_resume);
 318
 319 int snd_sof_resume(struct device *dev)
 320 {
 321         return sof_resume(dev, false);
 322 }
 323 EXPORT_SYMBOL(snd_sof_resume);
 324
 325 int snd_sof_suspend(struct device *dev)
 326 {
 327         return sof_suspend(dev, false);
 328 }
 329 EXPORT_SYMBOL(snd_sof_suspend);
 330
 331 int snd_sof_prepare(struct device *dev)
 332 {
 333         struct snd_sof_dev *sdev = dev_get_drvdata(dev);
 334         const struct sof_dev_desc *desc = sdev->pdata->desc;
 335
 336         /* will suspend to S3 by default */
 337         sdev->system_suspend_target = SOF_SUSPEND_S3;
 338
 339         /*
 340          * if the firmware is crashed or boot failed then we try to aim for S3
 341          * to reboot the firmware
 342          */
 343         if (sdev->fw_state == SOF_FW_CRASHED ||
 344             sdev->fw_state == SOF_FW_BOOT_FAILED)
 345                 return 0;
 346
 347         if (!desc->use_acpi_target_states)
 348                 return 0;
 349
 350 #if defined(CONFIG_ACPI)
 351         switch (acpi_target_system_state()) {
 352         case ACPI_STATE_S0:
 353                 sdev->system_suspend_target = SOF_SUSPEND_S0IX;
 354                 break;
 355         case ACPI_STATE_S1:
 356         case ACPI_STATE_S2:
 357         case ACPI_STATE_S3:
 358                 sdev->system_suspend_target = SOF_SUSPEND_S3;
 359                 break;
 360         case ACPI_STATE_S4:
 361                 sdev->system_suspend_target = SOF_SUSPEND_S4;
 362                 break;
 363         case ACPI_STATE_S5:
 364                 sdev->system_suspend_target = SOF_SUSPEND_S5;
 365                 break;
 366         default:
 367                 break;
 368         }
 369 #endif
 370
 371         return 0;
 372 }
 373 EXPORT_SYMBOL(snd_sof_prepare);
 374
 375 void snd_sof_complete(struct device *dev)
 376 {
 377         struct snd_sof_dev *sdev = dev_get_drvdata(dev);
 378
 379         sdev->system_suspend_target = SOF_SUSPEND_NONE;
 380 }
 381 EXPORT_SYMBOL(snd_sof_complete);