sound/soc/sof/core.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 <liam.r.girdwood@linux.intel.com>
   9 //
  10
  11 #include <linux/firmware.h>
  12 #include <linux/module.h>
  13 #include <sound/soc.h>
  14 #include <sound/sof.h>
  15 #include "sof-priv.h"
  16 #include "ops.h"
  17
  18 #define CREATE_TRACE_POINTS
  19 #include <trace/events/sof.h>
  20
  21 /* see SOF_DBG_ flags */
  22 static int sof_core_debug =  IS_ENABLED(CONFIG_SND_SOC_SOF_DEBUG_ENABLE_FIRMWARE_TRACE);
  23 module_param_named(sof_debug, sof_core_debug, int, 0444);
  24 MODULE_PARM_DESC(sof_debug, "SOF core debug options (0x0 all off)");
  25
  26 /* SOF defaults if not provided by the platform in ms */
  27 #define TIMEOUT_DEFAULT_IPC_MS  500
  28 #define TIMEOUT_DEFAULT_BOOT_MS 2000
  29
  30 /**
  31  * sof_debug_check_flag - check if a given flag(s) is set in sof_core_debug
  32  * @mask: Flag or combination of flags to check
  33  *
  34  * Returns true if all bits set in mask is also set in sof_core_debug, otherwise
  35  * false
  36  */
  37 bool sof_debug_check_flag(int mask)
  38 {
  39         if ((sof_core_debug & mask) == mask)
  40                 return true;
  41
  42         return false;
  43 }
  44 EXPORT_SYMBOL(sof_debug_check_flag);
  45
  46 /*
  47  * FW Panic/fault handling.
  48  */
  49
  50 struct sof_panic_msg {
  51         u32 id;
  52         const char *msg;
  53 };
  54
  55 /* standard FW panic types */
  56 static const struct sof_panic_msg panic_msg[] = {
  57         {SOF_IPC_PANIC_MEM, "out of memory"},
  58         {SOF_IPC_PANIC_WORK, "work subsystem init failed"},
  59         {SOF_IPC_PANIC_IPC, "IPC subsystem init failed"},
  60         {SOF_IPC_PANIC_ARCH, "arch init failed"},
  61         {SOF_IPC_PANIC_PLATFORM, "platform init failed"},
  62         {SOF_IPC_PANIC_TASK, "scheduler init failed"},
  63         {SOF_IPC_PANIC_EXCEPTION, "runtime exception"},
  64         {SOF_IPC_PANIC_DEADLOCK, "deadlock"},
  65         {SOF_IPC_PANIC_STACK, "stack overflow"},
  66         {SOF_IPC_PANIC_IDLE, "can't enter idle"},
  67         {SOF_IPC_PANIC_WFI, "invalid wait state"},
  68         {SOF_IPC_PANIC_ASSERT, "assertion failed"},
  69 };
  70
  71 /**
  72  * sof_print_oops_and_stack - Handle the printing of DSP oops and stack trace
  73  * @sdev: Pointer to the device's sdev
  74  * @level: prink log level to use for the printing
  75  * @panic_code: the panic code
  76  * @tracep_code: tracepoint code
  77  * @oops: Pointer to DSP specific oops data
  78  * @panic_info: Pointer to the received panic information message
  79  * @stack: Pointer to the call stack data
  80  * @stack_words: Number of words in the stack data
  81  *
  82  * helper to be called from .dbg_dump callbacks. No error code is
  83  * provided, it's left as an exercise for the caller of .dbg_dump
  84  * (typically IPC or loader)
  85  */
  86 void sof_print_oops_and_stack(struct snd_sof_dev *sdev, const char *level,
  87                               u32 panic_code, u32 tracep_code, void *oops,
  88                               struct sof_ipc_panic_info *panic_info,
  89                               void *stack, size_t stack_words)
  90 {
  91         u32 code;
  92         int i;
  93
  94         /* is firmware dead ? */
  95         if ((panic_code & SOF_IPC_PANIC_MAGIC_MASK) != SOF_IPC_PANIC_MAGIC) {
  96                 dev_printk(level, sdev->dev, "unexpected fault %#010x trace %#010x\n",
  97                            panic_code, tracep_code);
  98                 return; /* no fault ? */
  99         }
 100
 101         code = panic_code & (SOF_IPC_PANIC_MAGIC_MASK | SOF_IPC_PANIC_CODE_MASK);
 102
 103         for (i = 0; i < ARRAY_SIZE(panic_msg); i++) {
 104                 if (panic_msg[i].id == code) {
 105                         dev_printk(level, sdev->dev, "reason: %s (%#x)\n",
 106                                    panic_msg[i].msg, code & SOF_IPC_PANIC_CODE_MASK);
 107                         dev_printk(level, sdev->dev, "trace point: %#010x\n", tracep_code);
 108                         goto out;
 109                 }
 110         }
 111
 112         /* unknown error */
 113         dev_printk(level, sdev->dev, "unknown panic code: %#x\n",
 114                    code & SOF_IPC_PANIC_CODE_MASK);
 115         dev_printk(level, sdev->dev, "trace point: %#010x\n", tracep_code);
 116
 117 out:
 118         dev_printk(level, sdev->dev, "panic at %s:%d\n", panic_info->filename,
 119                    panic_info->linenum);
 120         sof_oops(sdev, level, oops);
 121         sof_stack(sdev, level, oops, stack, stack_words);
 122 }
 123 EXPORT_SYMBOL(sof_print_oops_and_stack);
 124
 125 /* Helper to manage DSP state */
 126 void sof_set_fw_state(struct snd_sof_dev *sdev, enum sof_fw_state new_state)
 127 {
 128         if (sdev->fw_state == new_state)
 129                 return;
 130
 131         dev_dbg(sdev->dev, "fw_state change: %d -> %d\n", sdev->fw_state, new_state);
 132         sdev->fw_state = new_state;
 133
 134         switch (new_state) {
 135         case SOF_FW_BOOT_NOT_STARTED:
 136         case SOF_FW_BOOT_COMPLETE:
 137         case SOF_FW_CRASHED:
 138                 sof_client_fw_state_dispatcher(sdev);
 139                 fallthrough;
 140         default:
 141                 break;
 142         }
 143 }
 144 EXPORT_SYMBOL(sof_set_fw_state);
 145
 146 /*
 147  *                      FW Boot State Transition Diagram
 148  *
 149  *    +----------------------------------------------------------------------+
 150  *    |                                                                      |
 151  * ------------------        ------------------                              |
 152  * |                |        |                |                              |
 153  * |   BOOT_FAILED  |<-------|  READY_FAILED  |                              |
 154  * |                |<--+    |                |    ------------------        |
 155  * ------------------   |    ------------------    |                |        |
 156  *      ^               |           ^              |    CRASHED     |---+    |
 157  *      |               |           |              |                |   |    |
 158  * (FW Boot Timeout)    |       (FW_READY FAIL)    ------------------   |    |
 159  *      |               |           |                ^                  |    |
 160  *      |               |           |                |(DSP Panic)       |    |
 161  * ------------------   |           |              ------------------   |    |
 162  * |                |   |           |              |                |   |    |
 163  * |   IN_PROGRESS  |---------------+------------->|    COMPLETE    |   |    |
 164  * |                | (FW Boot OK)   (FW_READY OK) |                |   |    |
 165  * ------------------   |                          ------------------   |    |
 166  *      ^               |                               |               |    |
 167  *      |               |                               |               |    |
 168  * (FW Loading OK)      |                       (System Suspend/Runtime Suspend)
 169  *      |               |                               |               |    |
 170  *      |       (FW Loading Fail)                       |               |    |
 171  * ------------------   |       ------------------      |               |    |
 172  * |                |   |       |                |<-----+               |    |
 173  * |   PREPARE      |---+       |   NOT_STARTED  |<---------------------+    |
 174  * |                |           |                |<--------------------------+
 175  * ------------------           ------------------
 176  *    |     ^                       |      ^
 177  *    |     |                       |      |
 178  *    |     +-----------------------+      |
 179  *    |         (DSP Probe OK)             |
 180  *    |                                    |
 181  *    |                                    |
 182  *    +------------------------------------+
 183  *      (System Suspend/Runtime Suspend)
 184  */
 185
 186 static int sof_probe_continue(struct snd_sof_dev *sdev)
 187 {
 188         struct snd_sof_pdata *plat_data = sdev->pdata;
 189         int ret;
 190
 191         /* probe the DSP hardware */
 192         ret = snd_sof_probe(sdev);
 193         if (ret < 0) {
 194                 dev_err(sdev->dev, "error: failed to probe DSP %d\n", ret);
 195                 goto probe_err;
 196         }
 197
 198         sof_set_fw_state(sdev, SOF_FW_BOOT_PREPARE);
 199
 200         /* check machine info */
 201         ret = sof_machine_check(sdev);
 202         if (ret < 0) {
 203                 dev_err(sdev->dev, "error: failed to get machine info %d\n",
 204                         ret);
 205                 goto dsp_err;
 206         }
 207
 208         /* set up platform component driver */
 209         snd_sof_new_platform_drv(sdev);
 210
 211         if (sdev->dspless_mode_selected) {
 212                 sof_set_fw_state(sdev, SOF_DSPLESS_MODE);
 213                 goto skip_dsp_init;
 214         }
 215
 216         /* register any debug/trace capabilities */
 217         ret = snd_sof_dbg_init(sdev);
 218         if (ret < 0) {
 219                 /*
 220                  * debugfs issues are suppressed in snd_sof_dbg_init() since
 221                  * we cannot rely on debugfs
 222                  * here we trap errors due to memory allocation only.
 223                  */
 224                 dev_err(sdev->dev, "error: failed to init DSP trace/debug %d\n",
 225                         ret);
 226                 goto dbg_err;
 227         }
 228
 229         /* init the IPC */
 230         sdev->ipc = snd_sof_ipc_init(sdev);
 231         if (!sdev->ipc) {
 232                 ret = -ENOMEM;
 233                 dev_err(sdev->dev, "error: failed to init DSP IPC %d\n", ret);
 234                 goto ipc_err;
 235         }
 236
 237         /* load the firmware */
 238         ret = snd_sof_load_firmware(sdev);
 239         if (ret < 0) {
 240                 dev_err(sdev->dev, "error: failed to load DSP firmware %d\n",
 241                         ret);
 242                 sof_set_fw_state(sdev, SOF_FW_BOOT_FAILED);
 243                 goto fw_load_err;
 244         }
 245
 246         sof_set_fw_state(sdev, SOF_FW_BOOT_IN_PROGRESS);
 247
 248         /*
 249          * Boot the firmware. The FW boot status will be modified
 250          * in snd_sof_run_firmware() depending on the outcome.
 251          */
 252         ret = snd_sof_run_firmware(sdev);
 253         if (ret < 0) {
 254                 dev_err(sdev->dev, "error: failed to boot DSP firmware %d\n",
 255                         ret);
 256                 sof_set_fw_state(sdev, SOF_FW_BOOT_FAILED);
 257                 goto fw_run_err;
 258         }
 259
 260         if (sof_debug_check_flag(SOF_DBG_ENABLE_TRACE)) {
 261                 sdev->fw_trace_is_supported = true;
 262
 263                 /* init firmware tracing */
 264                 ret = sof_fw_trace_init(sdev);
 265                 if (ret < 0) {
 266                         /* non fatal */
 267                         dev_warn(sdev->dev, "failed to initialize firmware tracing %d\n",
 268                                  ret);
 269                 }
 270         } else {
 271                 dev_dbg(sdev->dev, "SOF firmware trace disabled\n");
 272         }
 273
 274 skip_dsp_init:
 275         /* hereafter all FW boot flows are for PM reasons */
 276         sdev->first_boot = false;
 277
 278         /* now register audio DSP platform driver and dai */
 279         ret = devm_snd_soc_register_component(sdev->dev, &sdev->plat_drv,
 280                                               sof_ops(sdev)->drv,
 281                                               sof_ops(sdev)->num_drv);
 282         if (ret < 0) {
 283                 dev_err(sdev->dev,
 284                         "error: failed to register DSP DAI driver %d\n", ret);
 285                 goto fw_trace_err;
 286         }
 287
 288         ret = snd_sof_machine_register(sdev, plat_data);
 289         if (ret < 0) {
 290                 dev_err(sdev->dev,
 291                         "error: failed to register machine driver %d\n", ret);
 292                 goto fw_trace_err;
 293         }
 294
 295         ret = sof_register_clients(sdev);
 296         if (ret < 0) {
 297                 dev_err(sdev->dev, "failed to register clients %d\n", ret);
 298                 goto sof_machine_err;
 299         }
 300
 301         /*
 302          * Some platforms in SOF, ex: BYT, may not have their platform PM
 303          * callbacks set. Increment the usage count so as to
 304          * prevent the device from entering runtime suspend.
 305          */
 306         if (!sof_ops(sdev)->runtime_suspend || !sof_ops(sdev)->runtime_resume)
 307                 pm_runtime_get_noresume(sdev->dev);
 308
 309         if (plat_data->sof_probe_complete)
 310                 plat_data->sof_probe_complete(sdev->dev);
 311
 312         sdev->probe_completed = true;
 313
 314         return 0;
 315
 316 sof_machine_err:
 317         snd_sof_machine_unregister(sdev, plat_data);
 318 fw_trace_err:
 319         sof_fw_trace_free(sdev);
 320 fw_run_err:
 321         snd_sof_fw_unload(sdev);
 322 fw_load_err:
 323         snd_sof_ipc_free(sdev);
 324 ipc_err:
 325 dbg_err:
 326         snd_sof_free_debug(sdev);
 327 dsp_err:
 328         snd_sof_remove(sdev);
 329 probe_err:
 330         sof_ops_free(sdev);
 331
 332         /* all resources freed, update state to match */
 333         sof_set_fw_state(sdev, SOF_FW_BOOT_NOT_STARTED);
 334         sdev->first_boot = true;
 335
 336         return ret;
 337 }
 338
 339 static void sof_probe_work(struct work_struct *work)
 340 {
 341         struct snd_sof_dev *sdev =
 342                 container_of(work, struct snd_sof_dev, probe_work);
 343         int ret;
 344
 345         ret = sof_probe_continue(sdev);
 346         if (ret < 0) {
 347                 /* errors cannot be propagated, log */
 348                 dev_err(sdev->dev, "error: %s failed err: %d\n", __func__, ret);
 349         }
 350 }
 351
 352 int snd_sof_device_probe(struct device *dev, struct snd_sof_pdata *plat_data)
 353 {
 354         struct snd_sof_dev *sdev;
 355         int ret;
 356
 357         sdev = devm_kzalloc(dev, sizeof(*sdev), GFP_KERNEL);
 358         if (!sdev)
 359                 return -ENOMEM;
 360
 361         /* initialize sof device */
 362         sdev->dev = dev;
 363
 364         /* initialize default DSP power state */
 365         sdev->dsp_power_state.state = SOF_DSP_PM_D0;
 366
 367         sdev->pdata = plat_data;
 368         sdev->first_boot = true;
 369         dev_set_drvdata(dev, sdev);
 370
 371         if (sof_core_debug)
 372                 dev_info(dev, "sof_debug value: %#x\n", sof_core_debug);
 373
 374         if (sof_debug_check_flag(SOF_DBG_DSPLESS_MODE)) {
 375                 if (plat_data->desc->dspless_mode_supported) {
 376                         dev_info(dev, "Switching to DSPless mode\n");
 377                         sdev->dspless_mode_selected = true;
 378                 } else {
 379                         dev_info(dev, "DSPless mode is not supported by the platform\n");
 380                 }
 381         }
 382
 383         /* check IPC support */
 384         if (!(BIT(plat_data->ipc_type) & plat_data->desc->ipc_supported_mask)) {
 385                 dev_err(dev, "ipc_type %d is not supported on this platform, mask is %#x\n",
 386                         plat_data->ipc_type, plat_data->desc->ipc_supported_mask);
 387                 return -EINVAL;
 388         }
 389
 390         /* init ops, if necessary */
 391         ret = sof_ops_init(sdev);
 392         if (ret < 0)
 393                 return ret;
 394
 395         /* check all mandatory ops */
 396         if (!sof_ops(sdev) || !sof_ops(sdev)->probe) {
 397                 sof_ops_free(sdev);
 398                 dev_err(dev, "missing mandatory ops\n");
 399                 return -EINVAL;
 400         }
 401
 402         if (!sdev->dspless_mode_selected &&
 403             (!sof_ops(sdev)->run || !sof_ops(sdev)->block_read ||
 404              !sof_ops(sdev)->block_write || !sof_ops(sdev)->send_msg ||
 405              !sof_ops(sdev)->load_firmware || !sof_ops(sdev)->ipc_msg_data)) {
 406                 sof_ops_free(sdev);
 407                 dev_err(dev, "missing mandatory DSP ops\n");
 408                 return -EINVAL;
 409         }
 410
 411         INIT_LIST_HEAD(&sdev->pcm_list);
 412         INIT_LIST_HEAD(&sdev->kcontrol_list);
 413         INIT_LIST_HEAD(&sdev->widget_list);
 414         INIT_LIST_HEAD(&sdev->pipeline_list);
 415         INIT_LIST_HEAD(&sdev->dai_list);
 416         INIT_LIST_HEAD(&sdev->dai_link_list);
 417         INIT_LIST_HEAD(&sdev->route_list);
 418         INIT_LIST_HEAD(&sdev->ipc_client_list);
 419         INIT_LIST_HEAD(&sdev->ipc_rx_handler_list);
 420         INIT_LIST_HEAD(&sdev->fw_state_handler_list);
 421         spin_lock_init(&sdev->ipc_lock);
 422         spin_lock_init(&sdev->hw_lock);
 423         mutex_init(&sdev->power_state_access);
 424         mutex_init(&sdev->ipc_client_mutex);
 425         mutex_init(&sdev->client_event_handler_mutex);
 426
 427         /* set default timeouts if none provided */
 428         if (plat_data->desc->ipc_timeout == 0)
 429                 sdev->ipc_timeout = TIMEOUT_DEFAULT_IPC_MS;
 430         else
 431                 sdev->ipc_timeout = plat_data->desc->ipc_timeout;
 432         if (plat_data->desc->boot_timeout == 0)
 433                 sdev->boot_timeout = TIMEOUT_DEFAULT_BOOT_MS;
 434         else
 435                 sdev->boot_timeout = plat_data->desc->boot_timeout;
 436
 437         sof_set_fw_state(sdev, SOF_FW_BOOT_NOT_STARTED);
 438
 439         if (IS_ENABLED(CONFIG_SND_SOC_SOF_PROBE_WORK_QUEUE)) {
 440                 INIT_WORK(&sdev->probe_work, sof_probe_work);
 441                 schedule_work(&sdev->probe_work);
 442                 return 0;
 443         }
 444
 445         return sof_probe_continue(sdev);
 446 }
 447 EXPORT_SYMBOL(snd_sof_device_probe);
 448
 449 bool snd_sof_device_probe_completed(struct device *dev)
 450 {
 451         struct snd_sof_dev *sdev = dev_get_drvdata(dev);
 452
 453         return sdev->probe_completed;
 454 }
 455 EXPORT_SYMBOL(snd_sof_device_probe_completed);
 456
 457 int snd_sof_device_remove(struct device *dev)
 458 {
 459         struct snd_sof_dev *sdev = dev_get_drvdata(dev);
 460         struct snd_sof_pdata *pdata = sdev->pdata;
 461         int ret;
 462         bool aborted = false;
 463
 464         if (IS_ENABLED(CONFIG_SND_SOC_SOF_PROBE_WORK_QUEUE))
 465                 aborted = cancel_work_sync(&sdev->probe_work);
 466
 467         /*
 468          * Unregister any registered client device first before IPC and debugfs
 469          * to allow client drivers to be removed cleanly
 470          */
 471         sof_unregister_clients(sdev);
 472
 473         /*
 474          * Unregister machine driver. This will unbind the snd_card which
 475          * will remove the component driver and unload the topology
 476          * before freeing the snd_card.
 477          */
 478         snd_sof_machine_unregister(sdev, pdata);
 479
 480         if (sdev->fw_state > SOF_FW_BOOT_NOT_STARTED) {
 481                 sof_fw_trace_free(sdev);
 482                 ret = snd_sof_dsp_power_down_notify(sdev);
 483                 if (ret < 0)
 484                         dev_warn(dev, "error: %d failed to prepare DSP for device removal",
 485                                  ret);
 486
 487                 snd_sof_ipc_free(sdev);
 488                 snd_sof_free_debug(sdev);
 489                 snd_sof_remove(sdev);
 490                 sof_ops_free(sdev);
 491         } else if (aborted) {
 492                 /* probe_work never ran */
 493                 sof_ops_free(sdev);
 494         }
 495
 496         /* release firmware */
 497         snd_sof_fw_unload(sdev);
 498
 499         return 0;
 500 }
 501 EXPORT_SYMBOL(snd_sof_device_remove);
 502
 503 int snd_sof_device_shutdown(struct device *dev)
 504 {
 505         struct snd_sof_dev *sdev = dev_get_drvdata(dev);
 506
 507         if (IS_ENABLED(CONFIG_SND_SOC_SOF_PROBE_WORK_QUEUE))
 508                 cancel_work_sync(&sdev->probe_work);
 509
 510         if (sdev->fw_state == SOF_FW_BOOT_COMPLETE) {
 511                 sof_fw_trace_free(sdev);
 512                 return snd_sof_shutdown(sdev);
 513         }
 514
 515         return 0;
 516 }
 517 EXPORT_SYMBOL(snd_sof_device_shutdown);
 518
 519 MODULE_AUTHOR("Liam Girdwood");
 520 MODULE_DESCRIPTION("Sound Open Firmware (SOF) Core");
 521 MODULE_LICENSE("Dual BSD/GPL");
 522 MODULE_ALIAS("platform:sof-audio");
 523 MODULE_IMPORT_NS(SND_SOC_SOF_CLIENT);