1ceb89accSPeter Ujfalusi // SPDX-License-Identifier: (GPL-2.0-only OR BSD-3-Clause)
2ceb89accSPeter Ujfalusi //
3ceb89accSPeter Ujfalusi // This file is provided under a dual BSD/GPLv2 license. When using or
4ceb89accSPeter Ujfalusi // redistributing this file, you may do so under either license.
5ceb89accSPeter Ujfalusi //
6ceb89accSPeter Ujfalusi // Copyright(c) 2022 Intel Corporation. All rights reserved.
7ceb89accSPeter Ujfalusi //
8ceb89accSPeter Ujfalusi // Authors: Rander Wang <rander.wang@linux.intel.com>
9ceb89accSPeter Ujfalusi // Peter Ujfalusi <peter.ujfalusi@linux.intel.com>
10ceb89accSPeter Ujfalusi //
115a932cfcSPeter Ujfalusi #include <linux/firmware.h>
12ceb89accSPeter Ujfalusi #include <sound/sof/header.h>
13ceb89accSPeter Ujfalusi #include <sound/sof/ipc4/header.h>
14ceb89accSPeter Ujfalusi #include "sof-priv.h"
15ceb89accSPeter Ujfalusi #include "sof-audio.h"
164700bfb2SRander Wang #include "ipc4-fw-reg.h"
17c62ff366SRanjani Sridharan #include "ipc4-priv.h"
18ceb89accSPeter Ujfalusi #include "ops.h"
19ceb89accSPeter Ujfalusi
20ceb89accSPeter Ujfalusi static const struct sof_ipc4_fw_status {
21ceb89accSPeter Ujfalusi int status;
22ceb89accSPeter Ujfalusi char *msg;
23ceb89accSPeter Ujfalusi } ipc4_status[] = {
24ceb89accSPeter Ujfalusi {0, "The operation was successful"},
25ceb89accSPeter Ujfalusi {1, "Invalid parameter specified"},
26ceb89accSPeter Ujfalusi {2, "Unknown message type specified"},
27ceb89accSPeter Ujfalusi {3, "Not enough space in the IPC reply buffer to complete the request"},
28ceb89accSPeter Ujfalusi {4, "The system or resource is busy"},
29ceb89accSPeter Ujfalusi {5, "Replaced ADSP IPC PENDING (unused)"},
30ceb89accSPeter Ujfalusi {6, "Unknown error while processing the request"},
31ceb89accSPeter Ujfalusi {7, "Unsupported operation requested"},
32ceb89accSPeter Ujfalusi {8, "Reserved (ADSP_STAGE_UNINITIALIZED removed)"},
33ceb89accSPeter Ujfalusi {9, "Specified resource not found"},
34ceb89accSPeter Ujfalusi {10, "A resource's ID requested to be created is already assigned"},
35ceb89accSPeter Ujfalusi {11, "Reserved (ADSP_IPC_OUT_OF_MIPS removed)"},
36ceb89accSPeter Ujfalusi {12, "Required resource is in invalid state"},
37ceb89accSPeter Ujfalusi {13, "Requested power transition failed to complete"},
38ceb89accSPeter Ujfalusi {14, "Manifest of the library being loaded is invalid"},
39ceb89accSPeter Ujfalusi {15, "Requested service or data is unavailable on the target platform"},
40ceb89accSPeter Ujfalusi {42, "Library target address is out of storage memory range"},
41ceb89accSPeter Ujfalusi {43, "Reserved"},
42ceb89accSPeter Ujfalusi {44, "Image verification by CSE failed"},
43ceb89accSPeter Ujfalusi {100, "General module management error"},
44ceb89accSPeter Ujfalusi {101, "Module loading failed"},
45ceb89accSPeter Ujfalusi {102, "Integrity check of the loaded module content failed"},
46ceb89accSPeter Ujfalusi {103, "Attempt to unload code of the module in use"},
47ceb89accSPeter Ujfalusi {104, "Other failure of module instance initialization request"},
48ceb89accSPeter Ujfalusi {105, "Reserved (ADSP_IPC_OUT_OF_MIPS removed)"},
49ceb89accSPeter Ujfalusi {106, "Reserved (ADSP_IPC_CONFIG_GET_ERROR removed)"},
50ceb89accSPeter Ujfalusi {107, "Reserved (ADSP_IPC_CONFIG_SET_ERROR removed)"},
51ceb89accSPeter Ujfalusi {108, "Reserved (ADSP_IPC_LARGE_CONFIG_GET_ERROR removed)"},
52ceb89accSPeter Ujfalusi {109, "Reserved (ADSP_IPC_LARGE_CONFIG_SET_ERROR removed)"},
53ceb89accSPeter Ujfalusi {110, "Invalid (out of range) module ID provided"},
54ceb89accSPeter Ujfalusi {111, "Invalid module instance ID provided"},
55ceb89accSPeter Ujfalusi {112, "Invalid queue (pin) ID provided"},
56ceb89accSPeter Ujfalusi {113, "Invalid destination queue (pin) ID provided"},
57ceb89accSPeter Ujfalusi {114, "Reserved (ADSP_IPC_BIND_UNBIND_DST_SINK_UNSUPPORTED removed)"},
58ceb89accSPeter Ujfalusi {115, "Reserved (ADSP_IPC_UNLOAD_INST_EXISTS removed)"},
59ceb89accSPeter Ujfalusi {116, "Invalid target code ID provided"},
60ceb89accSPeter Ujfalusi {117, "Injection DMA buffer is too small for probing the input pin"},
61ceb89accSPeter Ujfalusi {118, "Extraction DMA buffer is too small for probing the output pin"},
62ceb89accSPeter Ujfalusi {120, "Invalid ID of configuration item provided in TLV list"},
63ceb89accSPeter Ujfalusi {121, "Invalid length of configuration item provided in TLV list"},
64ceb89accSPeter Ujfalusi {122, "Invalid structure of configuration item provided"},
65ceb89accSPeter Ujfalusi {140, "Initialization of DMA Gateway failed"},
66ceb89accSPeter Ujfalusi {141, "Invalid ID of gateway provided"},
67ceb89accSPeter Ujfalusi {142, "Setting state of DMA Gateway failed"},
68ceb89accSPeter Ujfalusi {143, "DMA_CONTROL message targeting gateway not allocated yet"},
69ceb89accSPeter Ujfalusi {150, "Attempt to configure SCLK while I2S port is running"},
70ceb89accSPeter Ujfalusi {151, "Attempt to configure MCLK while I2S port is running"},
71ceb89accSPeter Ujfalusi {152, "Attempt to stop SCLK that is not running"},
72ceb89accSPeter Ujfalusi {153, "Attempt to stop MCLK that is not running"},
73ceb89accSPeter Ujfalusi {160, "Reserved (ADSP_IPC_PIPELINE_NOT_INITIALIZED removed)"},
74ceb89accSPeter Ujfalusi {161, "Reserved (ADSP_IPC_PIPELINE_NOT_EXIST removed)"},
75ceb89accSPeter Ujfalusi {162, "Reserved (ADSP_IPC_PIPELINE_SAVE_FAILED removed)"},
76ceb89accSPeter Ujfalusi {163, "Reserved (ADSP_IPC_PIPELINE_RESTORE_FAILED removed)"},
77ceb89accSPeter Ujfalusi {165, "Reserved (ADSP_IPC_PIPELINE_ALREADY_EXISTS removed)"},
78ceb89accSPeter Ujfalusi };
79ceb89accSPeter Ujfalusi
sof_ipc4_check_reply_status(struct snd_sof_dev * sdev,u32 status)80ceb89accSPeter Ujfalusi static int sof_ipc4_check_reply_status(struct snd_sof_dev *sdev, u32 status)
81ceb89accSPeter Ujfalusi {
82ceb89accSPeter Ujfalusi int i, ret;
83ceb89accSPeter Ujfalusi
84ceb89accSPeter Ujfalusi status &= SOF_IPC4_REPLY_STATUS;
85ceb89accSPeter Ujfalusi
86ceb89accSPeter Ujfalusi if (!status)
87ceb89accSPeter Ujfalusi return 0;
88ceb89accSPeter Ujfalusi
89ceb89accSPeter Ujfalusi for (i = 0; i < ARRAY_SIZE(ipc4_status); i++) {
90ceb89accSPeter Ujfalusi if (ipc4_status[i].status == status) {
91ceb89accSPeter Ujfalusi dev_err(sdev->dev, "FW reported error: %u - %s\n",
92ceb89accSPeter Ujfalusi status, ipc4_status[i].msg);
93ceb89accSPeter Ujfalusi goto to_errno;
94ceb89accSPeter Ujfalusi }
95ceb89accSPeter Ujfalusi }
96ceb89accSPeter Ujfalusi
97ceb89accSPeter Ujfalusi if (i == ARRAY_SIZE(ipc4_status))
98ceb89accSPeter Ujfalusi dev_err(sdev->dev, "FW reported error: %u - Unknown\n", status);
99ceb89accSPeter Ujfalusi
100ceb89accSPeter Ujfalusi to_errno:
101ceb89accSPeter Ujfalusi switch (status) {
102ceb89accSPeter Ujfalusi case 8:
103ceb89accSPeter Ujfalusi case 11:
104ceb89accSPeter Ujfalusi case 105 ... 109:
105ceb89accSPeter Ujfalusi case 114 ... 115:
106ceb89accSPeter Ujfalusi case 160 ... 163:
107ceb89accSPeter Ujfalusi case 165:
108ceb89accSPeter Ujfalusi ret = -ENOENT;
109ceb89accSPeter Ujfalusi break;
110ceb89accSPeter Ujfalusi case 4:
111ceb89accSPeter Ujfalusi case 150:
112ceb89accSPeter Ujfalusi case 151:
113ceb89accSPeter Ujfalusi ret = -EBUSY;
114ceb89accSPeter Ujfalusi break;
115ceb89accSPeter Ujfalusi default:
116ceb89accSPeter Ujfalusi ret = -EINVAL;
117ceb89accSPeter Ujfalusi break;
118ceb89accSPeter Ujfalusi }
119ceb89accSPeter Ujfalusi
120ceb89accSPeter Ujfalusi return ret;
121ceb89accSPeter Ujfalusi }
122ceb89accSPeter Ujfalusi
123ceb89accSPeter Ujfalusi #if IS_ENABLED(CONFIG_SND_SOC_SOF_DEBUG_VERBOSE_IPC)
124ceb89accSPeter Ujfalusi #define DBG_IPC4_MSG_TYPE_ENTRY(type) [SOF_IPC4_##type] = #type
125ceb89accSPeter Ujfalusi static const char * const ipc4_dbg_mod_msg_type[] = {
126ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(MOD_INIT_INSTANCE),
127ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(MOD_CONFIG_GET),
128ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(MOD_CONFIG_SET),
129ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(MOD_LARGE_CONFIG_GET),
130ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(MOD_LARGE_CONFIG_SET),
131ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(MOD_BIND),
132ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(MOD_UNBIND),
133ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(MOD_SET_DX),
134ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(MOD_SET_D0IX),
135ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(MOD_ENTER_MODULE_RESTORE),
136ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(MOD_EXIT_MODULE_RESTORE),
137ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(MOD_DELETE_INSTANCE),
138ceb89accSPeter Ujfalusi };
139ceb89accSPeter Ujfalusi
140ceb89accSPeter Ujfalusi static const char * const ipc4_dbg_glb_msg_type[] = {
141ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(GLB_BOOT_CONFIG),
142ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(GLB_ROM_CONTROL),
143ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(GLB_IPCGATEWAY_CMD),
144ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(GLB_PERF_MEASUREMENTS_CMD),
145ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(GLB_CHAIN_DMA),
146ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(GLB_LOAD_MULTIPLE_MODULES),
147ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(GLB_UNLOAD_MULTIPLE_MODULES),
148ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(GLB_CREATE_PIPELINE),
149ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(GLB_DELETE_PIPELINE),
150ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(GLB_SET_PIPELINE_STATE),
151ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(GLB_GET_PIPELINE_STATE),
152ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(GLB_GET_PIPELINE_CONTEXT_SIZE),
153ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(GLB_SAVE_PIPELINE),
154ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(GLB_RESTORE_PIPELINE),
155ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(GLB_LOAD_LIBRARY),
156ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(GLB_INTERNAL_MESSAGE),
157ceb89accSPeter Ujfalusi DBG_IPC4_MSG_TYPE_ENTRY(GLB_NOTIFICATION),
158ceb89accSPeter Ujfalusi };
159ceb89accSPeter Ujfalusi
160ceb89accSPeter Ujfalusi #define DBG_IPC4_NOTIFICATION_TYPE_ENTRY(type) [SOF_IPC4_NOTIFY_##type] = #type
161ceb89accSPeter Ujfalusi static const char * const ipc4_dbg_notification_type[] = {
162ceb89accSPeter Ujfalusi DBG_IPC4_NOTIFICATION_TYPE_ENTRY(PHRASE_DETECTED),
163ceb89accSPeter Ujfalusi DBG_IPC4_NOTIFICATION_TYPE_ENTRY(RESOURCE_EVENT),
164ceb89accSPeter Ujfalusi DBG_IPC4_NOTIFICATION_TYPE_ENTRY(LOG_BUFFER_STATUS),
165ceb89accSPeter Ujfalusi DBG_IPC4_NOTIFICATION_TYPE_ENTRY(TIMESTAMP_CAPTURED),
166ceb89accSPeter Ujfalusi DBG_IPC4_NOTIFICATION_TYPE_ENTRY(FW_READY),
167ceb89accSPeter Ujfalusi DBG_IPC4_NOTIFICATION_TYPE_ENTRY(FW_AUD_CLASS_RESULT),
168ceb89accSPeter Ujfalusi DBG_IPC4_NOTIFICATION_TYPE_ENTRY(EXCEPTION_CAUGHT),
169ceb89accSPeter Ujfalusi DBG_IPC4_NOTIFICATION_TYPE_ENTRY(MODULE_NOTIFICATION),
170ceb89accSPeter Ujfalusi DBG_IPC4_NOTIFICATION_TYPE_ENTRY(PROBE_DATA_AVAILABLE),
171ceb89accSPeter Ujfalusi DBG_IPC4_NOTIFICATION_TYPE_ENTRY(ASYNC_MSG_SRVC_MESSAGE),
172ceb89accSPeter Ujfalusi };
173ceb89accSPeter Ujfalusi
sof_ipc4_log_header(struct device * dev,u8 * text,struct sof_ipc4_msg * msg,bool data_size_valid)174ceb89accSPeter Ujfalusi static void sof_ipc4_log_header(struct device *dev, u8 *text, struct sof_ipc4_msg *msg,
175ceb89accSPeter Ujfalusi bool data_size_valid)
176ceb89accSPeter Ujfalusi {
177ceb89accSPeter Ujfalusi u32 val, type;
178ceb89accSPeter Ujfalusi const u8 *str2 = NULL;
179ceb89accSPeter Ujfalusi const u8 *str = NULL;
180ceb89accSPeter Ujfalusi
181ceb89accSPeter Ujfalusi val = msg->primary & SOF_IPC4_MSG_TARGET_MASK;
182ceb89accSPeter Ujfalusi type = SOF_IPC4_MSG_TYPE_GET(msg->primary);
183ceb89accSPeter Ujfalusi
184ceb89accSPeter Ujfalusi if (val == SOF_IPC4_MSG_TARGET(SOF_IPC4_MODULE_MSG)) {
185ceb89accSPeter Ujfalusi /* Module message */
186ceb89accSPeter Ujfalusi if (type < SOF_IPC4_MOD_TYPE_LAST)
187ceb89accSPeter Ujfalusi str = ipc4_dbg_mod_msg_type[type];
188ceb89accSPeter Ujfalusi if (!str)
189ceb89accSPeter Ujfalusi str = "Unknown Module message type";
190ceb89accSPeter Ujfalusi } else {
191ceb89accSPeter Ujfalusi /* Global FW message */
192ceb89accSPeter Ujfalusi if (type < SOF_IPC4_GLB_TYPE_LAST)
193ceb89accSPeter Ujfalusi str = ipc4_dbg_glb_msg_type[type];
194ceb89accSPeter Ujfalusi if (!str)
195ceb89accSPeter Ujfalusi str = "Unknown Global message type";
196ceb89accSPeter Ujfalusi
197ceb89accSPeter Ujfalusi if (type == SOF_IPC4_GLB_NOTIFICATION) {
198ceb89accSPeter Ujfalusi /* Notification message */
199ceb89accSPeter Ujfalusi u32 notif = SOF_IPC4_NOTIFICATION_TYPE_GET(msg->primary);
200ceb89accSPeter Ujfalusi
201621a3f77SPeter Ujfalusi /* Do not print log buffer notification if not desired */
202621a3f77SPeter Ujfalusi if (notif == SOF_IPC4_NOTIFY_LOG_BUFFER_STATUS &&
203621a3f77SPeter Ujfalusi !sof_debug_check_flag(SOF_DBG_PRINT_DMA_POSITION_UPDATE_LOGS))
204621a3f77SPeter Ujfalusi return;
205621a3f77SPeter Ujfalusi
206ceb89accSPeter Ujfalusi if (notif < SOF_IPC4_NOTIFY_TYPE_LAST)
207ceb89accSPeter Ujfalusi str2 = ipc4_dbg_notification_type[notif];
208ceb89accSPeter Ujfalusi if (!str2)
209ceb89accSPeter Ujfalusi str2 = "Unknown Global notification";
210ceb89accSPeter Ujfalusi }
211ceb89accSPeter Ujfalusi }
212ceb89accSPeter Ujfalusi
213ceb89accSPeter Ujfalusi if (str2) {
214ceb89accSPeter Ujfalusi if (data_size_valid && msg->data_size)
215ceb89accSPeter Ujfalusi dev_dbg(dev, "%s: %#x|%#x: %s|%s [data size: %zu]\n",
216ceb89accSPeter Ujfalusi text, msg->primary, msg->extension, str, str2,
217ceb89accSPeter Ujfalusi msg->data_size);
218ceb89accSPeter Ujfalusi else
219ceb89accSPeter Ujfalusi dev_dbg(dev, "%s: %#x|%#x: %s|%s\n", text, msg->primary,
220ceb89accSPeter Ujfalusi msg->extension, str, str2);
221ceb89accSPeter Ujfalusi } else {
222ceb89accSPeter Ujfalusi if (data_size_valid && msg->data_size)
223ceb89accSPeter Ujfalusi dev_dbg(dev, "%s: %#x|%#x: %s [data size: %zu]\n",
224ceb89accSPeter Ujfalusi text, msg->primary, msg->extension, str,
225ceb89accSPeter Ujfalusi msg->data_size);
226ceb89accSPeter Ujfalusi else
227ceb89accSPeter Ujfalusi dev_dbg(dev, "%s: %#x|%#x: %s\n", text, msg->primary,
228ceb89accSPeter Ujfalusi msg->extension, str);
229ceb89accSPeter Ujfalusi }
230ceb89accSPeter Ujfalusi }
231ceb89accSPeter Ujfalusi #else /* CONFIG_SND_SOC_SOF_DEBUG_VERBOSE_IPC */
sof_ipc4_log_header(struct device * dev,u8 * text,struct sof_ipc4_msg * msg,bool data_size_valid)232ceb89accSPeter Ujfalusi static void sof_ipc4_log_header(struct device *dev, u8 *text, struct sof_ipc4_msg *msg,
233ceb89accSPeter Ujfalusi bool data_size_valid)
234ceb89accSPeter Ujfalusi {
235621a3f77SPeter Ujfalusi /* Do not print log buffer notification if not desired */
236621a3f77SPeter Ujfalusi if (!sof_debug_check_flag(SOF_DBG_PRINT_DMA_POSITION_UPDATE_LOGS) &&
237621a3f77SPeter Ujfalusi !SOF_IPC4_MSG_IS_MODULE_MSG(msg->primary) &&
238621a3f77SPeter Ujfalusi SOF_IPC4_MSG_TYPE_GET(msg->primary) == SOF_IPC4_GLB_NOTIFICATION &&
239621a3f77SPeter Ujfalusi SOF_IPC4_NOTIFICATION_TYPE_GET(msg->primary) == SOF_IPC4_NOTIFY_LOG_BUFFER_STATUS)
240621a3f77SPeter Ujfalusi return;
241621a3f77SPeter Ujfalusi
242ceb89accSPeter Ujfalusi if (data_size_valid && msg->data_size)
243ceb89accSPeter Ujfalusi dev_dbg(dev, "%s: %#x|%#x [data size: %zu]\n", text,
244ceb89accSPeter Ujfalusi msg->primary, msg->extension, msg->data_size);
245ceb89accSPeter Ujfalusi else
246ceb89accSPeter Ujfalusi dev_dbg(dev, "%s: %#x|%#x\n", text, msg->primary, msg->extension);
247ceb89accSPeter Ujfalusi }
248ceb89accSPeter Ujfalusi #endif
249ceb89accSPeter Ujfalusi
sof_ipc4_dump_payload(struct snd_sof_dev * sdev,void * ipc_data,size_t size)250c3d275e3SPeter Ujfalusi static void sof_ipc4_dump_payload(struct snd_sof_dev *sdev,
251c3d275e3SPeter Ujfalusi void *ipc_data, size_t size)
252c3d275e3SPeter Ujfalusi {
253c3d275e3SPeter Ujfalusi print_hex_dump_debug("Message payload: ", DUMP_PREFIX_OFFSET,
254c3d275e3SPeter Ujfalusi 16, 4, ipc_data, size, false);
255c3d275e3SPeter Ujfalusi }
256c3d275e3SPeter Ujfalusi
sof_ipc4_get_reply(struct snd_sof_dev * sdev)257ceb89accSPeter Ujfalusi static int sof_ipc4_get_reply(struct snd_sof_dev *sdev)
258ceb89accSPeter Ujfalusi {
259ceb89accSPeter Ujfalusi struct snd_sof_ipc_msg *msg = sdev->msg;
260ceb89accSPeter Ujfalusi struct sof_ipc4_msg *ipc4_reply;
261ceb89accSPeter Ujfalusi int ret;
262ceb89accSPeter Ujfalusi
263ceb89accSPeter Ujfalusi /* get the generic reply */
264ceb89accSPeter Ujfalusi ipc4_reply = msg->reply_data;
265ceb89accSPeter Ujfalusi
266ceb89accSPeter Ujfalusi sof_ipc4_log_header(sdev->dev, "ipc tx reply", ipc4_reply, false);
267ceb89accSPeter Ujfalusi
268ceb89accSPeter Ujfalusi ret = sof_ipc4_check_reply_status(sdev, ipc4_reply->primary);
269ceb89accSPeter Ujfalusi if (ret)
270ceb89accSPeter Ujfalusi return ret;
271ceb89accSPeter Ujfalusi
272ceb89accSPeter Ujfalusi /* No other information is expected for non large config get replies */
273ceb89accSPeter Ujfalusi if (!msg->reply_size || !SOF_IPC4_MSG_IS_MODULE_MSG(ipc4_reply->primary) ||
274ceb89accSPeter Ujfalusi (SOF_IPC4_MSG_TYPE_GET(ipc4_reply->primary) != SOF_IPC4_MOD_LARGE_CONFIG_GET))
275ceb89accSPeter Ujfalusi return 0;
276ceb89accSPeter Ujfalusi
277ceb89accSPeter Ujfalusi /* Read the requested payload */
278ceb89accSPeter Ujfalusi snd_sof_dsp_mailbox_read(sdev, sdev->dsp_box.offset, ipc4_reply->data_ptr,
279ceb89accSPeter Ujfalusi msg->reply_size);
280ceb89accSPeter Ujfalusi
281ceb89accSPeter Ujfalusi return 0;
282ceb89accSPeter Ujfalusi }
283ceb89accSPeter Ujfalusi
284ceb89accSPeter Ujfalusi /* wait for IPC message reply */
ipc4_wait_tx_done(struct snd_sof_ipc * ipc,void * reply_data)285ceb89accSPeter Ujfalusi static int ipc4_wait_tx_done(struct snd_sof_ipc *ipc, void *reply_data)
286ceb89accSPeter Ujfalusi {
287ceb89accSPeter Ujfalusi struct snd_sof_ipc_msg *msg = &ipc->msg;
288ceb89accSPeter Ujfalusi struct sof_ipc4_msg *ipc4_msg = msg->msg_data;
289ceb89accSPeter Ujfalusi struct snd_sof_dev *sdev = ipc->sdev;
290ceb89accSPeter Ujfalusi int ret;
291ceb89accSPeter Ujfalusi
292ceb89accSPeter Ujfalusi /* wait for DSP IPC completion */
293ceb89accSPeter Ujfalusi ret = wait_event_timeout(msg->waitq, msg->ipc_complete,
294ceb89accSPeter Ujfalusi msecs_to_jiffies(sdev->ipc_timeout));
295ceb89accSPeter Ujfalusi if (ret == 0) {
296ceb89accSPeter Ujfalusi dev_err(sdev->dev, "ipc timed out for %#x|%#x\n",
297ceb89accSPeter Ujfalusi ipc4_msg->primary, ipc4_msg->extension);
2984245fdbaSPeter Ujfalusi snd_sof_handle_fw_exception(ipc->sdev, "IPC timeout");
299ceb89accSPeter Ujfalusi return -ETIMEDOUT;
300ceb89accSPeter Ujfalusi }
301ceb89accSPeter Ujfalusi
302ceb89accSPeter Ujfalusi if (msg->reply_error) {
303ceb89accSPeter Ujfalusi dev_err(sdev->dev, "ipc error for msg %#x|%#x\n",
304ceb89accSPeter Ujfalusi ipc4_msg->primary, ipc4_msg->extension);
305ceb89accSPeter Ujfalusi ret = msg->reply_error;
306ceb89accSPeter Ujfalusi } else {
307ceb89accSPeter Ujfalusi if (reply_data) {
308ceb89accSPeter Ujfalusi struct sof_ipc4_msg *ipc4_reply = msg->reply_data;
309ceb89accSPeter Ujfalusi struct sof_ipc4_msg *ipc4_reply_data = reply_data;
310ceb89accSPeter Ujfalusi
311ceb89accSPeter Ujfalusi /* Copy the header */
312ceb89accSPeter Ujfalusi ipc4_reply_data->header_u64 = ipc4_reply->header_u64;
313ceb89accSPeter Ujfalusi if (msg->reply_size && ipc4_reply_data->data_ptr) {
314ceb89accSPeter Ujfalusi /* copy the payload returned from DSP */
315ceb89accSPeter Ujfalusi memcpy(ipc4_reply_data->data_ptr, ipc4_reply->data_ptr,
316ceb89accSPeter Ujfalusi msg->reply_size);
317ceb89accSPeter Ujfalusi ipc4_reply_data->data_size = msg->reply_size;
318ceb89accSPeter Ujfalusi }
319ceb89accSPeter Ujfalusi }
320ceb89accSPeter Ujfalusi
321ceb89accSPeter Ujfalusi ret = 0;
322ceb89accSPeter Ujfalusi sof_ipc4_log_header(sdev->dev, "ipc tx done ", ipc4_msg, true);
323ceb89accSPeter Ujfalusi }
324ceb89accSPeter Ujfalusi
325ceb89accSPeter Ujfalusi /* re-enable dumps after successful IPC tx */
326ceb89accSPeter Ujfalusi if (sdev->ipc_dump_printed) {
327ceb89accSPeter Ujfalusi sdev->dbg_dump_printed = false;
328ceb89accSPeter Ujfalusi sdev->ipc_dump_printed = false;
329ceb89accSPeter Ujfalusi }
330ceb89accSPeter Ujfalusi
331ceb89accSPeter Ujfalusi return ret;
332ceb89accSPeter Ujfalusi }
333ceb89accSPeter Ujfalusi
ipc4_tx_msg_unlocked(struct snd_sof_ipc * ipc,void * msg_data,size_t msg_bytes,void * reply_data,size_t reply_bytes)334ceb89accSPeter Ujfalusi static int ipc4_tx_msg_unlocked(struct snd_sof_ipc *ipc,
335ceb89accSPeter Ujfalusi void *msg_data, size_t msg_bytes,
336ceb89accSPeter Ujfalusi void *reply_data, size_t reply_bytes)
337ceb89accSPeter Ujfalusi {
338ceb89accSPeter Ujfalusi struct sof_ipc4_msg *ipc4_msg = msg_data;
339ceb89accSPeter Ujfalusi struct snd_sof_dev *sdev = ipc->sdev;
340ceb89accSPeter Ujfalusi int ret;
341ceb89accSPeter Ujfalusi
342ceb89accSPeter Ujfalusi if (msg_bytes > ipc->max_payload_size || reply_bytes > ipc->max_payload_size)
343ceb89accSPeter Ujfalusi return -EINVAL;
344ceb89accSPeter Ujfalusi
3452d91d571SPeter Ujfalusi sof_ipc4_log_header(sdev->dev, "ipc tx ", msg_data, true);
3462d91d571SPeter Ujfalusi
347ceb89accSPeter Ujfalusi ret = sof_ipc_send_msg(sdev, msg_data, msg_bytes, reply_bytes);
348ceb89accSPeter Ujfalusi if (ret) {
349ceb89accSPeter Ujfalusi dev_err_ratelimited(sdev->dev,
350ceb89accSPeter Ujfalusi "%s: ipc message send for %#x|%#x failed: %d\n",
351ceb89accSPeter Ujfalusi __func__, ipc4_msg->primary, ipc4_msg->extension, ret);
352ceb89accSPeter Ujfalusi return ret;
353ceb89accSPeter Ujfalusi }
354ceb89accSPeter Ujfalusi
355ceb89accSPeter Ujfalusi /* now wait for completion */
356ceb89accSPeter Ujfalusi return ipc4_wait_tx_done(ipc, reply_data);
357ceb89accSPeter Ujfalusi }
358ceb89accSPeter Ujfalusi
sof_ipc4_tx_msg(struct snd_sof_dev * sdev,void * msg_data,size_t msg_bytes,void * reply_data,size_t reply_bytes,bool no_pm)359ceb89accSPeter Ujfalusi static int sof_ipc4_tx_msg(struct snd_sof_dev *sdev, void *msg_data, size_t msg_bytes,
360ceb89accSPeter Ujfalusi void *reply_data, size_t reply_bytes, bool no_pm)
361ceb89accSPeter Ujfalusi {
362ceb89accSPeter Ujfalusi struct snd_sof_ipc *ipc = sdev->ipc;
363ceb89accSPeter Ujfalusi int ret;
364ceb89accSPeter Ujfalusi
365ceb89accSPeter Ujfalusi if (!msg_data)
366ceb89accSPeter Ujfalusi return -EINVAL;
367ceb89accSPeter Ujfalusi
3681c91e927SRander Wang if (!no_pm) {
3691c91e927SRander Wang const struct sof_dsp_power_state target_state = {
3701c91e927SRander Wang .state = SOF_DSP_PM_D0,
3711c91e927SRander Wang };
3721c91e927SRander Wang
3731c91e927SRander Wang /* ensure the DSP is in D0i0 before sending a new IPC */
3741c91e927SRander Wang ret = snd_sof_dsp_set_power_state(sdev, &target_state);
3751c91e927SRander Wang if (ret < 0)
3761c91e927SRander Wang return ret;
3771c91e927SRander Wang }
3781c91e927SRander Wang
379ceb89accSPeter Ujfalusi /* Serialise IPC TX */
380ceb89accSPeter Ujfalusi mutex_lock(&ipc->tx_mutex);
381ceb89accSPeter Ujfalusi
382ceb89accSPeter Ujfalusi ret = ipc4_tx_msg_unlocked(ipc, msg_data, msg_bytes, reply_data, reply_bytes);
383ceb89accSPeter Ujfalusi
384c3d275e3SPeter Ujfalusi if (sof_debug_check_flag(SOF_DBG_DUMP_IPC_MESSAGE_PAYLOAD)) {
385c3d275e3SPeter Ujfalusi struct sof_ipc4_msg *msg = NULL;
386ceb89accSPeter Ujfalusi
387ceb89accSPeter Ujfalusi /* payload is indicated by non zero msg/reply_bytes */
388ceb89accSPeter Ujfalusi if (msg_bytes)
389ceb89accSPeter Ujfalusi msg = msg_data;
390ceb89accSPeter Ujfalusi else if (reply_bytes)
391ceb89accSPeter Ujfalusi msg = reply_data;
392ceb89accSPeter Ujfalusi
393ceb89accSPeter Ujfalusi if (msg)
394ceb89accSPeter Ujfalusi sof_ipc4_dump_payload(sdev, msg->data_ptr, msg->data_size);
395c3d275e3SPeter Ujfalusi }
396c3d275e3SPeter Ujfalusi
397c3d275e3SPeter Ujfalusi mutex_unlock(&ipc->tx_mutex);
398ceb89accSPeter Ujfalusi
399ceb89accSPeter Ujfalusi return ret;
400ceb89accSPeter Ujfalusi }
401ceb89accSPeter Ujfalusi
sof_ipc4_set_get_data(struct snd_sof_dev * sdev,void * data,size_t payload_bytes,bool set)402ceb89accSPeter Ujfalusi static int sof_ipc4_set_get_data(struct snd_sof_dev *sdev, void *data,
403ceb89accSPeter Ujfalusi size_t payload_bytes, bool set)
404ceb89accSPeter Ujfalusi {
405e51f4951SRanjani Sridharan const struct sof_dsp_power_state target_state = {
406e51f4951SRanjani Sridharan .state = SOF_DSP_PM_D0,
407e51f4951SRanjani Sridharan };
408ceb89accSPeter Ujfalusi size_t payload_limit = sdev->ipc->max_payload_size;
409ceb89accSPeter Ujfalusi struct sof_ipc4_msg *ipc4_msg = data;
410ceb89accSPeter Ujfalusi struct sof_ipc4_msg tx = {{ 0 }};
411ceb89accSPeter Ujfalusi struct sof_ipc4_msg rx = {{ 0 }};
412ceb89accSPeter Ujfalusi size_t remaining = payload_bytes;
413ceb89accSPeter Ujfalusi size_t offset = 0;
414ceb89accSPeter Ujfalusi size_t chunk_size;
415ceb89accSPeter Ujfalusi int ret;
416ceb89accSPeter Ujfalusi
417ceb89accSPeter Ujfalusi if (!data)
418ceb89accSPeter Ujfalusi return -EINVAL;
419ceb89accSPeter Ujfalusi
420ceb89accSPeter Ujfalusi if ((ipc4_msg->primary & SOF_IPC4_MSG_TARGET_MASK) !=
421ceb89accSPeter Ujfalusi SOF_IPC4_MSG_TARGET(SOF_IPC4_MODULE_MSG))
422ceb89accSPeter Ujfalusi return -EINVAL;
423ceb89accSPeter Ujfalusi
424ceb89accSPeter Ujfalusi ipc4_msg->primary &= ~SOF_IPC4_MSG_TYPE_MASK;
425ceb89accSPeter Ujfalusi tx.primary = ipc4_msg->primary;
426ceb89accSPeter Ujfalusi tx.extension = ipc4_msg->extension;
427ceb89accSPeter Ujfalusi
428ceb89accSPeter Ujfalusi if (set)
429ceb89accSPeter Ujfalusi tx.primary |= SOF_IPC4_MSG_TYPE_SET(SOF_IPC4_MOD_LARGE_CONFIG_SET);
430ceb89accSPeter Ujfalusi else
431ceb89accSPeter Ujfalusi tx.primary |= SOF_IPC4_MSG_TYPE_SET(SOF_IPC4_MOD_LARGE_CONFIG_GET);
432ceb89accSPeter Ujfalusi
433ceb89accSPeter Ujfalusi tx.extension &= ~SOF_IPC4_MOD_EXT_MSG_SIZE_MASK;
434ceb89accSPeter Ujfalusi tx.extension |= SOF_IPC4_MOD_EXT_MSG_SIZE(payload_bytes);
435ceb89accSPeter Ujfalusi
436ceb89accSPeter Ujfalusi tx.extension |= SOF_IPC4_MOD_EXT_MSG_FIRST_BLOCK(1);
437ceb89accSPeter Ujfalusi
438e51f4951SRanjani Sridharan /* ensure the DSP is in D0i0 before sending IPC */
439e51f4951SRanjani Sridharan ret = snd_sof_dsp_set_power_state(sdev, &target_state);
440e51f4951SRanjani Sridharan if (ret < 0)
441e51f4951SRanjani Sridharan return ret;
442e51f4951SRanjani Sridharan
443ceb89accSPeter Ujfalusi /* Serialise IPC TX */
444ceb89accSPeter Ujfalusi mutex_lock(&sdev->ipc->tx_mutex);
445ceb89accSPeter Ujfalusi
446ceb89accSPeter Ujfalusi do {
447ceb89accSPeter Ujfalusi size_t tx_size, rx_size;
448ceb89accSPeter Ujfalusi
449ceb89accSPeter Ujfalusi if (remaining > payload_limit) {
450ceb89accSPeter Ujfalusi chunk_size = payload_limit;
451ceb89accSPeter Ujfalusi } else {
452ceb89accSPeter Ujfalusi chunk_size = remaining;
453ceb89accSPeter Ujfalusi if (set)
454ceb89accSPeter Ujfalusi tx.extension |= SOF_IPC4_MOD_EXT_MSG_LAST_BLOCK(1);
455ceb89accSPeter Ujfalusi }
456ceb89accSPeter Ujfalusi
457ceb89accSPeter Ujfalusi if (offset) {
458ceb89accSPeter Ujfalusi tx.extension &= ~SOF_IPC4_MOD_EXT_MSG_FIRST_BLOCK_MASK;
459ceb89accSPeter Ujfalusi tx.extension &= ~SOF_IPC4_MOD_EXT_MSG_SIZE_MASK;
460ceb89accSPeter Ujfalusi tx.extension |= SOF_IPC4_MOD_EXT_MSG_SIZE(offset);
461ceb89accSPeter Ujfalusi }
462ceb89accSPeter Ujfalusi
463ceb89accSPeter Ujfalusi if (set) {
464ceb89accSPeter Ujfalusi tx.data_size = chunk_size;
465ceb89accSPeter Ujfalusi tx.data_ptr = ipc4_msg->data_ptr + offset;
466ceb89accSPeter Ujfalusi
467ceb89accSPeter Ujfalusi tx_size = chunk_size;
468ceb89accSPeter Ujfalusi rx_size = 0;
469ceb89accSPeter Ujfalusi } else {
470ceb89accSPeter Ujfalusi rx.primary = 0;
471ceb89accSPeter Ujfalusi rx.extension = 0;
472ceb89accSPeter Ujfalusi rx.data_size = chunk_size;
473ceb89accSPeter Ujfalusi rx.data_ptr = ipc4_msg->data_ptr + offset;
474ceb89accSPeter Ujfalusi
475ceb89accSPeter Ujfalusi tx_size = 0;
476ceb89accSPeter Ujfalusi rx_size = chunk_size;
477ceb89accSPeter Ujfalusi }
478ceb89accSPeter Ujfalusi
479ceb89accSPeter Ujfalusi /* Send the message for the current chunk */
480ceb89accSPeter Ujfalusi ret = ipc4_tx_msg_unlocked(sdev->ipc, &tx, tx_size, &rx, rx_size);
481ceb89accSPeter Ujfalusi if (ret < 0) {
482ceb89accSPeter Ujfalusi dev_err(sdev->dev,
483ceb89accSPeter Ujfalusi "%s: large config %s failed at offset %zu: %d\n",
484ceb89accSPeter Ujfalusi __func__, set ? "set" : "get", offset, ret);
485ceb89accSPeter Ujfalusi goto out;
486ceb89accSPeter Ujfalusi }
487ceb89accSPeter Ujfalusi
488ceb89accSPeter Ujfalusi if (!set && rx.extension & SOF_IPC4_MOD_EXT_MSG_FIRST_BLOCK_MASK) {
489ceb89accSPeter Ujfalusi /* Verify the firmware reported total payload size */
490ceb89accSPeter Ujfalusi rx_size = rx.extension & SOF_IPC4_MOD_EXT_MSG_SIZE_MASK;
491ceb89accSPeter Ujfalusi
492ceb89accSPeter Ujfalusi if (rx_size > payload_bytes) {
493ceb89accSPeter Ujfalusi dev_err(sdev->dev,
494ceb89accSPeter Ujfalusi "%s: Receive buffer (%zu) is too small for %zu\n",
495ceb89accSPeter Ujfalusi __func__, payload_bytes, rx_size);
496ceb89accSPeter Ujfalusi ret = -ENOMEM;
497ceb89accSPeter Ujfalusi goto out;
498ceb89accSPeter Ujfalusi }
499ceb89accSPeter Ujfalusi
500ceb89accSPeter Ujfalusi if (rx_size < chunk_size) {
501ceb89accSPeter Ujfalusi chunk_size = rx_size;
502ceb89accSPeter Ujfalusi remaining = rx_size;
503ceb89accSPeter Ujfalusi } else if (rx_size < payload_bytes) {
504ceb89accSPeter Ujfalusi remaining = rx_size;
505ceb89accSPeter Ujfalusi }
506ceb89accSPeter Ujfalusi }
507ceb89accSPeter Ujfalusi
508ceb89accSPeter Ujfalusi offset += chunk_size;
509ceb89accSPeter Ujfalusi remaining -= chunk_size;
510ceb89accSPeter Ujfalusi } while (remaining);
511ceb89accSPeter Ujfalusi
512ceb89accSPeter Ujfalusi /* Adjust the received data size if needed */
513ceb89accSPeter Ujfalusi if (!set && payload_bytes != offset)
514ceb89accSPeter Ujfalusi ipc4_msg->data_size = offset;
515ceb89accSPeter Ujfalusi
516c3d275e3SPeter Ujfalusi if (sof_debug_check_flag(SOF_DBG_DUMP_IPC_MESSAGE_PAYLOAD))
517ceb89accSPeter Ujfalusi sof_ipc4_dump_payload(sdev, ipc4_msg->data_ptr, ipc4_msg->data_size);
518ceb89accSPeter Ujfalusi
519ceb89accSPeter Ujfalusi out:
520ceb89accSPeter Ujfalusi mutex_unlock(&sdev->ipc->tx_mutex);
521ceb89accSPeter Ujfalusi
522ceb89accSPeter Ujfalusi return ret;
523ceb89accSPeter Ujfalusi }
524ceb89accSPeter Ujfalusi
sof_ipc4_init_msg_memory(struct snd_sof_dev * sdev)525ceb89accSPeter Ujfalusi static int sof_ipc4_init_msg_memory(struct snd_sof_dev *sdev)
526ceb89accSPeter Ujfalusi {
527ceb89accSPeter Ujfalusi struct sof_ipc4_msg *ipc4_msg;
528ceb89accSPeter Ujfalusi struct snd_sof_ipc_msg *msg = &sdev->ipc->msg;
529ceb89accSPeter Ujfalusi
530ceb89accSPeter Ujfalusi /* TODO: get max_payload_size from firmware */
531ceb89accSPeter Ujfalusi sdev->ipc->max_payload_size = SOF_IPC4_MSG_MAX_SIZE;
532ceb89accSPeter Ujfalusi
533ceb89accSPeter Ujfalusi /* Allocate memory for the ipc4 container and the maximum payload */
534ceb89accSPeter Ujfalusi msg->reply_data = devm_kzalloc(sdev->dev, sdev->ipc->max_payload_size +
535ceb89accSPeter Ujfalusi sizeof(struct sof_ipc4_msg), GFP_KERNEL);
536ceb89accSPeter Ujfalusi if (!msg->reply_data)
537ceb89accSPeter Ujfalusi return -ENOMEM;
538ceb89accSPeter Ujfalusi
539ceb89accSPeter Ujfalusi ipc4_msg = msg->reply_data;
540ceb89accSPeter Ujfalusi ipc4_msg->data_ptr = msg->reply_data + sizeof(struct sof_ipc4_msg);
541ceb89accSPeter Ujfalusi
542ceb89accSPeter Ujfalusi return 0;
543ceb89accSPeter Ujfalusi }
544ceb89accSPeter Ujfalusi
ipc4_fw_ready(struct snd_sof_dev * sdev,struct sof_ipc4_msg * ipc4_msg)545ceb89accSPeter Ujfalusi static int ipc4_fw_ready(struct snd_sof_dev *sdev, struct sof_ipc4_msg *ipc4_msg)
546ceb89accSPeter Ujfalusi {
547ceb89accSPeter Ujfalusi int inbox_offset, inbox_size, outbox_offset, outbox_size;
548ceb89accSPeter Ujfalusi
549ceb89accSPeter Ujfalusi /* no need to re-check version/ABI for subsequent boots */
550ceb89accSPeter Ujfalusi if (!sdev->first_boot)
551ceb89accSPeter Ujfalusi return 0;
552ceb89accSPeter Ujfalusi
553ceb89accSPeter Ujfalusi /* Set up the windows for IPC communication */
554ceb89accSPeter Ujfalusi inbox_offset = snd_sof_dsp_get_mailbox_offset(sdev);
555ceb89accSPeter Ujfalusi if (inbox_offset < 0) {
556ceb89accSPeter Ujfalusi dev_err(sdev->dev, "%s: No mailbox offset\n", __func__);
557ceb89accSPeter Ujfalusi return inbox_offset;
558ceb89accSPeter Ujfalusi }
559ceb89accSPeter Ujfalusi inbox_size = SOF_IPC4_MSG_MAX_SIZE;
560b59f1532SPeter Ujfalusi outbox_offset = snd_sof_dsp_get_window_offset(sdev, SOF_IPC4_OUTBOX_WINDOW_IDX);
561ceb89accSPeter Ujfalusi outbox_size = SOF_IPC4_MSG_MAX_SIZE;
562ceb89accSPeter Ujfalusi
5634700bfb2SRander Wang sdev->fw_info_box.offset = snd_sof_dsp_get_window_offset(sdev, SOF_IPC4_INBOX_WINDOW_IDX);
5644700bfb2SRander Wang sdev->fw_info_box.size = sizeof(struct sof_ipc4_fw_registers);
565ceb89accSPeter Ujfalusi sdev->dsp_box.offset = inbox_offset;
566ceb89accSPeter Ujfalusi sdev->dsp_box.size = inbox_size;
567ceb89accSPeter Ujfalusi sdev->host_box.offset = outbox_offset;
568ceb89accSPeter Ujfalusi sdev->host_box.size = outbox_size;
569ceb89accSPeter Ujfalusi
570a5d0147aSPeter Ujfalusi sdev->debug_box.offset = snd_sof_dsp_get_window_offset(sdev,
571a5d0147aSPeter Ujfalusi SOF_IPC4_DEBUG_WINDOW_IDX);
572a5d0147aSPeter Ujfalusi
573ceb89accSPeter Ujfalusi dev_dbg(sdev->dev, "mailbox upstream 0x%x - size 0x%x\n",
574ceb89accSPeter Ujfalusi inbox_offset, inbox_size);
575ceb89accSPeter Ujfalusi dev_dbg(sdev->dev, "mailbox downstream 0x%x - size 0x%x\n",
576ceb89accSPeter Ujfalusi outbox_offset, outbox_size);
577a5d0147aSPeter Ujfalusi dev_dbg(sdev->dev, "debug box 0x%x\n", sdev->debug_box.offset);
578ceb89accSPeter Ujfalusi
579ceb89accSPeter Ujfalusi return sof_ipc4_init_msg_memory(sdev);
580ceb89accSPeter Ujfalusi }
581ceb89accSPeter Ujfalusi
sof_ipc4_rx_msg(struct snd_sof_dev * sdev)582ceb89accSPeter Ujfalusi static void sof_ipc4_rx_msg(struct snd_sof_dev *sdev)
583ceb89accSPeter Ujfalusi {
584ceb89accSPeter Ujfalusi struct sof_ipc4_msg *ipc4_msg = sdev->ipc->msg.rx_data;
585ceb89accSPeter Ujfalusi size_t data_size = 0;
586ceb89accSPeter Ujfalusi int err;
587ceb89accSPeter Ujfalusi
588ceb89accSPeter Ujfalusi if (!ipc4_msg || !SOF_IPC4_MSG_IS_NOTIFICATION(ipc4_msg->primary))
589ceb89accSPeter Ujfalusi return;
590ceb89accSPeter Ujfalusi
591ceb89accSPeter Ujfalusi ipc4_msg->data_ptr = NULL;
592ceb89accSPeter Ujfalusi ipc4_msg->data_size = 0;
593ceb89accSPeter Ujfalusi
594ceb89accSPeter Ujfalusi sof_ipc4_log_header(sdev->dev, "ipc rx ", ipc4_msg, false);
595ceb89accSPeter Ujfalusi
596ceb89accSPeter Ujfalusi switch (SOF_IPC4_NOTIFICATION_TYPE_GET(ipc4_msg->primary)) {
597ceb89accSPeter Ujfalusi case SOF_IPC4_NOTIFY_FW_READY:
598ceb89accSPeter Ujfalusi /* check for FW boot completion */
599ceb89accSPeter Ujfalusi if (sdev->fw_state == SOF_FW_BOOT_IN_PROGRESS) {
600ceb89accSPeter Ujfalusi err = ipc4_fw_ready(sdev, ipc4_msg);
601ceb89accSPeter Ujfalusi if (err < 0)
602ceb89accSPeter Ujfalusi sof_set_fw_state(sdev, SOF_FW_BOOT_READY_FAILED);
603ceb89accSPeter Ujfalusi else
604ceb89accSPeter Ujfalusi sof_set_fw_state(sdev, SOF_FW_BOOT_READY_OK);
605ceb89accSPeter Ujfalusi
606ceb89accSPeter Ujfalusi /* wake up firmware loader */
607ceb89accSPeter Ujfalusi wake_up(&sdev->boot_wait);
608ceb89accSPeter Ujfalusi }
609ceb89accSPeter Ujfalusi
610ceb89accSPeter Ujfalusi break;
611ceb89accSPeter Ujfalusi case SOF_IPC4_NOTIFY_RESOURCE_EVENT:
612ceb89accSPeter Ujfalusi data_size = sizeof(struct sof_ipc4_notify_resource_data);
613ceb89accSPeter Ujfalusi break;
614f4ea22f7SPeter Ujfalusi case SOF_IPC4_NOTIFY_LOG_BUFFER_STATUS:
615f4ea22f7SPeter Ujfalusi sof_ipc4_mtrace_update_pos(sdev, SOF_IPC4_LOG_CORE_GET(ipc4_msg->primary));
616f4ea22f7SPeter Ujfalusi break;
617424a8ca3SRander Wang case SOF_IPC4_NOTIFY_EXCEPTION_CAUGHT:
618424a8ca3SRander Wang snd_sof_dsp_panic(sdev, 0, true);
619424a8ca3SRander Wang break;
620ceb89accSPeter Ujfalusi default:
621b3ec3eb2SPierre-Louis Bossart dev_dbg(sdev->dev, "Unhandled DSP message: %#x|%#x\n",
622ceb89accSPeter Ujfalusi ipc4_msg->primary, ipc4_msg->extension);
623ceb89accSPeter Ujfalusi break;
624ceb89accSPeter Ujfalusi }
625ceb89accSPeter Ujfalusi
626ceb89accSPeter Ujfalusi if (data_size) {
627ceb89accSPeter Ujfalusi ipc4_msg->data_ptr = kmalloc(data_size, GFP_KERNEL);
628ceb89accSPeter Ujfalusi if (!ipc4_msg->data_ptr)
629ceb89accSPeter Ujfalusi return;
630ceb89accSPeter Ujfalusi
631ceb89accSPeter Ujfalusi ipc4_msg->data_size = data_size;
632*61db7910SBard Liao err = snd_sof_ipc_msg_data(sdev, NULL, ipc4_msg->data_ptr, ipc4_msg->data_size);
633*61db7910SBard Liao if (err < 0) {
634*61db7910SBard Liao dev_err(sdev->dev, "failed to read IPC notification data: %d\n", err);
635*61db7910SBard Liao kfree(ipc4_msg->data_ptr);
636*61db7910SBard Liao ipc4_msg->data_ptr = NULL;
637*61db7910SBard Liao ipc4_msg->data_size = 0;
638*61db7910SBard Liao return;
639*61db7910SBard Liao }
640ceb89accSPeter Ujfalusi }
641ceb89accSPeter Ujfalusi
642ceb89accSPeter Ujfalusi sof_ipc4_log_header(sdev->dev, "ipc rx done ", ipc4_msg, true);
643ceb89accSPeter Ujfalusi
644ceb89accSPeter Ujfalusi if (data_size) {
645ceb89accSPeter Ujfalusi kfree(ipc4_msg->data_ptr);
646ceb89accSPeter Ujfalusi ipc4_msg->data_ptr = NULL;
647ceb89accSPeter Ujfalusi ipc4_msg->data_size = 0;
648ceb89accSPeter Ujfalusi }
649ceb89accSPeter Ujfalusi }
650ceb89accSPeter Ujfalusi
sof_ipc4_set_core_state(struct snd_sof_dev * sdev,int core_idx,bool on)651bd3df9ffSPeter Ujfalusi static int sof_ipc4_set_core_state(struct snd_sof_dev *sdev, int core_idx, bool on)
652bd3df9ffSPeter Ujfalusi {
653bd3df9ffSPeter Ujfalusi struct sof_ipc4_dx_state_info dx_state;
654bd3df9ffSPeter Ujfalusi struct sof_ipc4_msg msg;
655bd3df9ffSPeter Ujfalusi
656bd3df9ffSPeter Ujfalusi dx_state.core_mask = BIT(core_idx);
657bd3df9ffSPeter Ujfalusi if (on)
658bd3df9ffSPeter Ujfalusi dx_state.dx_mask = BIT(core_idx);
659bd3df9ffSPeter Ujfalusi else
660bd3df9ffSPeter Ujfalusi dx_state.dx_mask = 0;
661bd3df9ffSPeter Ujfalusi
662bd3df9ffSPeter Ujfalusi msg.primary = SOF_IPC4_MSG_TYPE_SET(SOF_IPC4_MOD_SET_DX);
663bd3df9ffSPeter Ujfalusi msg.primary |= SOF_IPC4_MSG_DIR(SOF_IPC4_MSG_REQUEST);
664bd3df9ffSPeter Ujfalusi msg.primary |= SOF_IPC4_MSG_TARGET(SOF_IPC4_MODULE_MSG);
665bd3df9ffSPeter Ujfalusi msg.extension = 0;
666bd3df9ffSPeter Ujfalusi msg.data_ptr = &dx_state;
667bd3df9ffSPeter Ujfalusi msg.data_size = sizeof(dx_state);
668bd3df9ffSPeter Ujfalusi
669bd3df9ffSPeter Ujfalusi return sof_ipc4_tx_msg(sdev, &msg, msg.data_size, NULL, 0, false);
670bd3df9ffSPeter Ujfalusi }
671bd3df9ffSPeter Ujfalusi
67263b90696SPeter Ujfalusi /*
67363b90696SPeter Ujfalusi * The context save callback is used to send a message to the firmware notifying
67463b90696SPeter Ujfalusi * it that the primary core is going to be turned off, which is used as an
67563b90696SPeter Ujfalusi * indication to prepare for a full power down, thus preparing for IMR boot
67663b90696SPeter Ujfalusi * (when supported)
67763b90696SPeter Ujfalusi *
67863b90696SPeter Ujfalusi * Note: in IPC4 there is no message used to restore context, thus no context
67963b90696SPeter Ujfalusi * restore callback is implemented
68063b90696SPeter Ujfalusi */
sof_ipc4_ctx_save(struct snd_sof_dev * sdev)68163b90696SPeter Ujfalusi static int sof_ipc4_ctx_save(struct snd_sof_dev *sdev)
68263b90696SPeter Ujfalusi {
68363b90696SPeter Ujfalusi return sof_ipc4_set_core_state(sdev, SOF_DSP_PRIMARY_CORE, false);
68463b90696SPeter Ujfalusi }
68563b90696SPeter Ujfalusi
sof_ipc4_set_pm_gate(struct snd_sof_dev * sdev,u32 flags)686167ca6a4SRander Wang static int sof_ipc4_set_pm_gate(struct snd_sof_dev *sdev, u32 flags)
687167ca6a4SRander Wang {
688167ca6a4SRander Wang struct sof_ipc4_msg msg = {{0}};
689167ca6a4SRander Wang
690167ca6a4SRander Wang msg.primary = SOF_IPC4_MSG_TYPE_SET(SOF_IPC4_MOD_SET_D0IX);
691167ca6a4SRander Wang msg.primary |= SOF_IPC4_MSG_DIR(SOF_IPC4_MSG_REQUEST);
692167ca6a4SRander Wang msg.primary |= SOF_IPC4_MSG_TARGET(SOF_IPC4_MODULE_MSG);
693167ca6a4SRander Wang msg.extension = flags;
694167ca6a4SRander Wang
695167ca6a4SRander Wang return sof_ipc4_tx_msg(sdev, &msg, 0, NULL, 0, true);
696167ca6a4SRander Wang }
697167ca6a4SRander Wang
698bd3df9ffSPeter Ujfalusi static const struct sof_ipc_pm_ops ipc4_pm_ops = {
69963b90696SPeter Ujfalusi .ctx_save = sof_ipc4_ctx_save,
700bd3df9ffSPeter Ujfalusi .set_core_state = sof_ipc4_set_core_state,
701167ca6a4SRander Wang .set_pm_gate = sof_ipc4_set_pm_gate,
702bd3df9ffSPeter Ujfalusi };
703bd3df9ffSPeter Ujfalusi
sof_ipc4_init(struct snd_sof_dev * sdev)7045a932cfcSPeter Ujfalusi static int sof_ipc4_init(struct snd_sof_dev *sdev)
7055a932cfcSPeter Ujfalusi {
7065a932cfcSPeter Ujfalusi struct sof_ipc4_fw_data *ipc4_data = sdev->private;
7075a932cfcSPeter Ujfalusi
7086bc4d1b7SRanjani Sridharan mutex_init(&ipc4_data->pipeline_state_mutex);
70932c4b698SRanjani Sridharan
7105a932cfcSPeter Ujfalusi xa_init_flags(&ipc4_data->fw_lib_xa, XA_FLAGS_ALLOC);
7115a932cfcSPeter Ujfalusi
7125a932cfcSPeter Ujfalusi return 0;
7135a932cfcSPeter Ujfalusi }
7145a932cfcSPeter Ujfalusi
sof_ipc4_exit(struct snd_sof_dev * sdev)7155a932cfcSPeter Ujfalusi static void sof_ipc4_exit(struct snd_sof_dev *sdev)
7165a932cfcSPeter Ujfalusi {
7175a932cfcSPeter Ujfalusi struct sof_ipc4_fw_data *ipc4_data = sdev->private;
7185a932cfcSPeter Ujfalusi struct sof_ipc4_fw_library *fw_lib;
7195a932cfcSPeter Ujfalusi unsigned long lib_id;
7205a932cfcSPeter Ujfalusi
7215a932cfcSPeter Ujfalusi xa_for_each(&ipc4_data->fw_lib_xa, lib_id, fw_lib) {
7225a932cfcSPeter Ujfalusi /*
7235a932cfcSPeter Ujfalusi * The basefw (ID == 0) is handled by generic code, it is not
7245a932cfcSPeter Ujfalusi * loaded by IPC4 code.
7255a932cfcSPeter Ujfalusi */
7265a932cfcSPeter Ujfalusi if (lib_id != 0)
7275a932cfcSPeter Ujfalusi release_firmware(fw_lib->sof_fw.fw);
7285a932cfcSPeter Ujfalusi
7295a932cfcSPeter Ujfalusi fw_lib->sof_fw.fw = NULL;
7305a932cfcSPeter Ujfalusi }
7315a932cfcSPeter Ujfalusi
7325a932cfcSPeter Ujfalusi xa_destroy(&ipc4_data->fw_lib_xa);
7335a932cfcSPeter Ujfalusi }
7345a932cfcSPeter Ujfalusi
sof_ipc4_post_boot(struct snd_sof_dev * sdev)735e6851310SPeter Ujfalusi static int sof_ipc4_post_boot(struct snd_sof_dev *sdev)
736e6851310SPeter Ujfalusi {
737e6851310SPeter Ujfalusi if (sdev->first_boot)
738e6851310SPeter Ujfalusi return sof_ipc4_query_fw_configuration(sdev);
739e6851310SPeter Ujfalusi
74073c091a2SPeter Ujfalusi return sof_ipc4_reload_fw_libraries(sdev);
741e6851310SPeter Ujfalusi }
742e6851310SPeter Ujfalusi
743ceb89accSPeter Ujfalusi const struct sof_ipc_ops ipc4_ops = {
7445a932cfcSPeter Ujfalusi .init = sof_ipc4_init,
7455a932cfcSPeter Ujfalusi .exit = sof_ipc4_exit,
746e6851310SPeter Ujfalusi .post_fw_boot = sof_ipc4_post_boot,
747ceb89accSPeter Ujfalusi .tx_msg = sof_ipc4_tx_msg,
748ceb89accSPeter Ujfalusi .rx_msg = sof_ipc4_rx_msg,
749ceb89accSPeter Ujfalusi .set_get_data = sof_ipc4_set_get_data,
750ceb89accSPeter Ujfalusi .get_reply = sof_ipc4_get_reply,
751bd3df9ffSPeter Ujfalusi .pm = &ipc4_pm_ops,
752c62ff366SRanjani Sridharan .fw_loader = &ipc4_loader_ops,
75390e89155SRanjani Sridharan .tplg = &ipc4_tplg_ops,
754e75e5db8SRanjani Sridharan .pcm = &ipc4_pcm_ops,
755f4ea22f7SPeter Ujfalusi .fw_tracing = &ipc4_mtrace_ops,
756ceb89accSPeter Ujfalusi };
757