#pragma section REPRO
/**
 * @file
 * @brief コンポ間通信などで標準的に使う ネットワーク層 の Common Tlm Cmd Packet (概ね Space Packet)
 * @note  ここでは，データリンク層は CCSDS ではなく EB90 Frame を使うことを想定 (TODO: 今後拡張予定)
 * @note  データリンク層は CDS_StreamConfig.data_link_layer_ で規定する
 * @note  packet 構造 などは tlm_cmd/common_packet/common_tlm_cmd_packet.h を参照のこと
 */
#include "cdrv_common_tlm_cmd_packet.h"
#include "cdrv_eb90_frame.h"
#include <string.h>

// FIXME: CDS_StreamConfig.data_link_layer_ をちゃんと見る！

CDS_ERR_CODE CDRV_CTCP_get_ctcp(const CDS_StreamConfig* p_stream_config, CommonTlmCmdPacket* received_packet)
{
  const uint16_t packet_len = CDRV_EB90_FRAME_get_packet_length(p_stream_config);

  if (packet_len > CTCP_MAX_LEN) return CDS_ERR_CODE_ERR;

  // まず， 受信データ長だけコピーしてしまってから，アサーションする（効率のため）
  memcpy(&received_packet->packet, CDRV_EB90_FRAME_get_packet_head(p_stream_config), (size_t)packet_len);
  if (CTCP_get_packet_len(received_packet) != packet_len) return CDS_ERR_CODE_ERR;
  if (!CTCP_is_valid_packet(received_packet)) return CDS_ERR_CODE_ERR;
  return CDS_ERR_CODE_OK;
}


CDS_ERR_CODE CDRV_CTP_get_ctp(const CDS_StreamConfig* p_stream_config, CommonTlmPacket* received_packet)
{
  const uint16_t packet_len = CDRV_EB90_FRAME_get_packet_length(p_stream_config);

  if (packet_len > CTP_MAX_LEN) return CDS_ERR_CODE_ERR;

  // まず， 受信データ長だけコピーしてしまってから，アサーションする（効率のため）
  memcpy(&received_packet->packet, CDRV_EB90_FRAME_get_packet_head(p_stream_config), (size_t)packet_len);
  if (CTP_get_packet_len(received_packet) != packet_len) return CDS_ERR_CODE_ERR;
  if (!CTP_is_valid_packet(received_packet)) return CDS_ERR_CODE_ERR;

  // On-Board Subnetwork Time を設定
  if (CTP_get_on_board_subnet_time(received_packet) == 0xffffffff)
  {
    // FIXME: TG_forward_tlm_ ではなくてここでいいか検討
    // 可能な限り正確な時間をいれるには，受信直後のここでいれるべき（←→網羅性）
    // MOBC - sub OBC (2nd OBC) - 3rd OBC というとき， 2nd OBC でも 0xffffffff ができるようにしている
    CTP_set_on_board_subnet_time(received_packet);
  }
  return CDS_ERR_CODE_OK;
}


CDS_ERR_CODE CDRV_CCP_get_ccp(const CDS_StreamConfig* p_stream_config, CommonCmdPacket* received_packet)
{
  const uint16_t packet_len = CDRV_EB90_FRAME_get_packet_length(p_stream_config);

  if (packet_len > CCP_MAX_LEN) return CDS_ERR_CODE_ERR;

  // まず， 受信データ長だけコピーしてしまってから，アサーションする（効率のため）
  memcpy(&received_packet->packet, CDRV_EB90_FRAME_get_packet_head(p_stream_config), (size_t)packet_len);
  if (CCP_get_packet_len(received_packet) != packet_len) return CDS_ERR_CODE_ERR;
  if (!CCP_is_valid_packet(received_packet)) return CDS_ERR_CODE_ERR;
  return CDS_ERR_CODE_OK;
}


