utility_counter.c

[詳解]

#pragma section REPRO
#include "utility_counter.h"
 
// FIXME
// error: ISO C requires a translation unit to contain at least one declaration [-Werror,-Wempty-translation-unit]
// 対策のために，適当に宣言しておく
int UTIL_COUNTER_dummy(void)
{
  return 0;
}
#if 0
 
#include "../TlmCmd/packet_handler.h"
#include "../System/AnomalyLogger/anomaly_logger.h"
#include <string.h>   // for memcpy
#include "../TlmCmd/common_cmd_packet_util.h"
 
static UtilityCounter utility_counter_;
const UtilityCounter* const utility_counter = &utility_counter_;
 
static void UTIL_COUNTER_all_init_(void);
static void UTIL_COUNTER_clear_(UTIL_COUNTER_NAME num);
static void UTIL_COUNTER_incl_(UTIL_COUNTER_NAME num);
 
// 汎用カウンタ関連ここから
AppInfo UTIL_COUNTER_create_app(void)
{
  return AI_create_app_info("utility_counter", UTIL_COUNTER_all_init_, NULL);
}
 
static void UTIL_COUNTER_all_init_(void)
{
  int i;
  for (i = 0; i < UTIL_COUNTER_MAX; i++)
  {
    utility_counter_.cnt[i].counter = 0;
    utility_counter_.cnt[i].threshold = 0;
    utility_counter_.cnt[i].anomaly_active = 0;
  }
}
 
static void UTIL_COUNTER_clear_(UTIL_COUNTER_NAME num)
{
  utility_counter_.cnt[num].counter = 0;
}
 
static void UTIL_COUNTER_incl_(UTIL_COUNTER_NAME num)
{
  if (utility_counter_.cnt[num].counter == 0xffffffff)
  {
    utility_counter_.cnt[num].counter = 0;
  }
  else
  {
    utility_counter_.cnt[num].counter += 1;
  }
  if (utility_counter_.cnt[num].counter >= utility_counter_.cnt[num].threshold)
  {
    if (utility_counter_.cnt[num].anomaly_active)
    {
      // FIXME: utility counter のりファクタ時に直す
// #ifndef AL_DISALBE_AT_C2A_CORE
      AL_add_anomaly(AL_GROUP_UTIL_CNT, (uint32_t)num);  // カウンタが閾値超えたことを示してアノマリを発生させる
// #endif
      utility_counter_.cnt[num].anomaly_active = 0;  // アノマリを発生させたら無効化する
    }
  }
 
}
 
CCP_CmdRet Cmd_UTIL_COUNTER_INCREMENT(const CommonCmdPacket* packet)
{
  UTIL_COUNTER_NAME index;
 
  // この代入方法は安全??
  // index = (int32_t)(CCP_get_param_head(packet)[0] << 24 | CCP_get_param_head(packet)[1] << 16 | CCP_get_param_head(packet)[2] << 8 | CCP_get_param_head(packet)[3]);
  memcpy(&index, &CCP_get_param_head(packet)[0], 4);
 
  if (index < UTIL_COUNTER_MAX)
  {
    // 範囲内ならインクリメント
    UTIL_COUNTER_incl_(index);
  }
  else
  {
    return CCP_make_cmd_ret_without_err_code(CCP_EXEC_ILLEGAL_PARAMETER);
  }
  return CCP_make_cmd_ret_without_err_code(CCP_EXEC_SUCCESS);
 
}
 
CCP_CmdRet Cmd_UTIL_COUNTER_RESET(const CommonCmdPacket* packet)
{
  UTIL_COUNTER_NAME index;
 
  // この代入方法は安全??
  // index = (int32_t)(CCP_get_param_head(packet)[0] << 24 | CCP_get_param_head(packet)[1] << 16 | CCP_get_param_head(packet)[2] << 8 | CCP_get_param_head(packet)[3]);
  memcpy(&index, &CCP_get_param_head(packet)[0], 4);
 
  if (index < UTIL_COUNTER_MAX)
  {
    // 範囲内なら該当のものをクリア
    UTIL_COUNTER_clear_(index);
  }
  else if (index == 0xff)
  {
    // 0xff指定なら全クリア
    UTIL_COUNTER_all_init_();
  }
  else
  {
    return CCP_make_cmd_ret_without_err_code(CCP_EXEC_ILLEGAL_PARAMETER);
  }
  return CCP_make_cmd_ret_without_err_code(CCP_EXEC_SUCCESS);
}
 
CCP_CmdRet Cmd_UTIL_COUNTER_SET_PARAM(const CommonCmdPacket* packet)
{
  UTIL_COUNTER_NAME index;
 
  // この代入方法は安全??
  // index = (int32_t)(CCP_get_param_head(packet)[0] << 24 | CCP_get_param_head(packet)[1] << 16 | CCP_get_param_head(packet)[2] << 8 | CCP_get_param_head(packet)[3]);
  memcpy(&index, &CCP_get_param_head(packet)[0], 4);
 
  if (index < UTIL_COUNTER_MAX)
  {
    memcpy(&utility_counter_.cnt[index].threshold, &CCP_get_param_head(packet)[4], 4);
    memcpy(&utility_counter_.cnt[index].anomaly_active, &CCP_get_param_head(packet)[8], 1);
    if (utility_counter_.cnt[index].anomaly_active > 1)
    {
      utility_counter_.cnt[index].anomaly_active = 0;
      return CCP_make_cmd_ret_without_err_code(CCP_EXEC_ILLEGAL_PARAMETER);
    }
  }
  else
  {
    return CCP_make_cmd_ret_without_err_code(CCP_EXEC_ILLEGAL_PARAMETER);
  }
  return CCP_make_cmd_ret_without_err_code(CCP_EXEC_SUCCESS);
}
 
#endif
 
#pragma section