ra8_power_profile.c

Go to the documentation of this file.

 
#include "ra8_power_profile.h"
 
#include <string.h>
 
#include "ra8_attributes.h"
#include "ra8_check.h"
#include "ra8_err.h"
#include "ra8_log.h"

#define RA8_POWER_PROFILE_TAG "PWRPROF"

static bool s_initialized = false;

static ra8_power_profile_config_t s_cfg = {};

static ra8_power_profile_stats_t s_stats = {};

RA8_INTERNAL static ra8_err_t internal_validate_region(ra8_power_profile_region_id_t region_id)
{
  if ((uint8_t)region_id >= (uint8_t)k_ra8_power_profile_max_regions) {
    ra8_log_error(RA8_POWER_PROFILE_TAG, "region id out of range");
    return k_ra8_err_range_check_failed;
  }
  return k_ra8_ok;
}

RA8_INTERNAL static uint64_t internal_now_us(void)
{
  if (s_cfg.now_us == nullptr) {
    return 0U;
  }
  return s_cfg.now_us(s_cfg.user_ctx_time);
}

RA8_INTERNAL static void internal_fire_pulse(ra8_power_profile_region_id_t region_id, bool entering)
{
  if (s_cfg.pulse == nullptr) {
    return;
  }
  s_cfg.pulse(s_cfg.user_ctx_gpio, region_id, entering);
}
 
ra8_err_t ra8_power_profile_init(const ra8_power_profile_config_t* cfg)
{
  RA8_CHECK_NULL_PTR(cfg, RA8_POWER_PROFILE_TAG, "cfg must not be nullptr");
 
  s_cfg         = *cfg;
  s_stats       = (ra8_power_profile_stats_t){};
  s_initialized = true;
  return k_ra8_ok;
}
 
ra8_err_t ra8_power_profile_mark_enter(ra8_power_profile_region_id_t region_id)
{
  RA8_VALIDATE_INIT(s_initialized, RA8_POWER_PROFILE_TAG, "init not called");
 
  const ra8_err_t range_err = internal_validate_region(region_id);
  if (range_err != k_ra8_ok) {
    return range_err;
  }
 
  ra8_power_profile_region_stats_t* slot = &s_stats.regions[(uint8_t)region_id];
  slot->entries += 1U;
  slot->last_enter_us = internal_now_us();
  slot->is_open       = true;
 
  internal_fire_pulse(region_id, true);
  return k_ra8_ok;
}
 
ra8_err_t ra8_power_profile_mark_exit(ra8_power_profile_region_id_t region_id)
{
  RA8_VALIDATE_INIT(s_initialized, RA8_POWER_PROFILE_TAG, "init not called");
 
  const ra8_err_t range_err = internal_validate_region(region_id);
  if (range_err != k_ra8_ok) {
    return range_err;
  }
 
  ra8_power_profile_region_stats_t* slot = &s_stats.regions[(uint8_t)region_id];
  slot->exits += 1U;
 
  ra8_err_t ret = k_ra8_ok;
  if (slot->is_open) {
    const uint64_t now = internal_now_us();
    if (now >= slot->last_enter_us) {
      slot->total_time_us += (now - slot->last_enter_us);
    }
    slot->is_open = false;
  } else {
    ra8_log_error(RA8_POWER_PROFILE_TAG, "exit without matching enter");
    ret = k_ra8_err_invalid_state;
  }
 
  internal_fire_pulse(region_id, false);
  return ret;
}
 
ra8_err_t ra8_power_profile_get_stats(ra8_power_profile_stats_t* out_stats)
{
  RA8_VALIDATE_INIT(s_initialized, RA8_POWER_PROFILE_TAG, "init not called");
  RA8_CHECK_NULL_PTR(out_stats, RA8_POWER_PROFILE_TAG, "out_stats must not be nullptr");
 
  (void)memcpy(out_stats, &s_stats, sizeof(*out_stats));
  return k_ra8_ok;
}
 
ra8_err_t ra8_power_profile_reset_stats(void)
{
  RA8_VALIDATE_INIT(s_initialized, RA8_POWER_PROFILE_TAG, "init not called");
 
  s_stats = (ra8_power_profile_stats_t){};
  return k_ra8_ok;
}