forked from Minki/linux
ASoC: Intel: avs: Add module management requests
Firmware modules implement processing algorithms. Their lifecycle, similarly to pipelines is being controlled by IPCs: initialization, deletion and (un)binding. Modules can be configured at runtime - runtime parameters. This is done with help of LARGE_CONFIG IPCs: getter and setter. Due to firmware limitations, LARGE_CONFIG_GET handler implementation does not support retrieving payload with size larger than IPC inbox window size. Signed-off-by: Amadeusz Sławiński <amadeuszx.slawinski@linux.intel.com> Signed-off-by: Cezary Rojewski <cezary.rojewski@intel.com> Link: https://lore.kernel.org/r/20220311153544.136854-8-cezary.rojewski@intel.com Signed-off-by: Mark Brown <broonie@kernel.org>
This commit is contained in:
Cezary Rojewski
Mark Brown
parent
b956b27b47
commit
f14a1c5a9f
@ -21,8 +21,14 @@ static void avs_dsp_receive_rx(struct avs_dev *adev, u64 header)
|
||||
|
||||
ipc->rx.header = header;
|
||||
/* Abort copying payload if request processing was unsuccessful. */
|
||||
if (!msg.status)
|
||||
if (!msg.status) {
|
||||
/* update size in case of LARGE_CONFIG_GET */
|
||||
if (msg.msg_target == AVS_MOD_MSG &&
|
||||
msg.global_msg_type == AVS_MOD_LARGE_CONFIG_GET)
|
||||
ipc->rx.size = msg.ext.large_config.data_off_size;
|
||||
|
||||
memcpy_fromio(ipc->rx.data, avs_uplink_addr(adev), ipc->rx.size);
|
||||
}
|
||||
}
|
||||
|
||||
static void avs_dsp_process_notification(struct avs_dev *adev, u64 header)
|
||||
|
||||
@ -6,6 +6,7 @@
|
||||
// Amadeusz Slawinski <amadeuszx.slawinski@linux.intel.com>
|
||||
//
|
||||
|
||||
#include <linux/slab.h>
|
||||
#include "avs.h"
|
||||
#include "messages.h"
|
||||
|
||||
@ -139,3 +140,263 @@ int avs_ipc_get_pipeline_state(struct avs_dev *adev, u8 instance_id,
|
||||
*state = reply.rsp.ext.get_ppl_state.state;
|
||||
return ret;
|
||||
}
|
||||
|
||||
/*
|
||||
* avs_ipc_init_instance - Initialize module instance
|
||||
*
|
||||
* @adev: Driver context
|
||||
* @module_id: Module-type id
|
||||
* @instance_id: Unique module instance id
|
||||
* @ppl_id: Parent pipeline id
|
||||
* @core_id: DSP core to allocate module on
|
||||
* @domain: Processing domain (low latency or data processing)
|
||||
* @param: Module-type specific configuration
|
||||
* @param_size: Size of @param in bytes
|
||||
*
|
||||
* Argument verification, as well as pipeline state checks are done by the
|
||||
* firmware.
|
||||
*
|
||||
* Note: @ppl_id and @core_id are independent of each other as single pipeline
|
||||
* can be composed of module instances located on different DSP cores.
|
||||
*/
|
||||
int 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)
|
||||
{
|
||||
union avs_module_msg msg = AVS_MODULE_REQUEST(INIT_INSTANCE);
|
||||
struct avs_ipc_msg request;
|
||||
int ret;
|
||||
|
||||
msg.module_id = module_id;
|
||||
msg.instance_id = instance_id;
|
||||
/* firmware expects size provided in dwords */
|
||||
msg.ext.init_instance.param_block_size = DIV_ROUND_UP(param_size, sizeof(u32));
|
||||
msg.ext.init_instance.ppl_instance_id = ppl_id;
|
||||
msg.ext.init_instance.core_id = core_id;
|
||||
msg.ext.init_instance.proc_domain = domain;
|
||||
|
||||
request.header = msg.val;
|
||||
request.data = param;
|
||||
request.size = param_size;
|
||||
|
||||
ret = avs_dsp_send_msg(adev, &request, NULL);
|
||||
if (ret)
|
||||
avs_ipc_err(adev, &request, "init instance", ret);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
/*
|
||||
* avs_ipc_delete_instance - Delete module instance
|
||||
*
|
||||
* @adev: Driver context
|
||||
* @module_id: Module-type id
|
||||
* @instance_id: Unique module instance id
|
||||
*
|
||||
* Argument verification, as well as pipeline state checks are done by the
|
||||
* firmware.
|
||||
*
|
||||
* Note: only standalone modules i.e. without a parent pipeline shall be
|
||||
* deleted using this IPC message. In all other cases, pipeline owning the
|
||||
* modules performs cleanup automatically when it is deleted.
|
||||
*/
|
||||
int avs_ipc_delete_instance(struct avs_dev *adev, u16 module_id, u8 instance_id)
|
||||
{
|
||||
union avs_module_msg msg = AVS_MODULE_REQUEST(DELETE_INSTANCE);
|
||||
struct avs_ipc_msg request = {{0}};
|
||||
int ret;
|
||||
|
||||
msg.module_id = module_id;
|
||||
msg.instance_id = instance_id;
|
||||
request.header = msg.val;
|
||||
|
||||
ret = avs_dsp_send_msg(adev, &request, NULL);
|
||||
if (ret)
|
||||
avs_ipc_err(adev, &request, "delete instance", ret);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
/*
|
||||
* avs_ipc_bind - Bind two module instances
|
||||
*
|
||||
* @adev: Driver context
|
||||
* @module_id: Source module-type id
|
||||
* @instance_id: Source module instance id
|
||||
* @dst_module_id: Sink module-type id
|
||||
* @dst_instance_id: Sink module instance id
|
||||
* @dst_queue: Sink module pin to bind @src_queue with
|
||||
* @src_queue: Source module pin to bind @dst_queue with
|
||||
*/
|
||||
int 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)
|
||||
{
|
||||
union avs_module_msg msg = AVS_MODULE_REQUEST(BIND);
|
||||
struct avs_ipc_msg request = {{0}};
|
||||
int ret;
|
||||
|
||||
msg.module_id = module_id;
|
||||
msg.instance_id = instance_id;
|
||||
msg.ext.bind_unbind.dst_module_id = dst_module_id;
|
||||
msg.ext.bind_unbind.dst_instance_id = dst_instance_id;
|
||||
msg.ext.bind_unbind.dst_queue = dst_queue;
|
||||
msg.ext.bind_unbind.src_queue = src_queue;
|
||||
request.header = msg.val;
|
||||
|
||||
ret = avs_dsp_send_msg(adev, &request, NULL);
|
||||
if (ret)
|
||||
avs_ipc_err(adev, &request, "bind modules", ret);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
/*
|
||||
* avs_ipc_unbind - Unbind two module instances
|
||||
*
|
||||
* @adev: Driver context
|
||||
* @module_id: Source module-type id
|
||||
* @instance_id: Source module instance id
|
||||
* @dst_module_id: Sink module-type id
|
||||
* @dst_instance_id: Sink module instance id
|
||||
* @dst_queue: Sink module pin to unbind @src_queue from
|
||||
* @src_queue: Source module pin to unbind @dst_queue from
|
||||
*/
|
||||
int 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)
|
||||
{
|
||||
union avs_module_msg msg = AVS_MODULE_REQUEST(UNBIND);
|
||||
struct avs_ipc_msg request = {{0}};
|
||||
int ret;
|
||||
|
||||
msg.module_id = module_id;
|
||||
msg.instance_id = instance_id;
|
||||
msg.ext.bind_unbind.dst_module_id = dst_module_id;
|
||||
msg.ext.bind_unbind.dst_instance_id = dst_instance_id;
|
||||
msg.ext.bind_unbind.dst_queue = dst_queue;
|
||||
msg.ext.bind_unbind.src_queue = src_queue;
|
||||
request.header = msg.val;
|
||||
|
||||
ret = avs_dsp_send_msg(adev, &request, NULL);
|
||||
if (ret)
|
||||
avs_ipc_err(adev, &request, "unbind modules", ret);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int __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)
|
||||
{
|
||||
union avs_module_msg msg = AVS_MODULE_REQUEST(LARGE_CONFIG_SET);
|
||||
struct avs_ipc_msg request;
|
||||
int ret;
|
||||
|
||||
msg.module_id = module_id;
|
||||
msg.instance_id = instance_id;
|
||||
msg.ext.large_config.data_off_size = off_size;
|
||||
msg.ext.large_config.large_param_id = param_id;
|
||||
msg.ext.large_config.final_block = final_block;
|
||||
msg.ext.large_config.init_block = init_block;
|
||||
|
||||
request.header = msg.val;
|
||||
request.data = request_data;
|
||||
request.size = request_size;
|
||||
|
||||
ret = avs_dsp_send_msg(adev, &request, NULL);
|
||||
if (ret)
|
||||
avs_ipc_err(adev, &request, "large config set", ret);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
int avs_ipc_set_large_config(struct avs_dev *adev, u16 module_id,
|
||||
u8 instance_id, u8 param_id,
|
||||
u8 *request, size_t request_size)
|
||||
{
|
||||
size_t remaining, tx_size;
|
||||
bool final;
|
||||
int ret;
|
||||
|
||||
remaining = request_size;
|
||||
tx_size = min_t(size_t, AVS_MAILBOX_SIZE, remaining);
|
||||
final = (tx_size == remaining);
|
||||
|
||||
/* Initial request states total payload size. */
|
||||
ret = __avs_ipc_set_large_config(adev, module_id, instance_id,
|
||||
param_id, 1, final, request, tx_size,
|
||||
request_size);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
remaining -= tx_size;
|
||||
|
||||
/* Loop the rest only when payload exceeds mailbox's size. */
|
||||
while (remaining) {
|
||||
size_t offset;
|
||||
|
||||
offset = request_size - remaining;
|
||||
tx_size = min_t(size_t, AVS_MAILBOX_SIZE, remaining);
|
||||
final = (tx_size == remaining);
|
||||
|
||||
ret = __avs_ipc_set_large_config(adev, module_id, instance_id,
|
||||
param_id, 0, final,
|
||||
request + offset, tx_size,
|
||||
offset);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
remaining -= tx_size;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int 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)
|
||||
{
|
||||
union avs_module_msg msg = AVS_MODULE_REQUEST(LARGE_CONFIG_GET);
|
||||
struct avs_ipc_msg request;
|
||||
struct avs_ipc_msg reply = {{0}};
|
||||
size_t size;
|
||||
void *buf;
|
||||
int ret;
|
||||
|
||||
reply.data = kzalloc(AVS_MAILBOX_SIZE, GFP_KERNEL);
|
||||
if (!reply.data)
|
||||
return -ENOMEM;
|
||||
|
||||
msg.module_id = module_id;
|
||||
msg.instance_id = instance_id;
|
||||
msg.ext.large_config.data_off_size = request_size;
|
||||
msg.ext.large_config.large_param_id = param_id;
|
||||
/* final_block is always 0 on request. Updated by fw on reply. */
|
||||
msg.ext.large_config.final_block = 0;
|
||||
msg.ext.large_config.init_block = 1;
|
||||
|
||||
request.header = msg.val;
|
||||
request.data = request_data;
|
||||
request.size = request_size;
|
||||
reply.size = AVS_MAILBOX_SIZE;
|
||||
|
||||
ret = avs_dsp_send_msg(adev, &request, &reply);
|
||||
if (ret) {
|
||||
avs_ipc_err(adev, &request, "large config get", ret);
|
||||
kfree(reply.data);
|
||||
return ret;
|
||||
}
|
||||
|
||||
size = reply.rsp.ext.large_config.data_off_size;
|
||||
buf = krealloc(reply.data, size, GFP_KERNEL);
|
||||
if (!buf) {
|
||||
kfree(reply.data);
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
*reply_data = buf;
|
||||
*reply_size = size;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
@ -91,6 +91,15 @@ struct avs_tlv {
|
||||
u32 value[];
|
||||
} __packed;
|
||||
|
||||
enum avs_module_msg_type {
|
||||
AVS_MOD_INIT_INSTANCE = 0,
|
||||
AVS_MOD_LARGE_CONFIG_GET = 3,
|
||||
AVS_MOD_LARGE_CONFIG_SET = 4,
|
||||
AVS_MOD_BIND = 5,
|
||||
AVS_MOD_UNBIND = 6,
|
||||
AVS_MOD_DELETE_INSTANCE = 11,
|
||||
};
|
||||
|
||||
union avs_module_msg {
|
||||
u64 val;
|
||||
struct {
|
||||
@ -106,6 +115,24 @@ union avs_module_msg {
|
||||
};
|
||||
union {
|
||||
u32 val;
|
||||
struct {
|
||||
u32 param_block_size:16;
|
||||
u32 ppl_instance_id:8;
|
||||
u32 core_id:4;
|
||||
u32 proc_domain:1;
|
||||
} init_instance;
|
||||
struct {
|
||||
u32 data_off_size:20;
|
||||
u32 large_param_id:8;
|
||||
u32 final_block:1;
|
||||
u32 init_block:1;
|
||||
} large_config;
|
||||
struct {
|
||||
u32 dst_module_id:16;
|
||||
u32 dst_instance_id:8;
|
||||
u32 dst_queue:3;
|
||||
u32 src_queue:3;
|
||||
} bind_unbind;
|
||||
} ext;
|
||||
};
|
||||
} __packed;
|
||||
@ -132,6 +159,13 @@ union avs_reply_msg {
|
||||
struct {
|
||||
u32 state:5;
|
||||
} get_ppl_state;
|
||||
/* module management */
|
||||
struct {
|
||||
u32 data_off_size:20;
|
||||
u32 large_param_id:8;
|
||||
u32 final_block:1;
|
||||
u32 init_block:1;
|
||||
} large_config;
|
||||
} ext;
|
||||
};
|
||||
} __packed;
|
||||
@ -237,4 +271,22 @@ int avs_ipc_set_pipeline_state(struct avs_dev *adev, u8 instance_id,
|
||||
int avs_ipc_get_pipeline_state(struct avs_dev *adev, u8 instance_id,
|
||||
enum avs_pipeline_state *state);
|
||||
|
||||
/* Module management messages */
|
||||
int 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);
|
||||
int avs_ipc_delete_instance(struct avs_dev *adev, u16 module_id, u8 instance_id);
|
||||
int 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);
|
||||
int 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);
|
||||
int avs_ipc_set_large_config(struct avs_dev *adev, u16 module_id,
|
||||
u8 instance_id, u8 param_id,
|
||||
u8 *request, size_t request_size);
|
||||
int 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);
|
||||
|
||||
#endif /* __SOUND_SOC_INTEL_AVS_MSGS_H */
|
||||
|
||||
Loading…
Reference in New Issue
Block a user