2ccc3ce6aa
Local variable for counter device is missing static keyword. Signed-off-by: Krzysztof Chruściński <krzysztof.chruscinski@nordicsemi.no>
121 lines
2.6 KiB
C
121 lines
2.6 KiB
C
/*
|
|
* Copyright (c) 2024, Nordic Semiconductor ASA
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#include <zephyr/debug/cpu_load.h>
|
|
#include <zephyr/kernel.h>
|
|
#include <zephyr/drivers/counter.h>
|
|
#include <zephyr/logging/log.h>
|
|
LOG_MODULE_REGISTER(cpu_load, CONFIG_CPU_LOAD_LOG_LEVEL);
|
|
|
|
BUILD_ASSERT(!IS_ENABLED(CONFIG_CPU_LOAD_USE_COUNTER) || DT_HAS_CHOSEN(zephyr_cpu_load_counter));
|
|
|
|
#ifndef CONFIG_CPU_LOAD_LOG_PERIODICALLY
|
|
#define CONFIG_CPU_LOAD_LOG_PERIODICALLY 0
|
|
#endif
|
|
|
|
static const struct device *counter = COND_CODE_1(CONFIG_CPU_LOAD_USE_COUNTER,
|
|
(DEVICE_DT_GET(DT_CHOSEN(zephyr_cpu_load_counter))), (NULL));
|
|
static uint32_t enter_ts;
|
|
static uint32_t cyc_start;
|
|
static uint32_t ticks_idle;
|
|
|
|
static struct k_work_delayable cpu_load_log;
|
|
|
|
void cpu_load_log_control(bool enable)
|
|
{
|
|
if (CONFIG_CPU_LOAD_LOG_PERIODICALLY == 0) {
|
|
return;
|
|
}
|
|
|
|
if (enable) {
|
|
(void)cpu_load_get(true);
|
|
k_work_schedule(&cpu_load_log, K_MSEC(CONFIG_CPU_LOAD_LOG_PERIODICALLY));
|
|
} else {
|
|
k_work_cancel_delayable(&cpu_load_log);
|
|
}
|
|
}
|
|
|
|
#if CONFIG_CPU_LOAD_USE_COUNTER || CONFIG_CPU_LOAD_LOG_PERIODICALLY
|
|
static void cpu_load_log_fn(struct k_work *work)
|
|
{
|
|
int load = cpu_load_get(true);
|
|
uint32_t percent = load / 10;
|
|
uint32_t fraction = load % 10;
|
|
|
|
LOG_INF("Load:%d.%03d%%", percent, fraction);
|
|
cpu_load_log_control(true);
|
|
}
|
|
|
|
static int cpu_load_init(void)
|
|
{
|
|
if (IS_ENABLED(CONFIG_CPU_LOAD_USE_COUNTER)) {
|
|
int err = counter_start(counter);
|
|
|
|
(void)err;
|
|
__ASSERT_NO_MSG(err == 0);
|
|
}
|
|
|
|
if (CONFIG_CPU_LOAD_LOG_PERIODICALLY > 0) {
|
|
k_work_init_delayable(&cpu_load_log, cpu_load_log_fn);
|
|
return k_work_schedule(&cpu_load_log, K_MSEC(CONFIG_CPU_LOAD_LOG_PERIODICALLY));
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
SYS_INIT(cpu_load_init, POST_KERNEL, 0);
|
|
#endif
|
|
|
|
void cpu_load_on_enter_idle(void)
|
|
{
|
|
if (IS_ENABLED(CONFIG_CPU_LOAD_USE_COUNTER)) {
|
|
counter_get_value(counter, &enter_ts);
|
|
return;
|
|
}
|
|
|
|
enter_ts = k_cycle_get_32();
|
|
}
|
|
|
|
void cpu_load_on_exit_idle(void)
|
|
{
|
|
uint32_t now;
|
|
|
|
if (IS_ENABLED(CONFIG_CPU_LOAD_USE_COUNTER)) {
|
|
counter_get_value(counter, &now);
|
|
} else {
|
|
now = k_cycle_get_32();
|
|
}
|
|
|
|
ticks_idle += now - enter_ts;
|
|
}
|
|
|
|
int cpu_load_get(bool reset)
|
|
{
|
|
uint32_t idle_us;
|
|
uint32_t total = k_cycle_get_32() - cyc_start;
|
|
uint32_t total_us = (uint32_t)k_cyc_to_us_floor32(total);
|
|
uint32_t res;
|
|
uint32_t active_us;
|
|
|
|
if (IS_ENABLED(CONFIG_CPU_LOAD_USE_COUNTER)) {
|
|
idle_us = counter_ticks_to_us(counter, ticks_idle);
|
|
} else {
|
|
idle_us = k_cyc_to_us_floor32(ticks_idle);
|
|
}
|
|
|
|
idle_us = MIN(idle_us, total_us);
|
|
active_us = total_us - idle_us;
|
|
|
|
res = ((1000 * active_us) / total_us);
|
|
|
|
if (reset) {
|
|
cyc_start = k_cycle_get_32();
|
|
ticks_idle = 0;
|
|
}
|
|
|
|
return res;
|
|
}
|