Team Fox
Updated EPS code with flowchart v2.3 (CDMS and HW faults)
Dependencies: FreescaleIAP mbed-rtos mbed
Fork of
QM_BAE_review_1_EPS_faults
by 
Mohamed Azad
TCTM.cpp
- Committer:
- sakthipriya
- Date:
- 2015-12-24
- Revision:
- 0:7b4c00e3912f
- Child:
- 3:07e15677a75c
File content as of revision 0:7b4c00e3912f:
#include "mbed.h"
#include "TCTM.h"
uint8_t telemetry_type2[13];
uint8_t telemetry_type1[130]; //two types of telemetry possible
uint8_t long_memory_block_tm[128],crc_tm[2]; // tmlmb
uint8_t frmseqcnt_fileheadpointer_tm,multi_obsrs_tm_packets[127]; // tm obsrs
uint8_t tc_liservice_type_packet1_tm[9],tc_liservice_type_packet2_tm[9]; // tm tc_liservice_type
uint8_t crc1_tm[2],crc2_tm[2]; // tm flash_crc
uint8_t tmid1_spr_tm=0xA0,tc_exec_tm,tc_service_typeatus_tm,pac_seq_cnt_of_tc_tm[8]; // tm ack_l1
uint8_t tmid2_spr_tm=0xB0,tc_pac_seq_cnt_tm,tm_pac_seq_cnt_tm,ackcode_tm; // tm ack_l234
uint8_t tmid3_spr_tm=0xC0,small_memory_block_tm[7]; // tm smb
uint8_t tmid4_spr_tm=0xD0,func_mngmt_service_tm[8]; // tm func_mngmt_service_tm
uint8_t apid_size,pac_seq_cnt,apid,long_or_short=1,service_type,sub_service_type; //All variable used TC
uint8_t sd_data[512],sd_read_data[512];
int TM_SD_BLOCK_NUMBER = 1;uint8_t rtc_tc_data[8];
void FCTN_TC_DECODE(uint8_t* TC_Packet)
{
// uint8_t long_or_short;
// uint8_t TC_Packet[long_or_short*124+11];
uint8_t service_type,sub_service_type,ackcode_tm,func_mngmt_service_tm[8],crc_tm[2];;
service_type=(TC_Packet[2]&0xF0)>>4;
sub_service_type=(TC_Packet[2]&0x0F);
switch(service_type){
case 6:printf("memory management service\n");
switch(sub_service_type){
case 1:printf("READ FROM MEMORY\n");
if(TC_Packet[3]==2){ //TC_Packet[3] is pid
printf("RD_L_FyoyouyLASH1\n");
//P_BAE_RD_FLASH
uint8_t long_memory_block_tm[128];
uint8_t TM_packet[130];
for(int i=0;i<128;i++){
TM_packet[i]=long_memory_block_tm[i-1];
}
for(int i=128;i<130;i++){
//FCTN_CRC(long_memory_block_tm)
TM_packet[i]=crc_tm[i-128];
}
}
else if ((TC_Packet[3]&0xF0)==0x10){
printf("RD_L_FLASH2\n");
//P_BAE_RD_FLASH
uint8_t long_memory_block_tm[128];
uint8_t TM_packet[130];
for(int i=0;i<128;i++){
TM_packet[i]=long_memory_block_tm[i-1];
}
for(int i=128;i<130;i++){
TM_packet[i]=crc_tm[i-128];
}
}
else if (TC_Packet[3]==0x22){
printf("RD_S_FLASH1\n");
//P_BAE_RD_FLASH
uint8_t tmid_spr_tm=0xC0,tc_psc_tm,tm_psc_tm,small_memory_block_tm[8];
uint8_t TM_packet[13];
TM_packet[0]=tmid_spr_tm;
TM_packet[1]=tc_psc_tm;
TM_packet[2]=tm_psc_tm;
TM_packet[3]=ackcode_tm;
for(int i=3;i<11;i++){
TM_packet[i]=small_memory_block_tm[i-3];
}
for(int i=11;i<13;i++){
TM_packet[i]=crc_tm[i-11];
}
}
else if ((TC_Packet[3]&0xF0)==0x30){
printf("RD_S_FLASH2\n");
//P_BAE_RD_FLASH
uint8_t tmid_spr_tm=0xC0,tc_psc_tm,tm_psc_tm,small_memory_block_tm[8];
uint8_t TM_packet[13];
TM_packet[0]=tmid_spr_tm;
TM_packet[1]=tc_psc_tm;
TM_packet[2]=tm_psc_tm;
TM_packet[3]=ackcode_tm;
for(int i=3;i<11;i++){
TM_packet[i]=small_memory_block_tm[i-3];
}
for(int i=11;i<13;i++){
TM_packet[i]=crc_tm[i-11];
}
}
else if (TC_Packet[3]==0x42){
printf("RD_L_RAM1\n");
//P_BAE_RD_RAM
uint8_t long_memory_block_tm[128];
uint8_t TM_packet[130];
for(int i=0;i<128;i++){
TM_packet[i]=long_memory_block_tm[i-1];
}
for(int i=128;i<130;i++){
TM_packet[i]=crc_tm[i-128];
}
}
else if ((TC_Packet[3]&0xF0)==0x50){
printf("RD_L_RAM2\n");
////P_BAE_RD_RAM
uint8_t long_memory_block_tm[128];
uint8_t TM_packet[130];
for(int i=0;i<128;i++){
TM_packet[i]=long_memory_block_tm[i-1];
}
for(int i=128;i<130;i++){
TM_packet[i]=crc_tm[i-128];
}
}
else if (TC_Packet[3]==0x62){
printf("RD_S_RAM\n");
//P_BAE_RD_RAM
uint8_t tmid_spr_tm=0xC0,tc_psc_tm,tm_psc_tm,small_memory_block_tm[8];
uint8_t TM_packet[13];
TM_packet[0]=tmid_spr_tm;
TM_packet[1]=tc_psc_tm;
TM_packet[2]=tm_psc_tm;
TM_packet[3]=ackcode_tm;
for(int i=3;i<11;i++){
TM_packet[i]=small_memory_block_tm[i-3];
}
for(int i=11;i<13;i++){
TM_packet[i]=crc_tm[i-11];
}
}
else if ((TC_Packet[3]&0xF0)==0x70){
printf("RD_S_RAM2\n");
//P_BAE_RD_RAM
uint8_t tmid_spr_tm=0xC0,tc_psc_tm,tm_psc_tm,small_memory_block_tm[8];
uint8_t TM_packet[13];
TM_packet[0]=tmid_spr_tm;
TM_packet[1]=tc_psc_tm;
TM_packet[2]=tm_psc_tm;
TM_packet[3]=ackcode_tm;
for(int i=3;i<11;i++){
TM_packet[i]=small_memory_block_tm[i-3];
}
for(int i=11;i<13;i++){
TM_packet[i]=crc_tm[i-11];
}
}
else {
printf("INVALID TC");
//Send Invalid TC Telemetry
}
break;
case 5:printf("WRITE ON MEMORY\n");
switch(TC_Packet[3]){
case 0:printf("WR_S_FLASH\n");
//P_BAE_WR_FLASH
telemetry_type2[0]=0XB0;
telemetry_type2[1]=tc_pac_seq_cnt_tm;
telemetry_type2[2]=tm_pac_seq_cnt_tm;
telemetry_type2[3]=ackcode_tm;
for(int i=4;i<11;i++){
telemetry_type2[i]=0X00;
}
break;
case 1:printf("WR_S_RAM\n");
//P_BAE_WR_RAM
telemetry_type2[0]=0XB0;
telemetry_type2[1]=tc_pac_seq_cnt_tm;
telemetry_type2[2]=tm_pac_seq_cnt_tm;
telemetry_type2[3]=ackcode_tm;
for(int i=4;i<11;i++){
telemetry_type2[i]=0X00;
}
break;
case 16:printf("WR_L_FLASH\n");
//P_BAE_WR_FLASH
telemetry_type2[0]=0XB0;
telemetry_type2[1]=tc_pac_seq_cnt_tm;
telemetry_type2[2]=tm_pac_seq_cnt_tm;
telemetry_type2[3]=ackcode_tm;
for(int i=4;i<11;i++){
telemetry_type2[i]=0X00;
}
break;
case 17:printf("WR_L_RAM\n");
//P_BAE_WR_RAM
telemetry_type2[0]=0XB0;
telemetry_type2[1]=tc_pac_seq_cnt_tm;
telemetry_type2[2]=tm_pac_seq_cnt_tm;
telemetry_type2[3]=ackcode_tm;
for(int i=4;i<11;i++){
telemetry_type2[i]=0X00;
}
break;
}
break;
case 6:printf("WRITE FROM ONE MEMORY TO ANOTHER\n");
switch(TC_Packet[3]){
case 0:printf("WR_S_FLASH\n");
//P_BAE_WR_FLASH
telemetry_type2[0]=0XB0;
telemetry_type2[1]=tc_pac_seq_cnt_tm;
telemetry_type2[2]=tm_pac_seq_cnt_tm;
telemetry_type2[3]=ackcode_tm;
for(int i=4;i<11;i++){
telemetry_type2[i]=0X00;
}
break;
case 1:printf("WR_S_RAM\n");
//P_BAE_WR_RAM
telemetry_type2[0]=0XB0;
telemetry_type2[1]=tc_pac_seq_cnt_tm;
telemetry_type2[2]=tm_pac_seq_cnt_tm;
telemetry_type2[3]=ackcode_tm;
for(int i=4;i<11;i++){
telemetry_type2[i]=0X00;
}
break;
case 16:printf("WR_L_FLASH\n");
//P_BAE_WR_FLASH
telemetry_type2[0]=0XB0;
telemetry_type2[1]=tc_pac_seq_cnt_tm;
telemetry_type2[2]=tm_pac_seq_cnt_tm;
telemetry_type2[3]=ackcode_tm;
for(int i=4;i<11;i++){
telemetry_type2[i]=0X00;
}
break;
case 17:printf("WR_L_RAM\n");
//P_BAE_WR_RAM
telemetry_type2[0]=0XB0;
telemetry_type2[1]=tc_pac_seq_cnt_tm;
telemetry_type2[2]=tm_pac_seq_cnt_tm;
telemetry_type2[3]=ackcode_tm;
for(int i=4;i<11;i++){
telemetry_type2[i]=0X00;
}
break;
}
break;
case 9:printf("SEND CRC OF FLASH MEMORY\n");
if(TC_Packet[3]==2){
printf("GET_FLASH_CRC\n");
//P_BAE_GET_FLASH_CRC
uint8_t crc1_tm[2],crc2_tm[2];
uint8_t TM_packet[130];
for(int i=0;i<2;i++){
TM_packet[i]=crc1_tm[i];
}
for(int i=2;i<4;i++){
TM_packet[i]=crc2_tm[i-2];
}
for(int i=128;i<130;i++){
TM_packet[i]=crc_tm[i-128];
}
}
else {
printf("INVALID TC");
//Send Invalid TC Telemetry
}
break;
default:{printf("INVALID TC");
//send invalid TC TM
break;}
}
break;
case 8:printf("FUNCTION MANAGEMENT SERVICE\n");
if(sub_service_type==1){
if((TC_Packet[3]&0xF0)==0x00){
printf("RUN_PRCS\n");
switch(TC_Packet[3]){
case 1:printf("P_EPS_INIT\n");
//FCTN_EPS_INIT
telemetry_type2[0]=0XB0;
telemetry_type2[1]=tc_pac_seq_cnt_tm;
telemetry_type2[2]=tm_pac_seq_cnt_tm;
telemetry_type2[3]=ackcode_tm;
for(int i=4;i<11;i++){
telemetry_type2[i]=0X00;
}
break;
case 2:printf("P_EPS_MAIN\n");
//FCTN_EPS_MAIN
telemetry_type2[0]=0XB0;
telemetry_type2[1]=tc_pac_seq_cnt_tm;
telemetry_type2[2]=tm_pac_seq_cnt_tm;
telemetry_type2[3]=ackcode_tm;
for(int i=4;i<11;i++){
telemetry_type2[i]=0X00;
}
break;
case 3:printf("P_ACS_INIT\n");
//FCTN_ACS_INIT
telemetry_type2[0]=0XB0;
telemetry_type2[1]=tc_pac_seq_cnt_tm;
telemetry_type2[2]=tm_pac_seq_cnt_tm;
telemetry_type2[3]=ackcode_tm;
for(int i=4;i<11;i++){
telemetry_type2[i]=0X00;
}
break;
case 4:printf("P_ACS_ACQ_DATA\n");
//P_ACS_ACQ_DATA
telemetry_type2[0]=0XB0;
telemetry_type2[1]=tc_pac_seq_cnt_tm;
telemetry_type2[2]=tm_pac_seq_cnt_tm;
telemetry_type2[3]=ackcode_tm;
for(int i=4;i<11;i++){
telemetry_type2[i]=0X00;
}
break;
case 5:printf("P_ACS_MAIN\n");
//P_ACS_MAIN
telemetry_type2[0]=0XB0;
telemetry_type2[1]=tc_pac_seq_cnt_tm;
telemetry_type2[2]=tm_pac_seq_cnt_tm;
telemetry_type2[3]=ackcode_tm;
for(int i=4;i<11;i++){
telemetry_type2[i]=0X00;
}
break;
case 6:printf("P_BCN_INIT\n");
//FCTN_BCN_INIT
telemetry_type2[0]=0XB0;
telemetry_type2[1]=tc_pac_seq_cnt_tm;
telemetry_type2[2]=tm_pac_seq_cnt_tm;
telemetry_type2[3]=ackcode_tm;
for(int i=4;i<11;i++){
telemetry_type2[i]=0X00;
}
break;
case 7:printf("P_BCN_MAIN\n");
//FCTN_BCN_MAIN
telemetry_type2[0]=0XB0;
telemetry_type2[1]=tc_pac_seq_cnt_tm;
telemetry_type2[2]=tm_pac_seq_cnt_tm;
telemetry_type2[3]=ackcode_tm;
for(int i=4;i<11;i++){
telemetry_type2[i]=0X00;
}
break;
default:{printf("INVALID TC");
//send invalid TC TM
break;}
}
}
else if((TC_Packet[3]&0xF0)==0x10){
printf("PWR_SWCH\n");
//P_BAE_SWCH_PWR
}
else if((TC_Packet[3]&0xF0)==0x20){
printf("PWR_Rservice_type\n");
//P_BAE_RST_PWR
}
else if((TC_Packet[3]&0xF0)==0xE0){
printf("COMSN_ACS_ALGO\n");
//P_BAE_COMSN_ACS_ALGO
uint8_t tmid_spr_tm=0xD0,tc_psc_tm,tm_psc_tm,ackcode_tm;
uint8_t TM_packet[13];
TM_packet[0]=tmid_spr_tm;
TM_packet[1]=tc_psc_tm;
TM_packet[2]=tm_psc_tm;
TM_packet[3]=ackcode_tm;
for(int i=3;i<11;i++){
TM_packet[i]=func_mngmt_service_tm[i-3];
}
for(int i=11;i<13;i++){
TM_packet[i]=crc_tm[i-11];
}
}
else if((TC_Packet[3]&0xF0)==0xF0){
printf("COMSN_ACS_HW\n");
//P_BAE_COMSN_ACS_HW
uint8_t tmid_spr_tm=0xD0,tc_psc_tm,tm_psc_tm,ackcode_tm;
uint8_t TM_packet[13];
TM_packet[0]=tmid_spr_tm;
TM_packet[1]=tc_psc_tm;
TM_packet[2]=tm_psc_tm;
TM_packet[3]=ackcode_tm;
for(int i=3;i<11;i++){
TM_packet[i]=func_mngmt_service_tm[i-3];
}
for(int i=11;i<13;i++){
TM_packet[i]=crc_tm[i-11];
}
}
else {
printf("INVALID TC");
//Send Invalid TC Telemetry
}
}
else {
printf("INVALID TC");
//Send Invalid TC Telemetry
}
break;
default:{printf("INVALID TC");
//send invalid TC TM
break;}
}
}
/************************************************************************************************************************************/
//FUNCTIONS EXECUTED BY TELECOMMAND
//MEMORY MANAGEMENT SERVICE
//PID 0X02