performance measurements: add global perf data get ipc

Implement global performance data get ipc which extracts performance data
from MW3

Signed-off-by: Tobiasz Dryjanski <tobiaszx.dryjanski@intel.com>

Author: tobonex

src/audio/base_fw.c

@@ -22,6 +22,7 @@
 #include <sof/audio/module_adapter/module/generic.h>
 #include <sof/schedule/dp_schedule.h>
 #include <sof/schedule/ll_schedule.h>
+#include <sof/debug/telemetry/performance_monitor.h>
 #include <sof/debug/telemetry/telemetry.h>
 #include <sof/debug/telemetry/performance_monitor.h>
 /* FIXME:
@@ -427,6 +428,24 @@ int set_perf_meas_state(const char *data)
 	return IPC4_SUCCESS;
 }
 
+static int global_perf_data_get(uint32_t *data_off_size, char *data)
+{
+#ifdef CONFIG_SOF_TELEMETRY_PERFORMANCE_MEASUREMENTS
+	int ret;
+	struct global_perf_data *perf_data = (struct global_perf_data *)data;
+
+	ret = get_performance_data(perf_data);
+	if (ret < 0)
+		return IPC4_ERROR_INVALID_PARAM;
+	*data_off_size = sizeof(*perf_data)
+			+ perf_data->perf_item_count * sizeof(*perf_data->perf_items);
+
+	return IPC4_SUCCESS;
+#else
+	return IPC4_UNAVAILABLE;
+#endif
+}
+
 static int basefw_get_large_config(struct comp_dev *dev,
 				   uint32_t param_id,
 				   bool first_block,
@@ -466,13 +485,14 @@ static int basefw_get_large_config(struct comp_dev *dev,
 		return basefw_modules_info_get(data_offset, data);
 	case IPC4_LIBRARIES_INFO_GET:
 		return basefw_libraries_info_get(data_offset, data);
+	case IPC4_GLOBAL_PERF_DATA:
+		return global_perf_data_get(data_offset, data);
 	/* TODO: add more support */
 	case IPC4_DSP_RESOURCE_STATE:
 	case IPC4_NOTIFICATION_MASK:
 	case IPC4_PIPELINE_PROPS_GET:
 	case IPC4_GATEWAYS_INFO_GET:
 	case IPC4_PERF_MEASUREMENTS_STATE:
-	case IPC4_GLOBAL_PERF_DATA:
 		COMPILER_FALLTHROUGH;
 	default:
 		break;

src/debug/telemetry/performance_monitor.c

@@ -4,7 +4,12 @@
 //
 // Author: Tobiasz Dryjanski <tobiaszx.dryjanski@intel.com>
 
+#include <sof/audio/component.h>
 #include <sof/debug/telemetry/performance_monitor.h>
+#include <sof/debug/telemetry/telemetry.h>
+#include <sof/lib/cpu.h>
+#include <sof/lib_manager.h>
+
 #include <zephyr/sys/bitarray.h>
 
 #include <errno.h>
@@ -15,7 +20,12 @@
 
 #include <adsp_debug_window.h>
 
+#include <ipc/trace.h>
+#include <ipc4/logging.h>
 #include <ipc4/base_fw.h>
+#include <ipc4/base_fw_vendor.h>
+
+LOG_MODULE_DECLARE(ipc, CONFIG_SOF_LOG_LEVEL);
 
 #define PERFORMANCE_DATA_ENTRIES_COUNT \
 	(CONFIG_MEMORY_WIN_3_SIZE / sizeof(struct perf_data_item_comp))
@@ -188,6 +198,49 @@ void perf_meas_set_state(enum ipc4_perf_measurements_state_set state)
 	perf_measurements_state = state;
 }
 
+int get_performance_data(struct global_perf_data * const global_perf_data)
+{
+	if (!global_perf_data) {
+		tr_err(&ipc_tr, "IPC data is NULL");
+		return -EINVAL;
+	}
+
+	size_t slots_count;
+	size_t slot_idx = 0;
+	struct telemetry_wnd_data *wnd_data =
+		(struct telemetry_wnd_data *)ADSP_DW->slots[SOF_DW_TELEMETRY_SLOT];
+	struct system_tick_info *systick_info =
+		(struct system_tick_info *)wnd_data->system_tick_info;
+
+	/* Fill one performance record with performance stats per core */
+	for (int core_id = 0; core_id < CONFIG_MAX_CORE_COUNT; ++core_id) {
+		if (!(cpu_enabled_cores() & BIT(core_id)))
+			continue;
+		memset(&global_perf_data->perf_items[slot_idx], 0, sizeof(struct perf_data_item));
+
+		global_perf_data->perf_items[slot_idx].resource_id = core_id;
+		global_perf_data->perf_items[slot_idx].avg_kcps =
+			systick_info[core_id].avg_utilization;
+		global_perf_data->perf_items[slot_idx].peak_kcps =
+			systick_info[core_id].peak_utilization;
+		++slot_idx;
+	}
+	slots_count = perf_bitmap_get_occupied(&performance_data_bitmap) + slot_idx;
+	global_perf_data->perf_item_count = slots_count;
+
+	/* fill the rest of the IPC records with data from
+	 * components registered in MW3 for performance measurement
+	 */
+	for (int idx = 0; idx < perf_bitmap_get_size(&performance_data_bitmap) &&
+	     slot_idx < slots_count; ++idx) {
+		if (perf_bitmap_is_bit_clear(&performance_data_bitmap, idx))
+			continue;
+		global_perf_data->perf_items[slot_idx] = perf_data[idx].item;
+		++slot_idx;
+	}
+	return 0;
+}
+
 int performance_monitor_init(void)
 {
 	/* init global performance measurement */

src/include/ipc4/base_fw.h

@@ -758,4 +758,12 @@ struct perf_data_item_comp {
 
 } __packed __aligned(4);
 
+struct global_perf_data {
+	/* Specifies number of items in perf_items array. */
+	uint32_t      perf_item_count;
+	/* Array of global performance measurements. */
+	struct perf_data_item  perf_items[0];
+
+} __packed __aligned(4);
+
 #endif /* __SOF_IPC4_BASE_FW_H__ */

src/include/sof/debug/telemetry/performance_monitor.h

@@ -52,4 +52,12 @@ void perf_meas_set_state(enum ipc4_perf_measurements_state_set state);
  */
 enum ipc4_perf_measurements_state_set perf_meas_get_state(void);
 
+/**
+ * Get global performance data entries.
+ *
+ * @param[out] global_perf_data Struct to be filled with data
+ * @return 0 if succeeded, error code otherwise.
+ */
+int get_performance_data(struct global_perf_data * const global_perf_data);
+
 #endif