1b3e29075SCezary Rojewski // SPDX-License-Identifier: GPL-2.0-only
2b3e29075SCezary Rojewski //
3b3e29075SCezary Rojewski // Copyright(c) 2021-2022 Intel Corporation. All rights reserved.
4b3e29075SCezary Rojewski //
5b3e29075SCezary Rojewski // Authors: Cezary Rojewski <cezary.rojewski@intel.com>
6b3e29075SCezary Rojewski // Amadeusz Slawinski <amadeuszx.slawinski@linux.intel.com>
7b3e29075SCezary Rojewski //
8b3e29075SCezary Rojewski
9b3e29075SCezary Rojewski #include <linux/devcoredump.h>
10b3e29075SCezary Rojewski #include <linux/slab.h>
11b3e29075SCezary Rojewski #include <sound/hdaudio_ext.h>
12b3e29075SCezary Rojewski #include "avs.h"
13b3e29075SCezary Rojewski #include "messages.h"
14b3e29075SCezary Rojewski
15b3eefa5dSCezary Rojewski static int __maybe_unused
avs_skl_enable_logs(struct avs_dev * adev,enum avs_log_enable enable,u32 aging_period,u32 fifo_full_period,unsigned long resource_mask,u32 * priorities)16*b5a41d42SCezary Rojewski avs_skl_enable_logs(struct avs_dev *adev, enum avs_log_enable enable, u32 aging_period,
17b3e29075SCezary Rojewski u32 fifo_full_period, unsigned long resource_mask, u32 *priorities)
18b3e29075SCezary Rojewski {
19*b5a41d42SCezary Rojewski struct avs_skl_log_state_info *info;
20b3e29075SCezary Rojewski u32 size, num_cores = adev->hw_cfg.dsp_cores;
21b3e29075SCezary Rojewski int ret, i;
22b3e29075SCezary Rojewski
23b3e29075SCezary Rojewski if (fls_long(resource_mask) > num_cores)
24b3e29075SCezary Rojewski return -EINVAL;
25b3e29075SCezary Rojewski size = struct_size(info, logs_core, num_cores);
26b3e29075SCezary Rojewski info = kzalloc(size, GFP_KERNEL);
27b3e29075SCezary Rojewski if (!info)
28b3e29075SCezary Rojewski return -ENOMEM;
29b3e29075SCezary Rojewski
30b3e29075SCezary Rojewski info->core_mask = resource_mask;
31b3e29075SCezary Rojewski if (enable)
32bfced33eSCezary Rojewski for_each_set_bit(i, &resource_mask, num_cores) {
33b3e29075SCezary Rojewski info->logs_core[i].enable = enable;
34b3e29075SCezary Rojewski info->logs_core[i].min_priority = *priorities++;
35b3e29075SCezary Rojewski }
36b3e29075SCezary Rojewski else
37bfced33eSCezary Rojewski for_each_set_bit(i, &resource_mask, num_cores)
38b3e29075SCezary Rojewski info->logs_core[i].enable = enable;
39b3e29075SCezary Rojewski
40b3e29075SCezary Rojewski ret = avs_ipc_set_enable_logs(adev, (u8 *)info, size);
41b3e29075SCezary Rojewski kfree(info);
42b3e29075SCezary Rojewski if (ret)
43b3e29075SCezary Rojewski return AVS_IPC_RET(ret);
44b3e29075SCezary Rojewski
45b3e29075SCezary Rojewski return 0;
46b3e29075SCezary Rojewski }
47b3e29075SCezary Rojewski
avs_skl_log_buffer_offset(struct avs_dev * adev,u32 core)48*b5a41d42SCezary Rojewski int avs_skl_log_buffer_offset(struct avs_dev *adev, u32 core)
49b3e29075SCezary Rojewski {
50b3e29075SCezary Rojewski return core * avs_log_buffer_size(adev);
51b3e29075SCezary Rojewski }
52b3e29075SCezary Rojewski
53b3e29075SCezary Rojewski /* fw DbgLogWp registers */
54b3e29075SCezary Rojewski #define FW_REGS_DBG_LOG_WP(core) (0x30 + 0x4 * core)
55b3e29075SCezary Rojewski
avs_skl_log_buffer_status(struct avs_dev * adev,union avs_notify_msg * msg)56*b5a41d42SCezary Rojewski static int avs_skl_log_buffer_status(struct avs_dev *adev, union avs_notify_msg *msg)
57b3e29075SCezary Rojewski {
58b3e29075SCezary Rojewski void __iomem *buf;
59b3e29075SCezary Rojewski u16 size, write, offset;
60b3e29075SCezary Rojewski
61f7de161fSCezary Rojewski if (!avs_logging_fw(adev))
62b3e29075SCezary Rojewski return 0;
63b3e29075SCezary Rojewski
64b3e29075SCezary Rojewski size = avs_log_buffer_size(adev) / 2;
65b3e29075SCezary Rojewski write = readl(avs_sram_addr(adev, AVS_FW_REGS_WINDOW) + FW_REGS_DBG_LOG_WP(msg->log.core));
66b3e29075SCezary Rojewski /* determine buffer half */
67b3e29075SCezary Rojewski offset = (write < size) ? size : 0;
68b3e29075SCezary Rojewski
69b3e29075SCezary Rojewski /* Address is guaranteed to exist in SRAM2. */
70b3e29075SCezary Rojewski buf = avs_log_buffer_addr(adev, msg->log.core) + offset;
71f7de161fSCezary Rojewski avs_dump_fw_log_wakeup(adev, buf, size);
72b3e29075SCezary Rojewski
73b3e29075SCezary Rojewski return 0;
74b3e29075SCezary Rojewski }
75b3e29075SCezary Rojewski
avs_skl_coredump(struct avs_dev * adev,union avs_notify_msg * msg)76*b5a41d42SCezary Rojewski static int avs_skl_coredump(struct avs_dev *adev, union avs_notify_msg *msg)
77b3e29075SCezary Rojewski {
78b3e29075SCezary Rojewski u8 *dump;
79b3e29075SCezary Rojewski
80b3e29075SCezary Rojewski dump = vzalloc(AVS_FW_REGS_SIZE);
81b3e29075SCezary Rojewski if (!dump)
82b3e29075SCezary Rojewski return -ENOMEM;
83b3e29075SCezary Rojewski
84b3e29075SCezary Rojewski memcpy_fromio(dump, avs_sram_addr(adev, AVS_FW_REGS_WINDOW), AVS_FW_REGS_SIZE);
85b3e29075SCezary Rojewski dev_coredumpv(adev->dev, dump, AVS_FW_REGS_SIZE, GFP_KERNEL);
86b3e29075SCezary Rojewski
87b3e29075SCezary Rojewski return 0;
88b3e29075SCezary Rojewski }
89b3e29075SCezary Rojewski
avs_skl_d0ix_toggle(struct avs_dev * adev,struct avs_ipc_msg * tx,bool wake)90*b5a41d42SCezary Rojewski static bool avs_skl_d0ix_toggle(struct avs_dev *adev, struct avs_ipc_msg *tx, bool wake)
91b3e29075SCezary Rojewski {
92b3e29075SCezary Rojewski /* unsupported on cAVS 1.5 hw */
93b3e29075SCezary Rojewski return false;
94b3e29075SCezary Rojewski }
95b3e29075SCezary Rojewski
avs_skl_set_d0ix(struct avs_dev * adev,bool enable)96*b5a41d42SCezary Rojewski static int avs_skl_set_d0ix(struct avs_dev *adev, bool enable)
97b3e29075SCezary Rojewski {
98b3e29075SCezary Rojewski /* unsupported on cAVS 1.5 hw */
99b3e29075SCezary Rojewski return 0;
100b3e29075SCezary Rojewski }
101b3e29075SCezary Rojewski
102*b5a41d42SCezary Rojewski const struct avs_dsp_ops avs_skl_dsp_ops = {
103b3e29075SCezary Rojewski .power = avs_dsp_core_power,
104b3e29075SCezary Rojewski .reset = avs_dsp_core_reset,
105b3e29075SCezary Rojewski .stall = avs_dsp_core_stall,
106b3e29075SCezary Rojewski .irq_handler = avs_dsp_irq_handler,
107b3e29075SCezary Rojewski .irq_thread = avs_dsp_irq_thread,
108b3e29075SCezary Rojewski .int_control = avs_dsp_interrupt_control,
109b3e29075SCezary Rojewski .load_basefw = avs_cldma_load_basefw,
110b3e29075SCezary Rojewski .load_lib = avs_cldma_load_library,
111b3e29075SCezary Rojewski .transfer_mods = avs_cldma_transfer_modules,
112*b5a41d42SCezary Rojewski .log_buffer_offset = avs_skl_log_buffer_offset,
113*b5a41d42SCezary Rojewski .log_buffer_status = avs_skl_log_buffer_status,
114*b5a41d42SCezary Rojewski .coredump = avs_skl_coredump,
115*b5a41d42SCezary Rojewski .d0ix_toggle = avs_skl_d0ix_toggle,
116*b5a41d42SCezary Rojewski .set_d0ix = avs_skl_set_d0ix,
117b3eefa5dSCezary Rojewski AVS_SET_ENABLE_LOGS_OP(skl)
118b3e29075SCezary Rojewski };
119