Audio: basefw: Implement ipc4 modules info get

Added support for ipc4 query no 9.
This make it possible to get information about the current loaded modules.

Signed-off-by: Grzegorz Bernat <grzegorzx.bernat@intel.com>

src/audio/base_fw.c

@@ -436,7 +436,7 @@ static int basefw_libraries_info_get(uint32_t *data_offset, char *data)
  tr_err(&basefw_comp_tr, "Error with message size");
  return -ENOMEM;
  }
-
+ // test
  struct ipc4_libraries_info *const libs_info = (struct ipc4_libraries_info *)data;
  const struct sof_man_fw_desc *desc;
  int lib_counter = 0;
@@ -479,6 +479,11 @@ static int basefw_libraries_info_get(uint32_t *data_offset, char *data)
  return 0;
 }
 
+static int basefw_modules_info_get(uint32_t *data_offset, char *data)
+{
+ return platform_basefw_modules_info_get(data_offset, data);
+}
+
 static int fw_config_set_force_l1_exit(const struct sof_tlv *tlv)
 {
 #if defined(CONFIG_SOC_SERIES_INTEL_ADSP_ACE)
@@ -655,7 +660,9 @@ static int basefw_get_large_config(struct comp_dev *dev,
  /* TODO: add more support */
  case IPC4_DSP_RESOURCE_STATE:
  case IPC4_NOTIFICATION_MASK:
+ break;
  case IPC4_MODULES_INFO_GET:
+ return basefw_modules_info_get(data_offset, data);
  case IPC4_PIPELINE_PROPS_GET:
  case IPC4_GATEWAYS_INFO_GET:
  break;

src/include/ipc4/base_fw_platform.h

@@ -29,4 +29,13 @@ int platform_basefw_hw_config(uint32_t *data_offset, char *data);
  */
 struct sof_man_fw_desc *platform_base_fw_get_manifest(void);
 
+/**
+ * \brief Platform specific routine to get information about modules.
+ * Function add information and sent to host via IPC.
+ * \param[out] data_offset data offset after structure added
+ * \param[in] data pointer where to add new entries
+ * \return 0 if successful, error code otherwise.
+ */
+int platform_basefw_modules_info_get(uint32_t *data_offset, char *data);
+
 #endif /* __SOF_IPC4_BASE_FW_PLATFORM_H__ */

src/platform/intel/ace/lib/base_fw_platform.c

@@ -8,6 +8,12 @@
 #include <sof/tlv.h>
 #include <sof/lib/dai.h>
 #include <ipc4/base_fw.h>
+#include <rimage/sof/user/manifest.h>
+
+struct ipc4_modules_info {
+ uint32_t modules_count;
+ struct sof_man_module modules[0];
+} __packed __aligned(4);
 
 int platform_basefw_hw_config(uint32_t *data_offset, char *data)
 {
@@ -39,3 +45,25 @@ struct sof_man_fw_desc *platform_base_fw_get_manifest(void)
 
  return desc;
 }
+
+int platform_basefw_modules_info_get(uint32_t *data_offset, char *data)
+{
+ struct ipc4_modules_info *const module_info = (struct ipc4_modules_info *)data;
+ struct sof_man_fw_desc *desc = platform_base_fw_get_manifest();
+
+ if (!desc)
+ return -EINVAL;
+
+ module_info->modules_count = desc->header.num_module_entries;
+
+ for (int idx = 0; idx < module_info->modules_count; ++idx) {
+ struct sof_man_module *module_entry =
+ (struct sof_man_module *)((char *)desc + SOF_MAN_MODULE_OFFSET(idx));
+ memcpy_s(&module_info->modules[idx], sizeof(module_info->modules[idx]),
+ module_entry, sizeof(struct sof_man_module));
+ }
+
+ *data_offset = sizeof(module_info) +
+ module_info->modules_count * sizeof(module_info->modules[0]);
+ return 0;
+}

src/platform/posix/base_fw_platform.c

@@ -21,3 +21,10 @@ struct sof_man_fw_desc *platform_base_fw_get_manifest(void)
 
  return desc;
 }
+
+int platform_basefw_modules_info_get(uint32_t *data_offset, char *data)
+{
+ *data_offset = 0;
+
+ return 0;
+}