Skip to content

Commit

Permalink
add SpacePacket
Browse files Browse the repository at this point in the history
  • Loading branch information
@meltingrabbit
meltingrabbit committed Jan 27, 2022
1 parent b37622a commit 484ce5f
Show file tree
Hide file tree
Showing 6 changed files with 538 additions and 29 deletions.
15 changes: 4 additions & 11 deletions Examples/minimum_user_for_s2e/src/src_user/Settings/TlmCmd/common_tlm_cmd_packet_define.h
View file
Original file line number Diff line number Diff line change
Expand Up @@ -5,18 +5,11 @@
#ifndef COMMON_TLM_CMD_PACKET_DEFINE_H_
#define COMMON_TLM_CMD_PACKET_DEFINE_H_

#include <src_core/TlmCmd/Ccsds/TCPacket.h>
#include "./Ccsds/apid_define.h"
#include <src_core/TlmCmd/Ccsds/space_packet.h>

// CommonTlmCmdPacket として TCP をつかう
// FIXME: SpacePacket に差し替える
typedef TCP CommonTlmCmdPacket;
// CommonTlmCmdPacket として SpacePacket をつかう
typedef SpacePacket CommonTlmCmdPacket;

// テレコマパケットの最大長を定義
#define CTCP_MAX_LEN (TCP_MAX_LEN)

// 自分宛てCMDを示すDestination IDを定義
// FIXME: Space Packet が整備されたら直す
#define CTCP_MY_DST_ID (APID_MOBC_CMD)
#define CTCP_MAX_LEN (SP_MAX_LEN)

#endif
3 changes: 0 additions & 3 deletions Examples/minimum_user_for_s2e/src/src_user/Settings/TlmCmd/common_tlm_cmd_packet_params.h
View file
Original file line number Diff line number Diff line change
Expand Up @@ -5,7 +5,4 @@
#ifndef COMMON_TLM_CMD_PACKET_PARAMS_H_
#define COMMON_TLM_CMD_PACKET_PARAMS_H_

#include <src_core/TlmCmd/Ccsds/TCPacket.h>


#endif
31 changes: 16 additions & 15 deletions Examples/minimum_user_for_s2e/src/src_user/TlmCmd/common_tlm_cmd_packet.c
View file
Original file line number Diff line number Diff line change
Expand Up @@ -12,43 +12,44 @@
int CTCP_is_valid_packet(const CommonTlmCmdPacket* packet)
{
if (packet == NULL) return 0;
if ( CTCP_get_packet_len(packet) > (uint16_t)sizeof(CommonTlmCmdPacket) ) return 0;
if ( CTCP_get_packet_len(packet) > CTCP_MAX_LEN ) return 0;

return 1;
}

CTCP_PACKET_TYPE CTCP_get_packet_type(const CommonTlmCmdPacket* packet)
{
switch (TCP_get_type(packet))
switch (SP_get_type(packet))
{
case TCP_TYPE_TLM:
case SP_TYPE_TLM:
return CTCP_PACKET_TYPE_TLM;

case TCP_TYPE_CMD:
case SP_TYPE_CMD:
return CTCP_PACKET_TYPE_CMD;

default:
return CTCP_PACKET_TYPE_UNKNOWN;
}
}

void CTCP_copy_packet(CommonTlmCmdPacket* dest, const CommonTlmCmdPacket* src)
uint16_t CTCP_get_packet_len(const CommonTlmCmdPacket* packet)
{
TCP_copy_packet(dest, src);
return SP_get_packet_len(packet);
}

// FIXME: Space Packet が整備されたら実装する
// APID CTCP_get_apid(const CommonTlmCmdPacket* packet)
// {
// }
APID CTCP_get_apid(const CommonTlmCmdPacket* packet)
{
return SP_get_apid(packet);
}

// void CTCP_set_apid(CommonTlmCmdPacket* packet, APID apid)
// {
// }
void CTCP_set_apid(CommonTlmCmdPacket* packet, APID apid)
{
SP_set_apid(packet, apid);
}

