forked from thesofproject/sof
-
Notifications
You must be signed in to change notification settings - Fork 0
Expand file tree
/
Copy pathtelemetry.c
More file actions
160 lines (137 loc) · 4.84 KB
/
telemetry.c
File metadata and controls
160 lines (137 loc) · 4.84 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
// SPDX-License-Identifier: BSD-3-Clause
//
// Copyright(c) 2024 Intel Corporation. All rights reserved.
//
// Author: Tobiasz Dryjanski <tobiaszx.dryjanski@intel.com>
#include <zephyr/debug/sparse.h>
#include <sof/audio/component.h>
#include <sof/audio/module_adapter/module/generic.h>
#include <sof/debug/telemetry/telemetry.h>
#include <sof/lib_manager.h>
#include <ipc/trace.h>
#include <ipc4/base_fw.h>
#include <ipc4/base_fw_vendor.h>
#include <adsp_debug_window.h>
#include <errno.h>
#include <limits.h>
#include <mem_window.h>
#include <stdbool.h>
#include <stddef.h>
#include <stdint.h>
LOG_MODULE_DECLARE(ipc, CONFIG_SOF_LOG_LEVEL);
/* Systic variables, one set per core */
static int telemetry_systick_counter[CONFIG_MAX_CORE_COUNT];
#ifdef CONFIG_SOF_TELEMETRY_PERFORMANCE_MEASUREMENTS
static int telemetry_prev_ccount[CONFIG_MAX_CORE_COUNT];
static int telemetry_perf_period_sum[CONFIG_MAX_CORE_COUNT];
static int telemetry_perf_period_cnt[CONFIG_MAX_CORE_COUNT];
static struct telemetry_perf_queue telemetry_perf_queue[CONFIG_MAX_CORE_COUNT];
#endif
#ifdef CONFIG_SOF_TELEMETRY_PERFORMANCE_MEASUREMENTS
static void telemetry_perf_queue_append(struct telemetry_perf_queue *q, size_t element)
{
if (!q->full) {
q->elements[q->index] = element;
q->sum += element;
q->index++;
q->size++;
if (q->index >= SOF_AVG_PERF_MEAS_DEPTH) {
q->index = 0;
q->size = SOF_AVG_PERF_MEAS_DEPTH;
q->full = true;
}
} else {
/* no space, pop tail */
q->sum -= q->elements[q->index];
/* replace tail */
q->elements[q->index] = element;
q->sum += element;
/* move tail */
q->index++;
if (q->index >= SOF_AVG_PERF_MEAS_DEPTH)
q->index = 0;
}
}
static size_t telemetry_perf_queue_avg(struct telemetry_perf_queue *q)
{
if (!q->size)
return 0;
return q->sum / q->size;
}
#endif
int telemetry_init(void)
{
/* systick_init */
uint8_t slot_num = SOF_DW_TELEMETRY_SLOT;
volatile struct adsp_debug_window *window = ADSP_DW;
struct telemetry_wnd_data *wnd_data = (struct telemetry_wnd_data *)ADSP_DW->slots[slot_num];
struct system_tick_info *systick_info =
(struct system_tick_info *)wnd_data->system_tick_info;
tr_info(&ipc_tr, "Telemetry enabled. May affect performance");
window->descs[slot_num].type = ADSP_DW_SLOT_TELEMETRY;
window->descs[slot_num].resource_id = 0;
wnd_data->separator_1 = 0x0000C0DE;
/* Zero values per core */
for (int i = 0; i < CONFIG_MAX_CORE_COUNT; i++) {
systick_info[i].count = 0;
systick_info[i].last_time_elapsed = 0;
systick_info[i].max_time_elapsed = 0;
systick_info[i].last_ccount = 0;
systick_info[i].avg_utilization = 0;
systick_info[i].peak_utilization = 0;
systick_info[i].peak_utilization_4k = 0;
systick_info[i].peak_utilization_8k = 0;
}
return 0;
}
void telemetry_update(uint32_t begin_stamp, uint32_t current_stamp)
{
int prid = cpu_get_id();
++telemetry_systick_counter[prid];
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;
systick_info[prid].count = telemetry_systick_counter[prid];
systick_info[prid].last_time_elapsed = current_stamp - begin_stamp;
systick_info[prid].max_time_elapsed =
MAX(current_stamp - begin_stamp,
systick_info[prid].max_time_elapsed);
systick_info[prid].last_ccount = current_stamp;
#ifdef CONFIG_SOF_TELEMETRY_PERFORMANCE_MEASUREMENTS
const size_t measured_systick = begin_stamp - telemetry_prev_ccount[prid];
telemetry_prev_ccount[prid] = begin_stamp;
if (telemetry_systick_counter[prid] > 2) {
telemetry_perf_period_sum[prid] += measured_systick;
telemetry_perf_period_cnt[prid] =
(telemetry_perf_period_cnt[prid] + 1) % SOF_AVG_PERF_MEAS_PERIOD;
if (telemetry_perf_period_cnt[prid] == 0) {
/* Append average of last SOF_AVG_PERF_MEAS_PERIOD runs */
telemetry_perf_queue_append(&telemetry_perf_queue[prid],
telemetry_perf_period_sum[prid]
/ SOF_AVG_PERF_MEAS_PERIOD);
telemetry_perf_period_sum[prid] = 0;
/* Calculate average from all buckets */
systick_info[prid].avg_utilization =
telemetry_perf_queue_avg(&telemetry_perf_queue[prid]);
}
systick_info[prid].peak_utilization =
MAX(systick_info[prid].peak_utilization,
measured_systick);
systick_info[prid].peak_utilization_4k =
MAX(systick_info[prid].peak_utilization_4k,
measured_systick);
systick_info[prid].peak_utilization_8k =
MAX(systick_info[prid].peak_utilization_8k,
measured_systick);
/* optimized: counter % 0x1000 */
if ((telemetry_systick_counter[prid] & 0xfff) == 0)
systick_info[prid].peak_utilization_4k = 0;
/* optimized: counter % 0x2000 */
if ((telemetry_systick_counter[prid] & 0x1fff) == 0)
systick_info[prid].peak_utilization_8k = 0;
}
#endif
}
/* init telemetry using Zephyr*/
SYS_INIT(telemetry_init, APPLICATION, CONFIG_APPLICATION_INIT_PRIORITY);