#pragma section REPRO
/**
 * @file
 * @brief Command Dispatcher Manager
 * @note  様々な CDIS を一括管理する
 * @note  例えば，様々な CDIS のテレメトリをいちいち作るのはめんどくさい（とくに MOBC にある sub OBC 用の CDIS）ため，それを一括で提供する
 */
#include "command_dispatcher_manager.h"
#include <stddef.h>
#include <string.h>
#include "./common_packet/common_cmd_packet_util.h"

/**
 * @brief  cdis を cdis mgr に登録されているか探し，見つかった場合は idx を返す
 * @note   CDIS_init から呼ばれることを想定
 * @param[in]  cdis: 探す cdis のポインタ
 * @param[out] cdis: 見つかった idx
 * @retval RESULT_OK:  見つかった（登録されている）
 * @retval RESULT_ERR: 見つからず（登録されていない）
 */
static RESULT CDIS_MGR_find_cdis_(const CommandDispatcher* cdis, uint8_t* idx);

static CommandDispatcherManager command_dispatcher_manager_;
const CommandDispatcherManager* const command_dispatcher_manager = &command_dispatcher_manager_;


void CDIS_MGR_initialize(void)
{
  uint8_t idx;
  memset(&command_dispatcher_manager_, 0x00, sizeof(command_dispatcher_manager_));
  for (idx = 0; idx < CDIS_MGR_MAX_NUM_OF_CDIS; ++idx)
  {
    command_dispatcher_manager_.cdises[idx] = NULL;
  }
}


RESULT CDIS_MGR_register_cdis(const CommandDispatcher* cdis, uint8_t* idx)
{
  if (CDIS_MGR_find_cdis_(cdis, idx) == RESULT_OK)
  {
    return RESULT_OK;
  }

  if (command_dispatcher_manager_.num_of_cdis >= CDIS_MGR_MAX_NUM_OF_CDIS)
  {
    return RESULT_ERR;
  }

  *idx = command_dispatcher_manager_.num_of_cdis;
  command_dispatcher_manager_.cdises[command_dispatcher_manager_.num_of_cdis] = cdis;
  command_dispatcher_manager_.num_of_cdis++;

  return RESULT_OK;
}


static RESULT CDIS_MGR_find_cdis_(const CommandDispatcher* cdis, uint8_t* idx)
{
  uint8_t i;
  for (i = 0; i < command_dispatcher_manager_.num_of_cdis; ++i)
  {
    if (command_dispatcher_manager_.cdises[i] == cdis)
    {
      *idx = i;
      return RESULT_OK;
    }
  }
  return RESULT_ERR;
}


const CommandDispatcher* CDIS_MGR_get_cdis(uint8_t idx)
{
  if (idx >= command_dispatcher_manager_.num_of_cdis)
  {
    return NULL;
  }
  return command_dispatcher_manager_.cdises[idx];
}


CCP_CmdRet Cmd_CDIS_MGR_SET_IDX_FOR_TLM(const CommonCmdPacket* packet)
{
  uint8_t idx_for_tlm = CCP_get_param_from_packet(packet, 0, uint8_t);
  if (idx_for_tlm >= command_dispatcher_manager_.num_of_cdis)
  {
    return CCP_make_cmd_ret(CCP_EXEC_ILLEGAL_PARAMETER, idx_for_tlm);
  }

  command_dispatcher_manager_.idx_for_tlm = idx_for_tlm;
  return CCP_make_cmd_ret_without_err_code(CCP_EXEC_SUCCESS);
}

#pragma section