uint16_t CTCP_get_packet_len(const CommonTlmCmdPacket* packet)
void CTCP_copy_packet(CommonTlmCmdPacket* dest, const CommonTlmCmdPacket* src)
{
return (uint16_t)(TCP_get_packet_len(packet) + TCP_PRM_HDR_LEN);
SP_copy_packet(dest, src);
}

// FIXME: 以下4関数について， Space Packet が整備されたら， `if len(ctcp) > CCP_MAX_LEN return NULL;` のようなアサーションをいれる！
Expand Down
250 changes: 250 additions & 0 deletions TlmCmd/Ccsds/space_packet.c
View file
Original file line number Diff line number Diff line change
Expand Up @@ -6,6 +6,256 @@
*/

#include "space_packet.h"
#include <src_core/Library/endian_memcpy.h>


static const SP_ParamExtractionInfo SP_pei_ver_ = { 0, 0xe0, 5, 1}; // 11100000b
static const SP_ParamExtractionInfo SP_pei_type_ = { 0, 0x10, 4, 1}; // 00010000b
static const SP_ParamExtractionInfo SP_pei_2nd_hdr_flag_ = { 0, 0x08, 3, 1}; // 00001000b
static const SP_ParamExtractionInfo SP_pei_apid_ = { 0, 0x07, 0, 2}; // 00000111b
static const SP_ParamExtractionInfo SP_pei_seq_flag_ = { 2, 0xc0, 6, 1}; // 11000000b
static const SP_ParamExtractionInfo SP_pei_seq_count_ = { 2, 0x3f, 0, 2}; // 00111111b
static const SP_ParamExtractionInfo SP_pei_pckt_data_len_ = { 4, 0xff, 0, 2}; // 11111111b


// ******************************
// Primary Header getter/setter
// ******************************

SP_VER SP_get_ver(const SpacePacket* sp)
{
uint8_t tmp;
SP_VER ver;

SP_extract_param_from_packet(sp, &SP_pei_ver_, &tmp);
ver = (SP_VER)tmp;

switch (ver)
{
case SP_VER_1:
return ver;
default:
return SP_VER_UNKNOWN;
}
}


void SP_set_ver(SpacePacket* sp, SP_VER ver)
{
uint8_t tmp = (uint8_t)ver;
SP_insert_param_from_packet(sp, &SP_pei_ver_, &tmp);
}


SP_TYPE TCP_get_type(const SpacePacket* sp)
{
uint8_t type;

SP_extract_param_from_packet(sp, &SP_pei_type_, &type);
return (SP_TYPE)type;
}


void TCP_set_type(SpacePacket* sp, SP_TYPE type)
{
uint8_t tmp = (uint8_t)type;
SP_insert_param_from_packet(sp, &SP_pei_type_, &tmp);
}


SP_2ND_HDR_FLAG SP_get_2nd_hdr_flag(const SpacePacket* sp)
{
uint8_t flag;

SP_extract_param_from_packet(sp, &SP_pei_2nd_hdr_flag_, &flag);
return (SP_2ND_HDR_FLAG)flag;
}


void SP_set_2nd_hdr_flag(SpacePacket* sp, SP_2ND_HDR_FLAG flag)
{
uint8_t tmp = (uint8_t)flag;
SP_insert_param_from_packet(sp, &SP_pei_2nd_hdr_flag_, &tmp);
}


APID SP_get_apid(const SpacePacket* sp)
{
uint16_t tmp;
SP_VER apid;

SP_extract_param_from_packet(sp, &SP_pei_apid_, &tmp);
apid = (APID)tmp;

switch (apid)
{
case APID_MOBC_CMD: // FALLTHROUGH
case APID_AOBC_CMD: // FALLTHROUGH
case APID_TOBC_CMD: // FALLTHROUGH
case APID_MIS_TLM: // FALLTHROUGH
case APID_DUMP_TLM:
return apid;

default:
return APID_UNKNOWN;
}
}


void SP_set_apid(SpacePacket* sp, APID apid)
{
uint16_t tmp = (uint16_t)apid;
SP_insert_param_from_packet(sp, &SP_pei_apid_, &tmp);
}


