To be debugged
Dependencies: FreescaleIAP mbed-rtos mbed
Fork of TFR_BAE_vr1_1_Debug153 by
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