1 // SPDX-License-Identifier: GPL-2.0-only
2 //
3 // Copyright(c) 2021-2022 Intel Corporation
4 //
5 // Authors: Cezary Rojewski <cezary.rojewski@intel.com>
6 //          Amadeusz Slawinski <amadeuszx.slawinski@linux.intel.com>
7 //
8 
9 #include <linux/slab.h>
10 #include "avs.h"
11 #include "messages.h"
12 
13 #define AVS_CL_TIMEOUT_MS	5000
14 
avs_ipc_set_boot_config(struct avs_dev * adev,u32 dma_id,u32 purge)15 int avs_ipc_set_boot_config(struct avs_dev *adev, u32 dma_id, u32 purge)
16 {
17 	union avs_global_msg msg = AVS_GLOBAL_REQUEST(ROM_CONTROL);
18 	struct avs_ipc_msg request = {{0}};
19 
20 	msg.boot_cfg.rom_ctrl_msg_type = AVS_ROM_SET_BOOT_CONFIG;
21 	msg.boot_cfg.dma_id = dma_id;
22 	msg.boot_cfg.purge_request = purge;
23 	request.header = msg.val;
24 
25 	return avs_dsp_send_rom_msg(adev, &request, "set boot config");
26 }
27 
avs_ipc_load_modules(struct avs_dev * adev,u16 * mod_ids,u32 num_mod_ids)28 int avs_ipc_load_modules(struct avs_dev *adev, u16 *mod_ids, u32 num_mod_ids)
29 {
30 	union avs_global_msg msg = AVS_GLOBAL_REQUEST(LOAD_MULTIPLE_MODULES);
31 	struct avs_ipc_msg request;
32 
33 	msg.load_multi_mods.mod_cnt = num_mod_ids;
34 	request.header = msg.val;
35 	request.data = mod_ids;
36 	request.size = sizeof(*mod_ids) * num_mod_ids;
37 
38 	return avs_dsp_send_msg_timeout(adev, &request, NULL, AVS_CL_TIMEOUT_MS,
39 					"load multiple modules");
40 }
41 
avs_ipc_unload_modules(struct avs_dev * adev,u16 * mod_ids,u32 num_mod_ids)42 int avs_ipc_unload_modules(struct avs_dev *adev, u16 *mod_ids, u32 num_mod_ids)
43 {
44 	union avs_global_msg msg = AVS_GLOBAL_REQUEST(UNLOAD_MULTIPLE_MODULES);
45 	struct avs_ipc_msg request;
46 
47 	msg.load_multi_mods.mod_cnt = num_mod_ids;
48 	request.header = msg.val;
49 	request.data = mod_ids;
50 	request.size = sizeof(*mod_ids) * num_mod_ids;
51 
52 	return avs_dsp_send_msg(adev, &request, NULL, "unload multiple modules");
53 }
54 
avs_ipc_load_library(struct avs_dev * adev,u32 dma_id,u32 lib_id)55 int avs_ipc_load_library(struct avs_dev *adev, u32 dma_id, u32 lib_id)
56 {
57 	union avs_global_msg msg = AVS_GLOBAL_REQUEST(LOAD_LIBRARY);
58 	struct avs_ipc_msg request = {{0}};
59 
60 	msg.load_lib.dma_id = dma_id;
61 	msg.load_lib.lib_id = lib_id;
62 	request.header = msg.val;
63 
64 	return avs_dsp_send_msg_timeout(adev, &request, NULL, AVS_CL_TIMEOUT_MS, "load library");
65 }
66 
avs_ipc_create_pipeline(struct avs_dev * adev,u16 req_size,u8 priority,u8 instance_id,bool lp,u16 attributes)67 int avs_ipc_create_pipeline(struct avs_dev *adev, u16 req_size, u8 priority,
68 			    u8 instance_id, bool lp, u16 attributes)
69 {
70 	union avs_global_msg msg = AVS_GLOBAL_REQUEST(CREATE_PIPELINE);
71 	struct avs_ipc_msg request = {{0}};
72 
73 	msg.create_ppl.ppl_mem_size = req_size;
74 	msg.create_ppl.ppl_priority = priority;
75 	msg.create_ppl.instance_id = instance_id;
76 	msg.ext.create_ppl.lp = lp;
77 	msg.ext.create_ppl.attributes = attributes;
78 	request.header = msg.val;
79 
80 	return avs_dsp_send_msg(adev, &request, NULL, "create pipeline");
81 }
82 
avs_ipc_delete_pipeline(struct avs_dev * adev,u8 instance_id)83 int avs_ipc_delete_pipeline(struct avs_dev *adev, u8 instance_id)
84 {
85 	union avs_global_msg msg = AVS_GLOBAL_REQUEST(DELETE_PIPELINE);
86 	struct avs_ipc_msg request = {{0}};
87 
88 	msg.ppl.instance_id = instance_id;
89 	request.header = msg.val;
90 
91 	return avs_dsp_send_msg(adev, &request, NULL, "delete pipeline");
92 }
93 
avs_ipc_set_pipeline_state(struct avs_dev * adev,u8 instance_id,enum avs_pipeline_state state)94 int avs_ipc_set_pipeline_state(struct avs_dev *adev, u8 instance_id,
95 			       enum avs_pipeline_state state)
96 {
97 	union avs_global_msg msg = AVS_GLOBAL_REQUEST(SET_PIPELINE_STATE);
98 	struct avs_ipc_msg request = {{0}};
99 
100 	msg.set_ppl_state.ppl_id = instance_id;
101 	msg.set_ppl_state.state = state;
102 	request.header = msg.val;
103 
104 	return avs_dsp_send_msg(adev, &request, NULL, "set pipeline state");
105 }
106 
avs_ipc_get_pipeline_state(struct avs_dev * adev,u8 instance_id,enum avs_pipeline_state * state)107 int avs_ipc_get_pipeline_state(struct avs_dev *adev, u8 instance_id,
108 			       enum avs_pipeline_state *state)
109 {
110 	union avs_global_msg msg = AVS_GLOBAL_REQUEST(GET_PIPELINE_STATE);
111 	struct avs_ipc_msg request = {{0}};
112 	struct avs_ipc_msg reply = {{0}};
113 	int ret;
114 
115 	msg.get_ppl_state.ppl_id = instance_id;
116 	request.header = msg.val;
117 
118 	ret = avs_dsp_send_msg(adev, &request, &reply, "get pipeline state");
119 	if (!ret)
120 		*state = reply.rsp.ext.get_ppl_state.state;
121 	return ret;
122 }
123 
124 /*
125  * avs_ipc_init_instance - Initialize module instance
126  *
127  * @adev: Driver context
128  * @module_id: Module-type id
129  * @instance_id: Unique module instance id
130  * @ppl_id: Parent pipeline id
131  * @core_id: DSP core to allocate module on
132  * @domain: Processing domain (low latency or data processing)
133  * @param: Module-type specific configuration
134  * @param_size: Size of @param in bytes
135  *
136  * Argument verification, as well as pipeline state checks are done by the
137  * firmware.
138  *
139  * Note: @ppl_id and @core_id are independent of each other as single pipeline
140  * can be composed of module instances located on different DSP cores.
141  */
avs_ipc_init_instance(struct avs_dev * adev,u16 module_id,u8 instance_id,u8 ppl_id,u8 core_id,u8 domain,void * param,u32 param_size)142 int avs_ipc_init_instance(struct avs_dev *adev, u16 module_id, u8 instance_id,
143 			  u8 ppl_id, u8 core_id, u8 domain,
144 			  void *param, u32 param_size)
145 {
146 	union avs_module_msg msg = AVS_MODULE_REQUEST(INIT_INSTANCE);
147 	struct avs_ipc_msg request;
148 
149 	msg.module_id = module_id;
150 	msg.instance_id = instance_id;
151 	/* firmware expects size provided in dwords */
152 	msg.ext.init_instance.param_block_size = DIV_ROUND_UP(param_size, sizeof(u32));
153 	msg.ext.init_instance.ppl_instance_id = ppl_id;
154 	msg.ext.init_instance.core_id = core_id;
155 	msg.ext.init_instance.proc_domain = domain;
156 
157 	request.header = msg.val;
158 	request.data = param;
159 	request.size = param_size;
160 
161 	return avs_dsp_send_msg(adev, &request, NULL, "init instance");
162 }
163 
164 /*
165  * avs_ipc_delete_instance - Delete module instance
166  *
167  * @adev: Driver context
168  * @module_id: Module-type id
169  * @instance_id: Unique module instance id
170  *
171  * Argument verification, as well as pipeline state checks are done by the
172  * firmware.
173  *
174  * Note: only standalone modules i.e. without a parent pipeline shall be
175  * deleted using this IPC message. In all other cases, pipeline owning the
176  * modules performs cleanup automatically when it is deleted.
177  */
avs_ipc_delete_instance(struct avs_dev * adev,u16 module_id,u8 instance_id)178 int avs_ipc_delete_instance(struct avs_dev *adev, u16 module_id, u8 instance_id)
179 {
180 	union avs_module_msg msg = AVS_MODULE_REQUEST(DELETE_INSTANCE);
181 	struct avs_ipc_msg request = {{0}};
182 
183 	msg.module_id = module_id;
184 	msg.instance_id = instance_id;
185 	request.header = msg.val;
186 
187 	return avs_dsp_send_msg(adev, &request, NULL, "delete instance");
188 }
189 
190 /*
191  * avs_ipc_bind - Bind two module instances
192  *
193  * @adev: Driver context
194  * @module_id: Source module-type id
195  * @instance_id: Source module instance id
196  * @dst_module_id: Sink module-type id
197  * @dst_instance_id: Sink module instance id
198  * @dst_queue: Sink module pin to bind @src_queue with
199  * @src_queue: Source module pin to bind @dst_queue with
200  */
avs_ipc_bind(struct avs_dev * adev,u16 module_id,u8 instance_id,u16 dst_module_id,u8 dst_instance_id,u8 dst_queue,u8 src_queue)201 int avs_ipc_bind(struct avs_dev *adev, u16 module_id, u8 instance_id,
202 		 u16 dst_module_id, u8 dst_instance_id,
203 		 u8 dst_queue, u8 src_queue)
204 {
205 	union avs_module_msg msg = AVS_MODULE_REQUEST(BIND);
206 	struct avs_ipc_msg request = {{0}};
207 
208 	msg.module_id = module_id;
209 	msg.instance_id = instance_id;
210 	msg.ext.bind_unbind.dst_module_id = dst_module_id;
211 	msg.ext.bind_unbind.dst_instance_id = dst_instance_id;
212 	msg.ext.bind_unbind.dst_queue = dst_queue;
213 	msg.ext.bind_unbind.src_queue = src_queue;
214 	request.header = msg.val;
215 
216 	return avs_dsp_send_msg(adev, &request, NULL, "bind modules");
217 }
218 
219 /*
220  * avs_ipc_unbind - Unbind two module instances
221  *
222  * @adev: Driver context
223  * @module_id: Source module-type id
224  * @instance_id: Source module instance id
225  * @dst_module_id: Sink module-type id
226  * @dst_instance_id: Sink module instance id
227  * @dst_queue: Sink module pin to unbind @src_queue from
228  * @src_queue: Source module pin to unbind @dst_queue from
229  */
avs_ipc_unbind(struct avs_dev * adev,u16 module_id,u8 instance_id,u16 dst_module_id,u8 dst_instance_id,u8 dst_queue,u8 src_queue)230 int avs_ipc_unbind(struct avs_dev *adev, u16 module_id, u8 instance_id,
231 		   u16 dst_module_id, u8 dst_instance_id,
232 		   u8 dst_queue, u8 src_queue)
233 {
234 	union avs_module_msg msg = AVS_MODULE_REQUEST(UNBIND);
235 	struct avs_ipc_msg request = {{0}};
236 
237 	msg.module_id = module_id;
238 	msg.instance_id = instance_id;
239 	msg.ext.bind_unbind.dst_module_id = dst_module_id;
240 	msg.ext.bind_unbind.dst_instance_id = dst_instance_id;
241 	msg.ext.bind_unbind.dst_queue = dst_queue;
242 	msg.ext.bind_unbind.src_queue = src_queue;
243 	request.header = msg.val;
244 
245 	return avs_dsp_send_msg(adev, &request, NULL, "unbind modules");
246 }
247 
__avs_ipc_set_large_config(struct avs_dev * adev,u16 module_id,u8 instance_id,u8 param_id,bool init_block,bool final_block,u8 * request_data,size_t request_size,size_t off_size)248 static int __avs_ipc_set_large_config(struct avs_dev *adev, u16 module_id, u8 instance_id,
249 				      u8 param_id, bool init_block, bool final_block,
250 				      u8 *request_data, size_t request_size, size_t off_size)
251 {
252 	union avs_module_msg msg = AVS_MODULE_REQUEST(LARGE_CONFIG_SET);
253 	struct avs_ipc_msg request;
254 
255 	msg.module_id = module_id;
256 	msg.instance_id = instance_id;
257 	msg.ext.large_config.data_off_size = off_size;
258 	msg.ext.large_config.large_param_id = param_id;
259 	msg.ext.large_config.final_block = final_block;
260 	msg.ext.large_config.init_block = init_block;
261 
262 	request.header = msg.val;
263 	request.data = request_data;
264 	request.size = request_size;
265 
266 	return avs_dsp_send_msg(adev, &request, NULL, "large config set");
267 }
268 
avs_ipc_set_large_config(struct avs_dev * adev,u16 module_id,u8 instance_id,u8 param_id,u8 * request,size_t request_size)269 int avs_ipc_set_large_config(struct avs_dev *adev, u16 module_id,
270 			     u8 instance_id, u8 param_id,
271 			     u8 *request, size_t request_size)
272 {
273 	size_t remaining, tx_size;
274 	bool final;
275 	int ret;
276 
277 	remaining = request_size;
278 	tx_size = min_t(size_t, AVS_MAILBOX_SIZE, remaining);
279 	final = (tx_size == remaining);
280 
281 	/* Initial request states total payload size. */
282 	ret = __avs_ipc_set_large_config(adev, module_id, instance_id,
283 					 param_id, 1, final, request, tx_size,
284 					 request_size);
285 	if (ret)
286 		return ret;
287 
288 	remaining -= tx_size;
289 
290 	/* Loop the rest only when payload exceeds mailbox's size. */
291 	while (remaining) {
292 		size_t offset;
293 
294 		offset = request_size - remaining;
295 		tx_size = min_t(size_t, AVS_MAILBOX_SIZE, remaining);
296 		final = (tx_size == remaining);
297 
298 		ret = __avs_ipc_set_large_config(adev, module_id, instance_id,
299 						 param_id, 0, final,
300 						 request + offset, tx_size,
301 						 offset);
302 		if (ret)
303 			return ret;
304 
305 		remaining -= tx_size;
306 	}
307 
308 	return 0;
309 }
310 
avs_ipc_get_large_config(struct avs_dev * adev,u16 module_id,u8 instance_id,u8 param_id,u8 * request_data,size_t request_size,u8 ** reply_data,size_t * reply_size)311 int avs_ipc_get_large_config(struct avs_dev *adev, u16 module_id, u8 instance_id,
312 			     u8 param_id, u8 *request_data, size_t request_size,
313 			     u8 **reply_data, size_t *reply_size)
314 {
315 	union avs_module_msg msg = AVS_MODULE_REQUEST(LARGE_CONFIG_GET);
316 	struct avs_ipc_msg request;
317 	struct avs_ipc_msg reply = {{0}};
318 	void *buf;
319 	int ret;
320 
321 	reply.data = kzalloc(AVS_MAILBOX_SIZE, GFP_KERNEL);
322 	if (!reply.data)
323 		return -ENOMEM;
324 
325 	msg.module_id = module_id;
326 	msg.instance_id = instance_id;
327 	msg.ext.large_config.data_off_size = request_size;
328 	msg.ext.large_config.large_param_id = param_id;
329 	/* final_block is always 0 on request. Updated by fw on reply. */
330 	msg.ext.large_config.final_block = 0;
331 	msg.ext.large_config.init_block = 1;
332 
333 	request.header = msg.val;
334 	request.data = request_data;
335 	request.size = request_size;
336 	reply.size = AVS_MAILBOX_SIZE;
337 
338 	ret = avs_dsp_send_msg(adev, &request, &reply, "large config get");
339 	if (ret) {
340 		kfree(reply.data);
341 		return ret;
342 	}
343 
344 	buf = krealloc(reply.data, reply.size, GFP_KERNEL);
345 	if (!buf) {
346 		kfree(reply.data);
347 		return -ENOMEM;
348 	}
349 
350 	*reply_data = buf;
351 	*reply_size = reply.size;
352 
353 	return 0;
354 }
355 
avs_ipc_set_dx(struct avs_dev * adev,u32 core_mask,bool powerup)356 int avs_ipc_set_dx(struct avs_dev *adev, u32 core_mask, bool powerup)
357 {
358 	union avs_module_msg msg = AVS_MODULE_REQUEST(SET_DX);
359 	struct avs_ipc_msg request;
360 	struct avs_dxstate_info dx;
361 
362 	dx.core_mask = core_mask;
363 	dx.dx_mask = powerup ? core_mask : 0;
364 	request.header = msg.val;
365 	request.data = &dx;
366 	request.size = sizeof(dx);
367 
368 	return avs_dsp_send_pm_msg(adev, &request, NULL, true, "set dx");
369 }
370 
371 /*
372  * avs_ipc_set_d0ix - Set power gating policy (entering D0IX substates)
373  *
374  * @enable_pg: Whether to enable or disable power gating
375  * @streaming: Whether a stream is running when transitioning
376  */
avs_ipc_set_d0ix(struct avs_dev * adev,bool enable_pg,bool streaming)377 int avs_ipc_set_d0ix(struct avs_dev *adev, bool enable_pg, bool streaming)
378 {
379 	union avs_module_msg msg = AVS_MODULE_REQUEST(SET_D0IX);
380 	struct avs_ipc_msg request = {{0}};
381 
382 	msg.ext.set_d0ix.wake = enable_pg;
383 	msg.ext.set_d0ix.streaming = streaming;
384 	msg.ext.set_d0ix.prevent_pg = !enable_pg;
385 
386 	request.header = msg.val;
387 
388 	return avs_dsp_send_pm_msg(adev, &request, NULL, false, "set d0ix");
389 }
390 
avs_ipc_get_fw_config(struct avs_dev * adev,struct avs_fw_cfg * cfg)391 int avs_ipc_get_fw_config(struct avs_dev *adev, struct avs_fw_cfg *cfg)
392 {
393 	struct avs_tlv *tlv;
394 	size_t payload_size;
395 	size_t offset = 0;
396 	u8 *payload;
397 	int ret;
398 
399 	ret = avs_ipc_get_large_config(adev, AVS_BASEFW_MOD_ID, AVS_BASEFW_INST_ID,
400 				       AVS_BASEFW_FIRMWARE_CONFIG, NULL, 0,
401 				       &payload, &payload_size);
402 	if (ret)
403 		goto err;
404 	/* Non-zero payload expected for FIRMWARE_CONFIG. */
405 	if (!payload_size) {
406 		ret = -EREMOTEIO;
407 		goto err;
408 	}
409 
410 	while (offset < payload_size) {
411 		tlv = (struct avs_tlv *)(payload + offset);
412 
413 		switch (tlv->type) {
414 		case AVS_FW_CFG_FW_VERSION:
415 			memcpy(&cfg->fw_version, tlv->value, sizeof(cfg->fw_version));
416 			break;
417 
418 		case AVS_FW_CFG_MEMORY_RECLAIMED:
419 			cfg->memory_reclaimed = *tlv->value;
420 			break;
421 
422 		case AVS_FW_CFG_SLOW_CLOCK_FREQ_HZ:
423 			cfg->slow_clock_freq_hz = *tlv->value;
424 			break;
425 
426 		case AVS_FW_CFG_FAST_CLOCK_FREQ_HZ:
427 			cfg->fast_clock_freq_hz = *tlv->value;
428 			break;
429 
430 		case AVS_FW_CFG_ALH_SUPPORT_LEVEL:
431 			cfg->alh_support = *tlv->value;
432 			break;
433 
434 		case AVS_FW_CFG_IPC_DL_MAILBOX_BYTES:
435 			cfg->ipc_dl_mailbox_bytes = *tlv->value;
436 			break;
437 
438 		case AVS_FW_CFG_IPC_UL_MAILBOX_BYTES:
439 			cfg->ipc_ul_mailbox_bytes = *tlv->value;
440 			break;
441 
442 		case AVS_FW_CFG_TRACE_LOG_BYTES:
443 			cfg->trace_log_bytes = *tlv->value;
444 			break;
445 
446 		case AVS_FW_CFG_MAX_PPL_COUNT:
447 			cfg->max_ppl_count = *tlv->value;
448 			break;
449 
450 		case AVS_FW_CFG_MAX_ASTATE_COUNT:
451 			cfg->max_astate_count = *tlv->value;
452 			break;
453 
454 		case AVS_FW_CFG_MAX_MODULE_PIN_COUNT:
455 			cfg->max_module_pin_count = *tlv->value;
456 			break;
457 
458 		case AVS_FW_CFG_MODULES_COUNT:
459 			cfg->modules_count = *tlv->value;
460 			break;
461 
462 		case AVS_FW_CFG_MAX_MOD_INST_COUNT:
463 			cfg->max_mod_inst_count = *tlv->value;
464 			break;
465 
466 		case AVS_FW_CFG_MAX_LL_TASKS_PER_PRI_COUNT:
467 			cfg->max_ll_tasks_per_pri_count = *tlv->value;
468 			break;
469 
470 		case AVS_FW_CFG_LL_PRI_COUNT:
471 			cfg->ll_pri_count = *tlv->value;
472 			break;
473 
474 		case AVS_FW_CFG_MAX_DP_TASKS_COUNT:
475 			cfg->max_dp_tasks_count = *tlv->value;
476 			break;
477 
478 		case AVS_FW_CFG_MAX_LIBS_COUNT:
479 			cfg->max_libs_count = *tlv->value;
480 			break;
481 
482 		case AVS_FW_CFG_XTAL_FREQ_HZ:
483 			cfg->xtal_freq_hz = *tlv->value;
484 			break;
485 
486 		case AVS_FW_CFG_POWER_GATING_POLICY:
487 			cfg->power_gating_policy = *tlv->value;
488 			break;
489 
490 		/* Known but not useful to us. */
491 		case AVS_FW_CFG_DMA_BUFFER_CONFIG:
492 		case AVS_FW_CFG_SCHEDULER_CONFIG:
493 		case AVS_FW_CFG_CLOCKS_CONFIG:
494 		case AVS_FW_CFG_RESERVED:
495 			break;
496 
497 		default:
498 			dev_info(adev->dev, "Unrecognized fw param: %d\n", tlv->type);
499 			break;
500 		}
501 
502 		offset += sizeof(*tlv) + tlv->length;
503 	}
504 
505 	/* No longer needed, free it as it's owned by the get_large_config() caller. */
506 	kfree(payload);
507 err:
508 	if (ret)
509 		dev_err(adev->dev, "get fw cfg failed: %d\n", ret);
510 	return ret;
511 }
512 
avs_ipc_set_fw_config(struct avs_dev * adev,size_t num_tlvs,...)513 int avs_ipc_set_fw_config(struct avs_dev *adev, size_t num_tlvs, ...)
514 {
515 	struct avs_tlv *tlv;
516 	void *payload;
517 	size_t offset;
518 	va_list args;
519 	int ret, i;
520 
521 	payload = kzalloc(AVS_MAILBOX_SIZE, GFP_KERNEL);
522 	if (!payload)
523 		return -ENOMEM;
524 
525 	va_start(args, num_tlvs);
526 	for (offset = i = 0; i < num_tlvs && offset < AVS_MAILBOX_SIZE - sizeof(*tlv); i++) {
527 		tlv = (struct avs_tlv *)(payload + offset);
528 		tlv->type = va_arg(args, u32);
529 		tlv->length = va_arg(args, u32);
530 
531 		offset += sizeof(*tlv) + tlv->length;
532 		if (offset > AVS_MAILBOX_SIZE)
533 			break;
534 
535 		memcpy(tlv->value, va_arg(args, u8*), tlv->length);
536 	}
537 
538 	if (i == num_tlvs)
539 		ret = avs_ipc_set_large_config(adev, AVS_BASEFW_MOD_ID, AVS_BASEFW_INST_ID,
540 					       AVS_BASEFW_FIRMWARE_CONFIG, payload, offset);
541 	else
542 		ret = -ERANGE;
543 
544 	va_end(args);
545 	kfree(payload);
546 	if (ret)
547 		dev_err(adev->dev, "set fw cfg failed: %d\n", ret);
548 	return ret;
549 }
550 
avs_ipc_get_hw_config(struct avs_dev * adev,struct avs_hw_cfg * cfg)551 int avs_ipc_get_hw_config(struct avs_dev *adev, struct avs_hw_cfg *cfg)
552 {
553 	struct avs_tlv *tlv;
554 	size_t payload_size;
555 	size_t size, offset = 0;
556 	u8 *payload;
557 	int ret;
558 
559 	ret = avs_ipc_get_large_config(adev, AVS_BASEFW_MOD_ID, AVS_BASEFW_INST_ID,
560 				       AVS_BASEFW_HARDWARE_CONFIG, NULL, 0,
561 				       &payload, &payload_size);
562 	if (ret)
563 		goto err;
564 	/* Non-zero payload expected for HARDWARE_CONFIG. */
565 	if (!payload_size) {
566 		ret = -EREMOTEIO;
567 		goto err;
568 	}
569 
570 	while (offset < payload_size) {
571 		tlv = (struct avs_tlv *)(payload + offset);
572 
573 		switch (tlv->type) {
574 		case AVS_HW_CFG_AVS_VER:
575 			cfg->avs_version = *tlv->value;
576 			break;
577 
578 		case AVS_HW_CFG_DSP_CORES:
579 			cfg->dsp_cores = *tlv->value;
580 			break;
581 
582 		case AVS_HW_CFG_MEM_PAGE_BYTES:
583 			cfg->mem_page_bytes = *tlv->value;
584 			break;
585 
586 		case AVS_HW_CFG_TOTAL_PHYS_MEM_PAGES:
587 			cfg->total_phys_mem_pages = *tlv->value;
588 			break;
589 
590 		case AVS_HW_CFG_I2S_CAPS:
591 			cfg->i2s_caps.i2s_version = tlv->value[0];
592 			size = tlv->value[1];
593 			cfg->i2s_caps.ctrl_count = size;
594 			if (!size)
595 				break;
596 
597 			/* Multiply to get entire array size. */
598 			size *= sizeof(*cfg->i2s_caps.ctrl_base_addr);
599 			cfg->i2s_caps.ctrl_base_addr = devm_kmemdup(adev->dev,
600 								    &tlv->value[2],
601 								    size, GFP_KERNEL);
602 			if (!cfg->i2s_caps.ctrl_base_addr) {
603 				ret = -ENOMEM;
604 				goto exit;
605 			}
606 			break;
607 
608 		case AVS_HW_CFG_GATEWAY_COUNT:
609 			cfg->gateway_count = *tlv->value;
610 			break;
611 
612 		case AVS_HW_CFG_HP_EBB_COUNT:
613 			cfg->hp_ebb_count = *tlv->value;
614 			break;
615 
616 		case AVS_HW_CFG_LP_EBB_COUNT:
617 			cfg->lp_ebb_count = *tlv->value;
618 			break;
619 
620 		case AVS_HW_CFG_EBB_SIZE_BYTES:
621 			cfg->ebb_size_bytes = *tlv->value;
622 			break;
623 
624 		case AVS_HW_CFG_GPDMA_CAPS:
625 			break;
626 
627 		default:
628 			dev_info(adev->dev, "Unrecognized hw config: %d\n", tlv->type);
629 			break;
630 		}
631 
632 		offset += sizeof(*tlv) + tlv->length;
633 	}
634 
635 exit:
636 	/* No longer needed, free it as it's owned by the get_large_config() caller. */
637 	kfree(payload);
638 err:
639 	if (ret)
640 		dev_err(adev->dev, "get hw cfg failed: %d\n", ret);
641 	return ret;
642 }
643 
avs_ipc_get_modules_info(struct avs_dev * adev,struct avs_mods_info ** info)644 int avs_ipc_get_modules_info(struct avs_dev *adev, struct avs_mods_info **info)
645 {
646 	size_t payload_size;
647 	u8 *payload;
648 	int ret;
649 
650 	ret = avs_ipc_get_large_config(adev, AVS_BASEFW_MOD_ID, AVS_BASEFW_INST_ID,
651 				       AVS_BASEFW_MODULES_INFO, NULL, 0,
652 				       &payload, &payload_size);
653 	if (ret)
654 		return ret;
655 	/* Non-zero payload expected for MODULES_INFO. */
656 	if (!payload_size)
657 		return -EREMOTEIO;
658 
659 	*info = (struct avs_mods_info *)payload;
660 	return 0;
661 }
662 
avs_ipc_copier_set_sink_format(struct avs_dev * adev,u16 module_id,u8 instance_id,u32 sink_id,const struct avs_audio_format * src_fmt,const struct avs_audio_format * sink_fmt)663 int avs_ipc_copier_set_sink_format(struct avs_dev *adev, u16 module_id,
664 				   u8 instance_id, u32 sink_id,
665 				   const struct avs_audio_format *src_fmt,
666 				   const struct avs_audio_format *sink_fmt)
667 {
668 	struct avs_copier_sink_format cpr_fmt;
669 
670 	cpr_fmt.sink_id = sink_id;
671 	/* Firmware expects driver to resend copier's input format. */
672 	cpr_fmt.src_fmt = *src_fmt;
673 	cpr_fmt.sink_fmt = *sink_fmt;
674 
675 	return avs_ipc_set_large_config(adev, module_id, instance_id,
676 					AVS_COPIER_SET_SINK_FORMAT,
677 					(u8 *)&cpr_fmt, sizeof(cpr_fmt));
678 }
679 
avs_ipc_peakvol_get_volume(struct avs_dev * adev,u16 module_id,u8 instance_id,struct avs_volume_cfg ** vols,size_t * num_vols)680 int avs_ipc_peakvol_get_volume(struct avs_dev *adev, u16 module_id, u8 instance_id,
681 			       struct avs_volume_cfg **vols, size_t *num_vols)
682 {
683 	size_t payload_size;
684 	u8 *payload;
685 	int ret;
686 
687 	ret = avs_ipc_get_large_config(adev, module_id, instance_id, AVS_PEAKVOL_VOLUME, NULL, 0,
688 				       &payload, &payload_size);
689 	if (ret)
690 		return ret;
691 
692 	/* Non-zero payload expected for PEAKVOL_VOLUME. */
693 	if (!payload_size)
694 		return -EREMOTEIO;
695 
696 	*vols = (struct avs_volume_cfg *)payload;
697 	*num_vols = payload_size / sizeof(**vols);
698 
699 	return 0;
700 }
701 
avs_ipc_peakvol_set_volume(struct avs_dev * adev,u16 module_id,u8 instance_id,struct avs_volume_cfg * vol)702 int avs_ipc_peakvol_set_volume(struct avs_dev *adev, u16 module_id, u8 instance_id,
703 			       struct avs_volume_cfg *vol)
704 {
705 	return avs_ipc_set_large_config(adev, module_id, instance_id, AVS_PEAKVOL_VOLUME,
706 					(u8 *)vol, sizeof(*vol));
707 }
708 
avs_ipc_peakvol_set_volumes(struct avs_dev * adev,u16 module_id,u8 instance_id,struct avs_volume_cfg * vols,size_t num_vols)709 int avs_ipc_peakvol_set_volumes(struct avs_dev *adev, u16 module_id, u8 instance_id,
710 				struct avs_volume_cfg *vols, size_t num_vols)
711 {
712 	struct avs_tlv *tlv;
713 	size_t offset;
714 	size_t size;
715 	u8 *payload;
716 	int ret, i;
717 
718 	size = num_vols * sizeof(*vols);
719 	size += num_vols * sizeof(*tlv);
720 	if (size > AVS_MAILBOX_SIZE)
721 		return -EINVAL;
722 
723 	payload = kzalloc(AVS_MAILBOX_SIZE, GFP_KERNEL);
724 	if (!payload)
725 		return -ENOMEM;
726 
727 	for (offset = i = 0; i < num_vols; i++) {
728 		tlv = (struct avs_tlv *)(payload + offset);
729 
730 		tlv->type = AVS_PEAKVOL_VOLUME;
731 		tlv->length = sizeof(*vols);
732 		memcpy(tlv->value, &vols[i], tlv->length);
733 
734 		offset += sizeof(*tlv) + tlv->length;
735 	}
736 
737 	ret = avs_ipc_set_large_config(adev, module_id, instance_id, AVS_VENDOR_CONFIG, payload,
738 				       size);
739 	kfree(payload);
740 	return ret;
741 }
742 
avs_ipc_peakvol_get_mute(struct avs_dev * adev,u16 module_id,u8 instance_id,struct avs_mute_cfg ** mutes,size_t * num_mutes)743 int avs_ipc_peakvol_get_mute(struct avs_dev *adev, u16 module_id, u8 instance_id,
744 			     struct avs_mute_cfg **mutes, size_t *num_mutes)
745 {
746 	size_t payload_size;
747 	u8 *payload;
748 	int ret;
749 
750 	ret = avs_ipc_get_large_config(adev, module_id, instance_id, AVS_PEAKVOL_MUTE, NULL, 0,
751 				       &payload, &payload_size);
752 	if (ret)
753 		return ret;
754 
755 	/* Non-zero payload expected for PEAKVOL_MUTE. */
756 	if (!payload_size)
757 		return -EREMOTEIO;
758 
759 	*mutes = (struct avs_mute_cfg *)payload;
760 	*num_mutes = payload_size / sizeof(**mutes);
761 
762 	return 0;
763 }
764 
avs_ipc_peakvol_set_mute(struct avs_dev * adev,u16 module_id,u8 instance_id,struct avs_mute_cfg * mute)765 int avs_ipc_peakvol_set_mute(struct avs_dev *adev, u16 module_id, u8 instance_id,
766 			     struct avs_mute_cfg *mute)
767 {
768 	return avs_ipc_set_large_config(adev, module_id, instance_id, AVS_PEAKVOL_MUTE,
769 					(u8 *)mute, sizeof(*mute));
770 }
771 
avs_ipc_peakvol_set_mutes(struct avs_dev * adev,u16 module_id,u8 instance_id,struct avs_mute_cfg * mutes,size_t num_mutes)772 int avs_ipc_peakvol_set_mutes(struct avs_dev *adev, u16 module_id, u8 instance_id,
773 			      struct avs_mute_cfg *mutes, size_t num_mutes)
774 {
775 	struct avs_tlv *tlv;
776 	size_t offset;
777 	size_t size;
778 	u8 *payload;
779 	int ret, i;
780 
781 	size = num_mutes * sizeof(*mutes);
782 	size += num_mutes * sizeof(*tlv);
783 	if (size > AVS_MAILBOX_SIZE)
784 		return -EINVAL;
785 
786 	payload = kzalloc(AVS_MAILBOX_SIZE, GFP_KERNEL);
787 	if (!payload)
788 		return -ENOMEM;
789 
790 	for (offset = i = 0; i < num_mutes; i++) {
791 		tlv = (struct avs_tlv *)(payload + offset);
792 
793 		tlv->type = AVS_PEAKVOL_MUTE;
794 		tlv->length = sizeof(*mutes);
795 		memcpy(tlv->value, &mutes[i], tlv->length);
796 
797 		offset += sizeof(*tlv) + tlv->length;
798 	}
799 
800 	ret = avs_ipc_set_large_config(adev, module_id, instance_id, AVS_VENDOR_CONFIG, payload,
801 				       size);
802 	kfree(payload);
803 	return ret;
804 }
805 
806 #ifdef CONFIG_DEBUG_FS
avs_ipc_set_enable_logs(struct avs_dev * adev,u8 * log_info,size_t size)807 int avs_ipc_set_enable_logs(struct avs_dev *adev, u8 *log_info, size_t size)
808 {
809 	return avs_ipc_set_large_config(adev, AVS_BASEFW_MOD_ID, AVS_BASEFW_INST_ID,
810 					AVS_BASEFW_ENABLE_LOGS, log_info, size);
811 }
812 
avs_ipc_set_system_time(struct avs_dev * adev)813 int avs_ipc_set_system_time(struct avs_dev *adev)
814 {
815 	struct avs_sys_time sys_time;
816 	u64 us;
817 
818 	/* firmware expects UTC time in micro seconds */
819 	us = ktime_to_us(ktime_get());
820 	sys_time.val_l = us & UINT_MAX;
821 	sys_time.val_u = us >> 32;
822 
823 	return avs_ipc_set_large_config(adev, AVS_BASEFW_MOD_ID, AVS_BASEFW_INST_ID,
824 					AVS_BASEFW_SYSTEM_TIME, (u8 *)&sys_time, sizeof(sys_time));
825 }
826 
avs_ipc_probe_get_dma(struct avs_dev * adev,struct avs_probe_dma ** dmas,size_t * num_dmas)827 int avs_ipc_probe_get_dma(struct avs_dev *adev, struct avs_probe_dma **dmas, size_t *num_dmas)
828 {
829 	size_t payload_size;
830 	u32 module_id;
831 	u8 *payload;
832 	int ret;
833 
834 	module_id = avs_get_module_id(adev, &AVS_PROBE_MOD_UUID);
835 
836 	ret = avs_ipc_get_large_config(adev, module_id, AVS_PROBE_INST_ID, AVS_PROBE_INJECTION_DMA,
837 				       NULL, 0, &payload, &payload_size);
838 	if (ret)
839 		return ret;
840 
841 	*dmas = (struct avs_probe_dma *)payload;
842 	*num_dmas = payload_size / sizeof(**dmas);
843 
844 	return 0;
845 }
846 
avs_ipc_probe_attach_dma(struct avs_dev * adev,struct avs_probe_dma * dmas,size_t num_dmas)847 int avs_ipc_probe_attach_dma(struct avs_dev *adev, struct avs_probe_dma *dmas, size_t num_dmas)
848 {
849 	u32 module_id = avs_get_module_id(adev, &AVS_PROBE_MOD_UUID);
850 
851 	return avs_ipc_set_large_config(adev, module_id, AVS_PROBE_INST_ID, AVS_PROBE_INJECTION_DMA,
852 					(u8 *)dmas, array_size(sizeof(*dmas), num_dmas));
853 }
854 
avs_ipc_probe_detach_dma(struct avs_dev * adev,union avs_connector_node_id * node_ids,size_t num_node_ids)855 int avs_ipc_probe_detach_dma(struct avs_dev *adev, union avs_connector_node_id *node_ids,
856 			     size_t num_node_ids)
857 {
858 	u32 module_id = avs_get_module_id(adev, &AVS_PROBE_MOD_UUID);
859 
860 	return avs_ipc_set_large_config(adev, module_id, AVS_PROBE_INST_ID,
861 					AVS_PROBE_INJECTION_DMA_DETACH, (u8 *)node_ids,
862 					array_size(sizeof(*node_ids), num_node_ids));
863 }
864 
avs_ipc_probe_get_points(struct avs_dev * adev,struct avs_probe_point_desc ** descs,size_t * num_descs)865 int avs_ipc_probe_get_points(struct avs_dev *adev, struct avs_probe_point_desc **descs,
866 			     size_t *num_descs)
867 {
868 	size_t payload_size;
869 	u32 module_id;
870 	u8 *payload;
871 	int ret;
872 
873 	module_id = avs_get_module_id(adev, &AVS_PROBE_MOD_UUID);
874 
875 	ret = avs_ipc_get_large_config(adev, module_id, AVS_PROBE_INST_ID, AVS_PROBE_POINTS, NULL,
876 				       0, &payload, &payload_size);
877 	if (ret)
878 		return ret;
879 
880 	*descs = (struct avs_probe_point_desc *)payload;
881 	*num_descs = payload_size / sizeof(**descs);
882 
883 	return 0;
884 }
885 
avs_ipc_probe_connect_points(struct avs_dev * adev,struct avs_probe_point_desc * descs,size_t num_descs)886 int avs_ipc_probe_connect_points(struct avs_dev *adev, struct avs_probe_point_desc *descs,
887 				 size_t num_descs)
888 {
889 	u32 module_id = avs_get_module_id(adev, &AVS_PROBE_MOD_UUID);
890 
891 	return avs_ipc_set_large_config(adev, module_id, AVS_PROBE_INST_ID, AVS_PROBE_POINTS,
892 					(u8 *)descs, array_size(sizeof(*descs), num_descs));
893 }
894 
avs_ipc_probe_disconnect_points(struct avs_dev * adev,union avs_probe_point_id * ids,size_t num_ids)895 int avs_ipc_probe_disconnect_points(struct avs_dev *adev, union avs_probe_point_id *ids,
896 				    size_t num_ids)
897 {
898 	u32 module_id = avs_get_module_id(adev, &AVS_PROBE_MOD_UUID);
899 
900 	return avs_ipc_set_large_config(adev, module_id, AVS_PROBE_INST_ID,
901 					AVS_PROBE_POINTS_DISCONNECT, (u8 *)ids,
902 					array_size(sizeof(*ids), num_ids));
903 }
904 #endif
905