SP_SEQ_FLAG SP_get_seq_flag(const SpacePacket* sp)
{
uint8_t flag;

SP_extract_param_from_packet(sp, &SP_pei_seq_flag_, &flag);
return (SP_SEQ_FLAG)flag;
}


void SP_set_seq_flag(SpacePacket* sp, SP_SEQ_FLAG flag)
{
uint8_t tmp = (uint8_t)flag;
SP_insert_param_from_packet(sp, &SP_pei_seq_flag_, &tmp);
}


uint16_t SP_get_seq_count(const SpacePacket* sp)
{
uint16_t count;

SP_extract_param_from_packet(sp, &SP_pei_seq_count_, &count);
return count;
}


void SP_set_seq_count(SpacePacket* sp, uint16_t count)
{
SP_insert_param_from_packet(sp, &SP_pei_seq_count_, &count);
}


uint16_t SP_get_packet_data_len(const SpacePacket* sp)
{
uint16_t len;

SP_extract_param_from_packet(sp, &SP_pei_pckt_data_len_, &len);
// Data Length は 0 起算表記なので 1 起算に変換して返す
return (uint16_t)(len + 1);
}


void SP_set_packet_data_len(SpacePacket* sp, uint16_t len)
{
if (len == 0) return;

// Data Length は 0 起算表記なので 1 起算を変換
len--;
SP_insert_param_from_packet(sp, &SP_pei_seq_count_, &len);
}


// ******************
// Utility Function
// ******************

uint16_t SP_get_packet_len(const SpacePacket* sp)
{
return (uint16_t)(SP_get_packet_data_len(sp) + SP_PRM_HDR_LEN);
}


void SP_set_packet_len(SpacePacket* sp, uint16_t len)
{
if (len <= SP_PRM_HDR_LEN) return;
SP_set_packet_data_len(sp, (uint16_t)(len - SP_PRM_HDR_LEN))
}


void SP_copy_packet(SpacePacket* dest, const SpacePacket* src)
{
memcpy(dest->packet, src->packet, (size_t)SP_get_packet_len(src));
}


void SP_extract_param_from_packet(const SpacePacket* sp,
const SP_ParamExtractionInfo* pei,
void* dst)
{
uint8_t buffer[8];
uint8_t i;

if (pei->byte_len == 0) return;
if (pei->byte_len > 8) return;
if (pei->offset > 7) return;

// offset あり
if (pei->offset)
{
// offset されるのは， 1byte の中で格納される時
if (pei->byte_len != 1) return;

buffer[0] = (sp->packet[pei->pos] & pei->mask) >> pei->offset;
}
else
{
// offset なし
// 最初の 1byte
buffer[0] = sp->packet[pei->pos] & pei->mask;

// 2byte 目以降
for (i = 1; i < pei->byte_len; ++i)
{
buffer[i] = sp->packet[pei->pos + i];
}
}

endian_memcpy(dst, buffer, pei->byte_len);
}


void SP_insert_param_from_packet(SpacePacket* sp,
const SP_ParamExtractionInfo* pei,
const void* src)
{
uint8_t buffer[8];
uint8_t i;

if (pei->byte_len == 0) return;
if (pei->byte_len > 8) return;
if (pei->offset > 7) return;

endian_memcpy(buffer, src, pei->byte_len);

// offset あり
if (pei->offset)
{
// offset されるのは， 1byte の中で格納される時
if (pei->byte_len != 1) return;

buffer[0] <<= pei->offset;

sp->packet[pei->pos] &= (uint8_t)(~pei->mask);
sp->packet[pei->pos] |= (uint8_t)(buffer[0] & pei->mask);
}
else
{
// offset なし
// 最初の 1byte
sp->packet[pei->pos] &= (uint8_t)(~pei->mask);
sp->packet[pei->pos] |= (uint8_t)(buffer[0] & pei->mask);

// 2byte 目以降
for (i = 1; i < pei->byte_len; ++i)
{
sp->packet[pei->pos + i] = buffer[i];
}
}
}

#pragma section
Loading

0 comments on commit 484ce5f

Please sign in to comment.