vr1.1
Dependencies: FreescaleIAP mbed-rtos mbed
Fork of CDMS_RTOS_v1_1 by
TC.cpp
- Committer:
- cholletisaik777
- Date:
- 2015-06-16
- Revision:
- 5:c77b49508927
- Parent:
- 4:cc85cfaa2086
- Child:
- 7:c270a9e37290
File content as of revision 5:c77b49508927:
#include "mbed.h" #include "TC.h" #include "SDCard.h" #include "func_head.h" #include "i2c.h" Serial sc(USBTX,USBRX); void FUNC_CDMS_RLY_TC() { sc.printf("in FUNC_CDMS_RLY_TC\r\n"); uint8_t read; sc.scanf("%d",&read); //Packet sequence count pac_seq_cnt = read; sc.scanf("%d",&read); //Data[0] contains APID,LFB,long_or_short,AoN,Spr and Ack apid_size = read; apid=(apid_size&0xC0)>>6; //apid is decoded long_or_short=(apid_size&0x10)>>4; //size of tc is known switch(apid) { case 1: //apid=01 implies it corresponds to bae { sc.printf("BAE\r\r\r\n"); uint8_t p_i2c_bae[long_or_short*124+11]; p_i2c_bae[0]=pac_seq_cnt; p_i2c_bae[1]=apid_size; sc.scanf("%d",&read); //services contains service_type and sub_service_type p_i2c_bae[2] = read; for(int i=3;i<(long_or_short*124+11);i++){ sc.scanf("%d",&read); p_i2c_bae[i] = read; } sc.printf("informing BAE about TC using I2C\r\r\n"); //interrupt to be sent to the bae if(long_or_short==0) FCTN_MASTER_I2C('s', (char *)p_i2c_bae); else if(long_or_short==1) FCTN_MASTER_I2C('l', (char *)p_i2c_bae); else sc.printf("long_or_short invalid\r\r\n"); sc.printf("send the packet + CRC to the BAE after receving i2c signal from BAE\r\r\n"); //packet along with crc will be sent when bae is ready break; } case 3: { sc.printf("SPEED\r\r\n"); //speed corresponds to apid = 11 uint8_t p_i2c_speed[long_or_short*124+11]; p_i2c_speed[0]=pac_seq_cnt; p_i2c_speed[1]=apid_size; sc.scanf("%d",&read); p_i2c_speed[2] = read; //services contains service_type and sub_service_type for(int i=3;i<(long_or_short*124+11);i++){ sc.scanf("%d",&read); p_i2c_speed[i] = read; } sc.printf("inform PL about TC using I2C\r\r\n"); sc.printf("send the packet + CRC to the PL after receving i2c signal from PL\r\r\n"); break; } case 2: { sc.printf("CDMS\r\r\n"); //apid = 10 corresponds to cdms uint8_t services,appdata[long_or_short*124+6],crc[2]; sc.scanf("%d",&read); services = read; //services contains service_type and sub_service_type for(int i=3;i<(long_or_short*124+6);i++){ sc.scanf("%d",&read); appdata[i-3] = read; } sc.scanf("%d",&read); crc[0] = read; sc.scanf("%d",&read); crc[1] = read; service_type=(services&0xF0)>>4; sub_service_type=(services&0x0F); switch(service_type){ case 6: { sc.printf("memory management syservice_typeem\r\r\n"); switch(sub_service_type){ case 1: { sc.printf("READ FROM MEMORY\r\r\n"); if(appdata[0]==2){ //appdata[0] is pid sc.printf("RD_L_FLASH1\r\r\n"); //tm is lmb //P_CDMS_RD_FLASH for(int i=0;i<128;i++){ telemetry_type1[i]=long_memory_block_tm[i-1]; } for(int i=128;i<130;i++){ telemetry_type1[i]=crc_tm[i-128]; } } else if ((appdata[0]&0xF0)==0x10){ sc.printf("RD_L_FLASH2\r\r\n"); //tm is lmb //P_CDMS_RD_FLASH for(int i=0;i<128;i++){ telemetry_type1[i]=long_memory_block_tm[i-1]; } for(int i=128;i<130;i++){ telemetry_type1[i]=crc_tm[i-128]; } } else if (appdata[0]==0x22){ sc.printf("RD_S_FLASH1\r\r\n"); //tm is smb //P_CDMS_RD_FLASH telemetry_type2[0]=tmid3_spr_tm; telemetry_type2[1]=tc_pac_seq_cnt_tm; telemetry_type2[2]=tm_pac_seq_cnt_tm; for(int i=4;i<11;i++){ telemetry_type2[i]=small_memory_block_tm[i-4]; } for(int i=11;i<13;i++){ telemetry_type2[i]=crc_tm[i-11]; } } else if ((appdata[0]&0xF0)==0x30){ sc.printf("RD_S_FLASH2\r\r\n"); //tm is smb //P_CDMS_RD_FLASH telemetry_type2[0]=tmid3_spr_tm; telemetry_type2[1]=tc_pac_seq_cnt_tm; telemetry_type2[2]=tm_pac_seq_cnt_tm; for(int i=3;i<11;i++){ telemetry_type2[i]=small_memory_block_tm[i-3]; } for(int i=11;i<13;i++){ telemetry_type2[i]=crc_tm[i-11]; } } else if (appdata[0]==0x42){ sc.printf("RD_L_RAM1\r\r\n"); //tm is lmb //P_CDMS_RD_RAM for(int i=0;i<128;i++){ telemetry_type1[i]=long_memory_block_tm[i-1]; } for(int i=128;i<130;i++){ telemetry_type1[i]=crc_tm[i-128]; } } else if ((appdata[0]&0xF0)==0x50){ sc.printf("RD_L_RAM2\r\r\n"); //tm is lmb //P_CDMS_RD_RAM for(int i=0;i<128;i++){ telemetry_type1[i]=long_memory_block_tm[i-1]; } for(int i=128;i<130;i++){ telemetry_type1[i]=crc_tm[i-128]; } } else if (appdata[0]==0x62){ sc.printf("RD_S_RAM\r\r\n"); //tm is smb //P_CDMS_RD_RAM telemetry_type2[0]=tmid3_spr_tm; telemetry_type2[1]=tc_pac_seq_cnt_tm; telemetry_type2[2]=tm_pac_seq_cnt_tm; for(int i=3;i<11;i++){ telemetry_type2[i]=small_memory_block_tm[i-3]; } for(int i=11;i<13;i++){ telemetry_type2[i]=crc_tm[i-11]; } } else if ((appdata[0]&0xF0)==0x70){ sc.printf("RD_S_RAM2\r\r\n"); //tm is smb //P_CDMS_RD_RAM telemetry_type2[0]=tmid3_spr_tm; telemetry_type2[1]=tc_pac_seq_cnt_tm; telemetry_type2[2]=tm_pac_seq_cnt_tm; for(int i=3;i<11;i++){ telemetry_type2[i]=small_memory_block_tm[i-3]; } for(int i=11;i<13;i++){ telemetry_type2[i]=crc_tm[i-11]; } } else { sc.printf("INVALID TC"); //Send Invalid TC Telemetry } break; } case 5: { sc.printf("WRITE ON MEMORY\r\r\n"); switch(appdata[0]){ case 0:sc.printf("WR_S_FLASH\r\r\n"); //P_CDMS_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:sc.printf("WR_S_RAM\r\r\n"); //P_CDMS_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:sc.printf("WR_L_FLASH\r\r\n"); 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; } //P_CDMS_WR_FLASH break; case 17:sc.printf("WR_L_RAM\r\r\n"); //P_CDMS_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; default:{sc.printf("INVALID TC"); //send invalid TC TM break;} } break; } case 6: { sc.printf("WRITE FROM ONE MEMORY TO ANOTHER\r\r\n"); switch(appdata[0]){ case 0:sc.printf("WR_S_FLASH\r\r\n"); //P_CDMS_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:sc.printf("WR_S_RAM\r\r\n"); //P_CDMS_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:sc.printf("WR_L_FLASH\r\r\n"); //P_CDMS_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:sc.printf("WR_L_RAM\r\r\n"); //P_CDMS_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; default:{sc.printf("INVALID TC"); //send invalid TC TM break;} } break; } case 9: { sc.printf("SEND CRC OF FLASH MEMORY\r\r\n"); if(appdata[0]==2){ sc.printf("GET_FLASH_CRC\r\r\n"); //tm is crc_flash //P_CDMS_GET_FLASH_CRC for(int i=0;i<2;i++){ telemetry_type1[i]=crc1_tm[i]; } for(int i=2;i<4;i++){ telemetry_type1[i]=crc2_tm[i-2]; } for(int i=128;i<130;i++){ telemetry_type1[i]=crc_tm[i-128]; } } else { sc.printf("INVALID TC"); //Send Invalid TC Telemetry } break; } default:{sc.printf("INVALID TC"); //send invalid TC TM break;} } break; } case 8: { sc.printf("FUNCTION MANAGEMENT SERVICE\r\r\n"); if(sub_service_type==1){ if((appdata[0]&0xF0)==0x00){ sc.printf("RUN_PRCS\r\r\n"); switch(appdata[0]){ case 1:sc.printf("P_PL_INIT\r\r\n");//tm is ack_l234 //P_PL_INIT telemetry_type2[0]=tmid2_spr_tm; telemetry_type2[1]=tc_pac_seq_cnt_tm; telemetry_type2[2]=tm_pac_seq_cnt_tm; telemetry_type2[3]=ackcode_tm; for(int i=3;i<11;i++){ telemetry_type2[i]=0x00; } for(int i=11;i<13;i++){ telemetry_type2[i]=crc_tm[i-11]; } break; case 2:sc.printf("P_PL_MNGR\r\r\n");//tm is ack_l234 //P_PL_MNGR telemetry_type2[0]=tmid2_spr_tm; telemetry_type2[1]=tc_pac_seq_cnt_tm; telemetry_type2[2]=tm_pac_seq_cnt_tm; telemetry_type2[3]=ackcode_tm; for(int i=3;i<11;i++){ telemetry_type2[i]=0x00; } for(int i=11;i<13;i++){ telemetry_type2[i]=crc_tm[i-11]; } break; case 3:sc.printf("P_COM_INIT\r\r\n");//tm is ack_l234 //P_COM_INIT telemetry_type2[0]=tmid2_spr_tm; telemetry_type2[1]=tc_pac_seq_cnt_tm; telemetry_type2[2]=tm_pac_seq_cnt_tm; telemetry_type2[3]=ackcode_tm; for(int i=3;i<11;i++){ telemetry_type2[i]=0x00; } for(int i=11;i<13;i++){ telemetry_type2[i]=crc_tm[i-11]; } break; case 4:sc.printf("P_CDMS_HK_MNGR\r\r\n");//tm is ack_l234 //P_CDMS_HK_MNGR telemetry_type2[0]=tmid2_spr_tm; telemetry_type2[1]=tc_pac_seq_cnt_tm; telemetry_type2[2]=tm_pac_seq_cnt_tm; telemetry_type2[3]=ackcode_tm; for(int i=3;i<11;i++){ telemetry_type2[i]=0x00; } for(int i=11;i<13;i++){ telemetry_type2[i]=crc_tm[i-11]; } break; default:{sc.printf("INVALID TC"); //send invalid TC TM break;} } } else if((appdata[0]&0xF0)==0x10){ sc.printf("PWR_SWCH\r\r\n"); //P_CDMS_SWCH_PWR } else if((appdata[0]&0xF0)==0x20){ sc.printf("PWR_Rservice_type\r\r\n"); //P_CDMS_RST_PWR } else if((appdata[0]&0xF0)==0xE0){ sc.printf("RD_RTC\r\n"); //tm is func_mngmt_service_tm uint8_t* data; FUNC_CDMS_RD_RTC(data); telemetry_type2[0]=tmid4_spr_tm; telemetry_type2[1]=tc_pac_seq_cnt_tm; telemetry_type2[2]=tm_pac_seq_cnt_tm; for(int i=3;i<11;i++) { telemetry_type2[i]=data[i-3]; } for(int i=0;i<13;i++) { sc.printf("%d\r\r\n",telemetry_type2[i]); } for(int i=11;i<13;i++) { telemetry_type2[i]=crc_tm[i-11]; } for(int i=0;i<13;i++) sd_data[i]=telemetry_type2[i]; for(int i=13;i<512;i++) sd_data[i]='\0'; FUNC_WR_SD(sd_data, 512); FUNC_RD_SD(sd_read_data,512); sc.printf("data read from sd card\r\r\n"); for(int i=0;i<512;i++) sc.printf("%d ",sd_read_data[i]); } else if((appdata[0]&0xF0)==0xF0){ sc.printf("SD_MNGR\r\r\n"); //tm is func_mngmt_service_tm //P_CDMS_MNG_SD telemetry_type2[0]=tmid4_spr_tm; telemetry_type2[1]=tc_pac_seq_cnt_tm; telemetry_type2[2]=tm_pac_seq_cnt_tm; for(int i=3;i<11;i++){ telemetry_type2[i]=func_mngmt_service_tm[i-3]; } for(int i=11;i<13;i++){ telemetry_type2[i]=crc_tm[i-11]; } } else { sc.printf("INVALID TC"); //Send Invalid TC Telemetry } } else { sc.printf("INVALID TC"); //Send Invalid TC Telemetry } break; } case 7: { sc.printf("PAYLOAD MANAGEMENT SERVICE\r\r\n"); //TM is ACKL234 switch(sub_service_type){ case 1:sc.printf("INSERT PL SCHEDULE\r\r\n"); telemetry_type2[0]=tmid2_spr_tm; telemetry_type2[1]=tc_pac_seq_cnt_tm; telemetry_type2[2]=tm_pac_seq_cnt_tm; telemetry_type2[3]=ackcode_tm; for(int i=3;i<11;i++){ telemetry_type2[i]=0x00; } for(int i=11;i<13;i++){ telemetry_type2[i]=crc_tm[i-11]; } break; case 2:sc.printf("DELETE PL SCHEDULE\r\r\n"); telemetry_type2[0]=tmid2_spr_tm; telemetry_type2[1]=tc_pac_seq_cnt_tm; telemetry_type2[2]=tm_pac_seq_cnt_tm; telemetry_type2[3]=ackcode_tm; for(int i=3;i<11;i++){ telemetry_type2[i]=0x00; } for(int i=11;i<13;i++){ telemetry_type2[i]=crc_tm[i-11]; } break; default:{sc.printf("INVALID TC"); //send invalid TC TM break;} } break; } case 11: { sc.printf("ONBOARD OPERATIONS SCHEDULING SERVICE\r\r\n"); switch(sub_service_type){ case 1: { sc.printf("DISABLE RELEASE OF TCs\r\r\n"); //tm is ack_l1 telemetry_type2[0]=tmid1_spr_tm; telemetry_type2[1]=tc_exec_tm; telemetry_type2[2]=tc_service_typeatus_tm; for(int i=3;i<11;i++){ telemetry_type2[i]=pac_seq_cnt_of_tc_tm[i-3]; } for(int i=11;i<13;i++){ telemetry_type2[i]=crc_tm[i-11]; } break; } case 2: { sc.printf("ENABLE RELEASE OF TCs\r\r\n"); break; } case 5: { sc.printf("DELETE TELECOMMANDS\r\r\n"); break; } case 6: { sc.printf("REPORT TC LIST IN DETAILED FORM\r\r\n"); //tm is tc_liservice_type for(int i=0;i<9;i++){ telemetry_type1[i]=tc_liservice_type_packet1_tm[i]; } for(int i=9;i<18;i++){ telemetry_type1[i]=tc_liservice_type_packet2_tm[i-9]; } for(int i=128;i<130;i++){ telemetry_type1[i]=crc_tm[i-128]; } break; } case 8: { sc.printf("REPORT STATUS OF TC LIST\r\r\n"); //tm is ack_l1 telemetry_type2[0]=tmid1_spr_tm; telemetry_type2[1]=tc_exec_tm; telemetry_type2[2]=tc_service_typeatus_tm; for(int i=3;i<11;i++){ telemetry_type2[i]=pac_seq_cnt_of_tc_tm[i-3]; } for(int i=11;i<13;i++){ telemetry_type2[i]=crc_tm[i-11]; } break; } case 15: { sc.printf("REPORT STATUS OF LAST UNEXECUTED TC\r\r\n"); //tm is ack_l234 telemetry_type2[0]=tmid2_spr_tm; telemetry_type2[1]=tc_pac_seq_cnt_tm; telemetry_type2[2]=tm_pac_seq_cnt_tm; telemetry_type2[3]=ackcode_tm; for(int i=3;i<11;i++){ telemetry_type2[i]=0x00; } for(int i=11;i<13;i++){ telemetry_type2[i]=crc_tm[i-11]; } break; } default:{sc.printf("INVALID TC"); //send invalid TC TM break;} } break; } case 13: { sc.printf("LARGE DATA TRANSFER\r\r\n"); //tm is ack_l234 telemetry_type2[0]=tmid2_spr_tm; telemetry_type2[1]=tc_pac_seq_cnt_tm; telemetry_type2[2]=tm_pac_seq_cnt_tm; telemetry_type2[3]=ackcode_tm; for(int i=3;i<11;i++){ telemetry_type2[i]=0x00; } for(int i=11;i<13;i++){ telemetry_type2[i]=crc_tm[i-11]; } break; } case 15: { sc.printf("ONBOARD STORAGE AND RETRIEVAL SERVICE\r\r\n"); switch(sub_service_type){ case 0: { sc.printf("SCF\r\r\n"); //tm is obsrs telemetry_type1[0]=frmseqcnt_fileheadpointer_tm; for(int i=1;i<128;i++){ telemetry_type1[i]=multi_obsrs_tm_packets[i-1]; } for(int i=128;i<130;i++){ telemetry_type1[i]=crc_tm[i-128]; } break; } case 1: { sc.printf("SFF-AT\r\r\n"); telemetry_type1[0]=frmseqcnt_fileheadpointer_tm; //tm is obsrs for(int i=1;i<128;i++){ telemetry_type1[i]=multi_obsrs_tm_packets[i-1]; } for(int i=128;i<130;i++){ telemetry_type1[i]=crc_tm[i-128]; } break; } case 2: { sc.printf("SFF-BT\r\r\n"); //tm is obsrs telemetry_type1[0]=frmseqcnt_fileheadpointer_tm; for(int i=1;i<128;i++){ telemetry_type1[i]=multi_obsrs_tm_packets[i-1]; } for(int i=128;i<130;i++){ telemetry_type1[i]=crc_tm[i-128]; } break; } case 3: { sc.printf("LOG\r\r\n"); //tm is obsrs telemetry_type1[0]=frmseqcnt_fileheadpointer_tm; for(int i=1;i<128;i++){ telemetry_type1[i]=multi_obsrs_tm_packets[i-1]; } for(int i=128;i<130;i++){ telemetry_type1[i]=crc_tm[i-128]; } break; } case 4: { sc.printf("HK_ARCHIVE\r\r\n"); //tm is obsrs telemetry_type1[0]=frmseqcnt_fileheadpointer_tm; for(int i=1;i<128;i++){ telemetry_type1[i]=multi_obsrs_tm_packets[i-1]; } for(int i=128;i<130;i++){ telemetry_type1[i]=crc_tm[i-128]; } break; } default:{sc.printf("INVALID TC"); //send invalid TC TM break; } } break; } default:{sc.printf("INVALID TC"); //send invalid TC TM break; } } break; } default:{sc.printf("INVALID TC"); //send invalid TC TM break; } } }