CDS_ERR_CODE CDRV_CTCP_init_stream_config(CDS_StreamConfig* p_stream_config,
                                          uint8_t* tx_frame_buffer,
                                          int16_t tx_frame_buffer_size,
                                          CDS_ERR_CODE (*data_analyzer)(CDS_StreamConfig* p_stream_config, void* p_driver))
{
  // MOBC か sub OBC かによって，送信側 (tx 側) が CTP になるか CCP になるかは不明なため，ひとまず CTCP に
  // メモリが苦しい OBC もあるので，考えてもいいかも
  const uint16_t max_frame_size = CDRV_EB90_FRAME_HEADER_SIZE + CTCP_MAX_LEN + CDRV_EB90_FRAME_FOOTER_SIZE;
  if (tx_frame_buffer_size < max_frame_size)
  {
    return CDS_ERR_CODE_ERR;
  }

  // 送信はする
  CDSSC_set_tx_frame(p_stream_config, tx_frame_buffer);  // 送る直前に中身を memcpy する
  CDSSC_set_tx_frame_buffer_size(p_stream_config, tx_frame_buffer_size);
  CDSSC_set_tx_frame_size(p_stream_config, 0);           // 送る直前に値をセットする

  // 定期的な受信はする
  CDSSC_set_rx_header(p_stream_config, CDRV_EB90_FRAME_kStx, CDRV_EB90_FRAME_STX_SIZE);
  CDSSC_set_rx_footer(p_stream_config, CDRV_EB90_FRAME_kEtx, CDRV_EB90_FRAME_ETX_SIZE);
  CDSSC_set_rx_frame_size(p_stream_config, -1);          // 可変
  CDSSC_set_max_rx_frame_size(p_stream_config, max_frame_size);
  CDSSC_set_rx_framelength_pos(p_stream_config, CDRV_EB90_FRAME_STX_SIZE);
  CDSSC_set_rx_framelength_type_size(p_stream_config, 2);
  CDSSC_set_rx_framelength_offset(p_stream_config,
                                 CDRV_EB90_FRAME_HEADER_SIZE + CDRV_EB90_FRAME_FOOTER_SIZE);
  CDSSC_set_data_analyzer(p_stream_config, data_analyzer);

  // 定期 TLM の監視機能の有効化はここではしないので， ComponentDriver 側でやる
  // enable もここではしない

  return CDS_ERR_CODE_OK;
}


CDS_ERR_CODE CDRV_CTCP_set_tx_frame(CDS_StreamConfig* p_stream_config,
                                    const CommonTlmCmdPacket* send_packet)
{
  size_t pos;
  size_t size;
  uint16_t crc;
  uint16_t packet_len = CTCP_get_packet_len(send_packet);
  uint16_t frame_len = (uint16_t)(packet_len + CDRV_EB90_FRAME_HEADER_SIZE + CDRV_EB90_FRAME_FOOTER_SIZE);
  uint8_t* tx_frame = CDSSC_get_tx_frame_as_non_const_pointer(p_stream_config);

  if (frame_len > CDSSC_get_tx_frame_buffer_size(p_stream_config)) return CDS_ERR_CODE_ERR;

  CDSSC_set_tx_frame_size(p_stream_config, frame_len);

  pos  = 0;
  size = CDRV_EB90_FRAME_STX_SIZE;
  memcpy(&(tx_frame[pos]), CDRV_EB90_FRAME_kStx, size);
  pos += size;
  size = CDRV_EB90_FRAME_LEN_SIZE;
  ENDIAN_memcpy(&(tx_frame[pos]), &packet_len, size);       // ここはエンディアンを気にする！
  pos += size;

  size = (size_t)packet_len;
  memcpy(&(tx_frame[pos]), send_packet->packet, size);
  pos += size;

  crc = EB90_FRAME_calc_crc(tx_frame + CDRV_EB90_FRAME_HEADER_SIZE, pos - CDRV_EB90_FRAME_HEADER_SIZE);
  size = CDRV_EB90_FRAME_CRC_SIZE;
  ENDIAN_memcpy(&(tx_frame[pos]), &crc, size);       // ここはエンディアンを気にする！
  pos += size;
  size = CDRV_EB90_FRAME_ETX_SIZE;
  memcpy(&(tx_frame[pos]), CDRV_EB90_FRAME_kEtx, size);

  return CDS_ERR_CODE_OK;
}


CDS_ERR_CODE CDRV_CTP_set_tx_frame(CDS_StreamConfig* p_stream_config,
                                   const CommonTlmPacket* send_packet)
{
  const CommonTlmCmdPacket* ctcp = CTCP_convert_from_ctp(send_packet);
  if (ctcp == NULL) return CDS_ERR_CODE_ERR;
  return CDRV_CTCP_set_tx_frame(p_stream_config, ctcp);
}


CDS_ERR_CODE CDRV_CCP_set_tx_frame(CDS_StreamConfig* p_stream_config,
                                   const CommonCmdPacket* send_packet)
{
  const CommonTlmCmdPacket* ctcp = CTCP_convert_from_ccp(send_packet);
  if (ctcp == NULL) return CDS_ERR_CODE_ERR;
  return CDRV_CTCP_set_tx_frame(p_stream_config, ctcp);
}

#pragma section