]> git.baikalelectronics.ru Git - kernel.git/commitdiff
ASoC: Intel: avs: Add module management requests
authorCezary Rojewski <cezary.rojewski@intel.com>
Fri, 11 Mar 2022 15:35:34 +0000 (16:35 +0100)
committerMark Brown <broonie@kernel.org>
Fri, 11 Mar 2022 16:23:59 +0000 (16:23 +0000)
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>
sound/soc/intel/avs/ipc.c
sound/soc/intel/avs/messages.c
sound/soc/intel/avs/messages.h

index b1986a82945d46460e0dd19ba0d29bd6cb54c760..68aaf01edbf2e8e48b7c48d42e09442d353cc6d1 100644 (file)
@@ -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)
index 3a6c2f9e9542d05c913035a07705c55361a798fd..2e775798a6c3088bf33881e8d1a791de9812f8f4 100644 (file)
@@ -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;
+}
index 8f18eb7935d156e037e59e47bb2fc5712b7e00aa..d744fe453033d24aa2e05703d9837d6fc382de5c 100644 (file)
@@ -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 */