|
5 | 5 | */
|
6 | 6 | #include <zephyr/ztest.h>
|
7 | 7 | #include <zephyr/drivers/timer/nrf_grtc_timer.h>
|
8 |
| -#include <zephyr/drivers/counter.h> |
9 |
| -#include <zephyr/drivers/timer/system_timer.h> |
10 |
| -#include <zephyr/random/random.h> |
11 |
| -#include <zephyr/logging/log.h> |
12 |
| -#include <zephyr/busy_sim.h> |
13 |
| -#include <zephyr/debug/cpu_load.h> |
14 |
| -#include <nrfx_grtc.h> |
15 | 8 | #include <hal/nrf_grtc.h>
|
16 |
| -LOG_MODULE_REGISTER(test, 1); |
17 | 9 |
|
18 | 10 | #define GRTC_SLEW_TICKS 10
|
19 | 11 | #define NUMBER_OF_TRIES 2000
|
@@ -161,243 +153,4 @@ ZTEST(nrf_grtc_timer, test_timer_abort_in_compare_mode)
|
161 | 153 | z_nrf_grtc_timer_chan_free(channel);
|
162 | 154 | }
|
163 | 155 |
|
164 |
| -enum test_timer_state { |
165 |
| - TIMER_IDLE, |
166 |
| - TIMER_PREPARE, |
167 |
| - TIMER_ACTIVE |
168 |
| -}; |
169 |
| - |
170 |
| -enum test_ctx { |
171 |
| - TEST_HIGH_PRI, |
172 |
| - TEST_TIMER_CB, |
173 |
| - TEST_THREAD |
174 |
| -}; |
175 |
| - |
176 |
| -struct test_grtc_timer { |
177 |
| - struct k_timer timer; |
178 |
| - uint32_t ticks; |
179 |
| - uint32_t expire; |
180 |
| - uint32_t start_cnt; |
181 |
| - uint32_t expire_cnt; |
182 |
| - uint32_t abort_cnt; |
183 |
| - uint32_t exp_expire; |
184 |
| - int max_late; |
185 |
| - int min_late; |
186 |
| - int avg_late; |
187 |
| - uint32_t early_cnt; |
188 |
| - enum test_timer_state state; |
189 |
| -}; |
190 |
| - |
191 |
| -static atomic_t test_active_cnt; |
192 |
| -static struct test_grtc_timer timers[8]; |
193 |
| -static uint32_t test_end; |
194 |
| -static k_tid_t test_tid; |
195 |
| -static volatile bool test_run; |
196 |
| -static uint32_t ctx_cnt[3]; |
197 |
| -static const char *const ctx_name[] = { "HIGH PRIO ISR", "TIMER CALLBACK", "THREAD" }; |
198 |
| - |
199 |
| -static bool stress_test_action(int ctx, int id) |
200 |
| -{ |
201 |
| - struct test_grtc_timer *timer = &timers[id]; |
202 |
| - |
203 |
| - ctx_cnt[ctx]++; |
204 |
| - if (timer->state == TIMER_ACTIVE) { |
205 |
| - /* Aborting soon to expire timers from higher interrupt priority may lead |
206 |
| - * to test failures. |
207 |
| - */ |
208 |
| - if (ctx == 0 && (k_timer_remaining_get(&timer->timer) < 5)) { |
209 |
| - return true; |
210 |
| - } |
211 |
| - |
212 |
| - if (timer->abort_cnt < timer->expire_cnt / 2) { |
213 |
| - bool any_active; |
214 |
| - |
215 |
| - timer->state = TIMER_PREPARE; |
216 |
| - k_timer_stop(&timer->timer); |
217 |
| - timer->abort_cnt++; |
218 |
| - any_active = atomic_dec(&test_active_cnt) > 1; |
219 |
| - timer->state = TIMER_IDLE; |
220 |
| - |
221 |
| - return any_active; |
222 |
| - } |
223 |
| - } else if (timer->state == TIMER_IDLE) { |
224 |
| - int ticks = 10 + (sys_rand32_get() & 0x3F); |
225 |
| - k_timeout_t t = K_TICKS(ticks); |
226 |
| - |
227 |
| - timer->exp_expire = k_ticks_to_cyc_floor32(sys_clock_tick_get_32() + ticks); |
228 |
| - timer->state = TIMER_PREPARE; |
229 |
| - timer->ticks = ticks; |
230 |
| - k_timer_start(&timer->timer, t, K_NO_WAIT); |
231 |
| - atomic_inc(&test_active_cnt); |
232 |
| - timer->start_cnt++; |
233 |
| - timer->state = TIMER_ACTIVE; |
234 |
| - } |
235 |
| - |
236 |
| - return true; |
237 |
| -} |
238 |
| - |
239 |
| -static void stress_test_actions(int ctx) |
240 |
| -{ |
241 |
| - uint32_t r = sys_rand32_get(); |
242 |
| - int action_cnt = Z_MAX(r & 0x3, 1); |
243 |
| - int tmr_id = (r >> 8) % ARRAY_SIZE(timers); |
244 |
| - |
245 |
| - /* Occasionally wake thread context from which timer actions are also executed. */ |
246 |
| - if ((((r >> 2) & 0x3) == 0) || test_active_cnt < 2) { |
247 |
| - LOG_DBG("ctx:%d thread wakeup", ctx); |
248 |
| - k_wakeup(test_tid); |
249 |
| - } |
250 |
| - |
251 |
| - for (int i = 0; i < action_cnt; i++) { |
252 |
| - if (stress_test_action(ctx, tmr_id) == false) { |
253 |
| - stress_test_action(ctx, tmr_id); |
254 |
| - } |
255 |
| - } |
256 |
| -} |
257 |
| - |
258 |
| -static void timer_cb(struct k_timer *timer) |
259 |
| -{ |
260 |
| - struct test_grtc_timer *test_timer = CONTAINER_OF(timer, struct test_grtc_timer, timer); |
261 |
| - uint32_t now = k_cycle_get_32(); |
262 |
| - int diff = now - test_timer->exp_expire; |
263 |
| - |
264 |
| - atomic_dec(&test_active_cnt); |
265 |
| - zassert_true(diff >= 0); |
266 |
| - test_timer->max_late = MAX(diff, test_timer->max_late); |
267 |
| - test_timer->min_late = MIN(diff, test_timer->min_late); |
268 |
| - |
269 |
| - if (test_timer->expire_cnt == 0) { |
270 |
| - test_timer->avg_late = diff; |
271 |
| - } else { |
272 |
| - test_timer->avg_late = (test_timer->avg_late * test_timer->expire_cnt + diff) / |
273 |
| - (test_timer->expire_cnt + 1); |
274 |
| - } |
275 |
| - |
276 |
| - test_timer->expire_cnt++; |
277 |
| - test_timer->state = TIMER_IDLE; |
278 |
| - |
279 |
| - if (test_run) { |
280 |
| - stress_test_actions(TEST_TIMER_CB); |
281 |
| - } |
282 |
| -} |
283 |
| - |
284 |
| -static void counter_set(const struct device *dev, struct counter_alarm_cfg *cfg) |
285 |
| -{ |
286 |
| - int err; |
287 |
| - uint32_t us = 150 + (sys_rand32_get() & 0x3F); |
288 |
| - |
289 |
| - cfg->ticks = counter_us_to_ticks(dev, us); |
290 |
| - err = counter_set_channel_alarm(dev, 0, cfg); |
291 |
| - zassert_equal(err, 0); |
292 |
| -} |
293 |
| - |
294 |
| -static void counter_cb(const struct device *dev, uint8_t chan_id, uint32_t ticks, void *user_data) |
295 |
| -{ |
296 |
| - struct counter_alarm_cfg *config = user_data; |
297 |
| - |
298 |
| - if (test_run) { |
299 |
| - stress_test_actions(TEST_HIGH_PRI); |
300 |
| - counter_set(dev, config); |
301 |
| - } |
302 |
| -} |
303 |
| - |
304 |
| -static void report_progress(uint32_t start, uint32_t end) |
305 |
| -{ |
306 |
| - static uint32_t next_report; |
307 |
| - static uint32_t step; |
308 |
| - static uint32_t progress; |
309 |
| - |
310 |
| - if (next_report == 0) { |
311 |
| - step = (end - start) / 10; |
312 |
| - next_report = start + step; |
313 |
| - } |
314 |
| - |
315 |
| - if (k_uptime_get_32() > next_report) { |
316 |
| - next_report += step; |
317 |
| - progress += 10; |
318 |
| - printk("%d%%\r", progress); |
319 |
| - } |
320 |
| -} |
321 |
| - |
322 |
| -static void grtc_stress_test(bool busy_sim_en) |
323 |
| -{ |
324 |
| - static struct counter_alarm_cfg alarm_cfg; |
325 |
| -#if DT_NODE_EXISTS(DT_NODELABEL(test_timer)) && DT_NODE_HAS_STATUS(DT_NODELABEL(test_timer), okay) |
326 |
| - const struct device *const counter_dev = DEVICE_DT_GET(DT_NODELABEL(test_timer)); |
327 |
| -#else |
328 |
| - const struct device *const counter_dev = NULL; |
329 |
| -#endif |
330 |
| - uint32_t test_ms = 5000; |
331 |
| - uint32_t test_start = k_uptime_get_32(); |
332 |
| - uint32_t load; |
333 |
| - |
334 |
| - test_end = k_cycle_get_32() + k_ms_to_cyc_floor32(test_ms); |
335 |
| - test_tid = k_current_get(); |
336 |
| - |
337 |
| - for (size_t i = 0; i < ARRAY_SIZE(timers); i++) { |
338 |
| - k_timer_init(&timers[i].timer, timer_cb, NULL); |
339 |
| - } |
340 |
| - |
341 |
| - if (IS_ENABLED(CONFIG_CPU_LOAD)) { |
342 |
| - (void)cpu_load_get(true); |
343 |
| - } |
344 |
| - |
345 |
| - if (counter_dev) { |
346 |
| - counter_start(counter_dev); |
347 |
| - } |
348 |
| - |
349 |
| - alarm_cfg.callback = counter_cb; |
350 |
| - alarm_cfg.user_data = &alarm_cfg; |
351 |
| - test_run = true; |
352 |
| - |
353 |
| - if (counter_dev) { |
354 |
| - counter_set(counter_dev, &alarm_cfg); |
355 |
| - } |
356 |
| - |
357 |
| - if (busy_sim_en) { |
358 |
| - busy_sim_start(500, 200, 1000, 400, NULL); |
359 |
| - } |
360 |
| - |
361 |
| - LOG_DBG("Starting test, will end at %d", test_end); |
362 |
| - while (k_cycle_get_32() < test_end) { |
363 |
| - report_progress(test_start, test_start + test_ms); |
364 |
| - stress_test_actions(TEST_THREAD); |
365 |
| - k_sleep(K_MSEC(test_ms)); |
366 |
| - } |
367 |
| - |
368 |
| - load = IS_ENABLED(CONFIG_CPU_LOAD) ? cpu_load_get(true) : 0; |
369 |
| - |
370 |
| - test_run = false; |
371 |
| - k_msleep(50); |
372 |
| - |
373 |
| - for (size_t i = 0; i < ARRAY_SIZE(timers); i++) { |
374 |
| - zassert_equal(timers[i].state, TIMER_IDLE, "Unexpected timer %d state:%d", |
375 |
| - i, timers[i].state); |
376 |
| - TC_PRINT("Timer%d (%p)\r\n\tstart_cnt:%d abort_cnt:%d expire_cnt:%d\n", |
377 |
| - i, &timers[i], timers[i].start_cnt, timers[i].abort_cnt, |
378 |
| - timers[i].expire_cnt); |
379 |
| - TC_PRINT("\tavarage late:%d ticks, max late:%d, min late:%d early:%d\n", |
380 |
| - timers[i].avg_late, timers[i].max_late, timers[i].min_late, |
381 |
| - timers[i].early_cnt); |
382 |
| - } |
383 |
| - |
384 |
| - for (size_t i = 0; i < ARRAY_SIZE(ctx_cnt); i++) { |
385 |
| - TC_PRINT("Context: %s executed %d times\n", ctx_name[i], ctx_cnt[i]); |
386 |
| - } |
387 |
| - TC_PRINT("CPU load during test:%d.%d\n", load / 10, load % 10); |
388 |
| - |
389 |
| - if (busy_sim_en) { |
390 |
| - busy_sim_stop(); |
391 |
| - } |
392 |
| - |
393 |
| - if (counter_dev) { |
394 |
| - counter_stop(counter_dev); |
395 |
| - } |
396 |
| -} |
397 |
| - |
398 |
| -ZTEST(nrf_grtc_timer, test_stress) |
399 |
| -{ |
400 |
| - grtc_stress_test(false); |
401 |
| -} |
402 |
| - |
403 | 156 | ZTEST_SUITE(nrf_grtc_timer, NULL, NULL, NULL, NULL, NULL);
|
0 commit comments