June 30
Dependencies: FreescaleIAP SimpleDMA mbed-rtos mbed
Fork of CDMS_CODE by
Diff: COM_MNG_TMTC.h.orig
- Revision:
- 117:bfdc807f3d3c
diff -r 2e1144a41d76 -r bfdc807f3d3c COM_MNG_TMTC.h.orig --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/COM_MNG_TMTC.h.orig Sat Feb 06 10:38:35 2016 +0000 @@ -0,0 +1,1585 @@ +// 8 Jul +// did flowchart of states + +// handle sd card with cdms team + +// Jun 6 +// WHAT IS TC exec code in L1 ack ? + +//Jan 7 +//added RLY_TMTC function +//added included related files + +//#include "Flash.h" +#include "cdms_rtc.h" + +DigitalIn tm_status_4m_slv(PIN39); //I2C interrupt to CDMS from BAE +//DigitalIn tm_status_4m_pl(PIN61); //I2C interrupt to CDMS from PL + +uint8_t received = 0; +uint16_t mid1; +uint16_t mid2; +uint16_t Nbytes; +uint32_t Data[2]; +uint16_t nbytes; +uint8_t flash_counter = 0; +uint16_t crc16; +uint16_t mid; +uint32_t block; + +#define delete_TC(tc_ptr) {\ + if(tc_ptr == gHEAD_NODE_TCL){\ + gHEAD_NODE_TCL = tc_ptr->next_TC;\ + }\ + delete tc_ptr;\ +} + +// typeof tm_ptr: Base_tm +// typeof tc_ptr: Base_tc +// typeof temp_xxxx: uint8_t +#define fill_l1_ack(tm_ptr) {\ + tm_ptr->next_TM = NULL;\ + tm_ptr->TM_string[0] = TMID_ACK_L1 << 4;\ + /*PENDING: PA TEMPERATURE*/\ + tm_ptr->TM_string[1] = gTOTAL_INCORRECT_SIZE_TC & 0xFF;\ + tm_ptr->TM_string[2] = gTOTAL_CRC_FAIL_TC & 0xFF;\ +} + +#define put_crc_l1_ack(tm_ptr) {\ + tm_ptr->TM_string[2] = gTOTAL_CRC_FAIL_TC & 0xFF;\ + /*TC LIST STATUS*/\ + tm_ptr->TM_string[3] |= (gMASTER_STATE << 5) & 0xE0;\ + /*PA HOT*/\ + if( gFLAGS & COM_PA_HOT_FLAG ){\ + tm_ptr->TM_string[3] |= (1 << 4);\ + }\ + else{\ + tm_ptr->TM_string[3] &= ~(1 << 4);\ + }\ + uint16_t crc_checksum = crc16_gen(tm_ptr->TM_string, TM_SHORT_SIZE-2);\ + tm_ptr->TM_string[TM_SHORT_SIZE-2] = (crc_checksum >> 8) & 0xFF;\ + tm_ptr->TM_string[TM_SHORT_SIZE-1] = crc_checksum & 0xFF;\ +} + +#define detect_ack(tm_ptr, temp_ack, tc_psc) {\ + if( tm_ptr != NULL ){\ + int length = TM_SHORT_SIZE;\ + if( GETshort_or_long_tm(tm_ptr) == SHORT_TM_CODE ){\ + length = TM_SHORT_SIZE;\ + }\ + else{\ + length = TM_LONG_SIZE;\ + }\ + uint16_t crc = crc16_gen(tm_ptr->TM_string, length-2);\ + if( (((crc & 0xFF00) >> 8) == tm_ptr->TM_string[length-2]) && ( (crc & 0x00FF) == tm_ptr->TM_string[length-1] ) ){\ + uint8_t temp8;\ + temp8 = tm_ptr->TM_string[TM_ACK_CODE_INDEX];\ + temp8 = temp8 & 0xE0;\ + if( (temp8 == 0xC0) || (temp8 == 0xA0) )\ + temp_ack = 0x01;\ + else{\ + temp_ack = 0x00;\ + /*CHECK FOR NACK CODE: CRC FAIL NACK*/\ + temp8 = tm_ptr->TM_string[TM_ACK_CODE_INDEX];\ + temp8 = temp8 & 0x0F;\ + if( temp8 == CRC_FAIL_NACK_CODE ){\ + tm_ptr->TM_string[2] = tc_psc;\ + }\ + }\ + }\ + else\ + temp_ack = 0x00;\ + }\ + else{\ + temp_ack = 0x00;\ + }\ +} + +#define isit_obosc(tc_ptr, temp_obosc) {\ + temp_obosc = 0x00;\ + if( GETapid(tc_ptr) == APID_COM ){\ + if( ((tc_ptr->TC_string[2]) >> 4) == SERVICE_OBOSC ){\ + temp_obosc = 0x01;\ + }\ + }\ +} + +#define isit_sdcard(tc_ptr, temp_sdcard) {\ + temp_sdcard = 0x00;\ + if( GETapid(tc_ptr) == APID_COM ){\ + if( ( (tc_ptr->TC_string[2]) >> 4) == SERVICE_OBSRS ){\ + temp_sdcard = 0x01;\ + }\ + }\ +} + +#define isPAhot(returnHere){\ + /*PENDING : COMPLETE THIS FUNCTION*/\ + returnHere = 0xFF;\ +} + +void after_cooling_pa(){ + gCOM_MNG_TMTC_THREAD->signal_set(COM_MNG_TMTC_SIGNAL_UART_INT); +} + +/* +@brief: check for missing tc, also check crc, i.e. + if true execution can be started else have to wait + decide the next state +@param: none +@return: bool indicating whether there are missing tc +*/ +// PENDING: LAST FRAME BIT +/* +for loop: check for missing tc +if: check for incorrect sized tc +if: check for last frame bit +*/ +#define continueToExecute(returnHere) {\ + uint8_t tempReturn = 0x00;\ + /*search for missing psc*/\ + for(uint8_t p = 0x00 ; p < (gTOTAL_VALID_TC) ; ++p){\ + bool flag = false;\ + Base_tc *node_ptr = gHEAD_NODE_TCL;\ + while(node_ptr != NULL){\ + if( (GETpacket_seq_count(node_ptr) == p) && (GETcrc_pass(node_ptr) == 1) ){\ + flag = true;\ + break;\ + }\ + else{\ + node_ptr = node_ptr->next_TC;\ + }\ + }\ + if(flag == false){\ + tempReturn = 0x02;\ + break;\ + }\ + }\ + /*search for last packet bit*/\ + tempReturn = tempReturn + 0x01;\ + Base_tc *tcp = gHEAD_NODE_TCL;\ + while(tcp != NULL){\ + if(GETpacket_seq_count(tcp) == (gTOTAL_VALID_TC - 1)){\ + if( ( (tcp->TC_string[1]) & 0x20 ) == 0x20 ){\ + tempReturn = tempReturn - 0x01;\ + }\ + break;\ + }\ + tcp = tcp->next_TC;\ + }\ + returnHere = tempReturn;\ + /*UPDATE gMASTER STATE*/\ + if( (returnHere == 0x00) ){\ + if( (gMASTER_STATE == TCL_STATE_INCOMPLETE) || (gMASTER_STATE == TCL_STATE_COMPLETED) || (gMASTER_STATE == TCL_STATE_ABORTED) ){\ + gMASTER_STATE = TCL_STATE_EXECUTING;\ + }\ + }\ + else{\ + if( (gMASTER_STATE == TCL_STATE_INCOMPLETE) || (gMASTER_STATE == TCL_STATE_COMPLETED) ){\ + gMASTER_STATE = TCL_STATE_INCOMPLETE;\ + }\ + }\ +} + +/* +return 1 if code match +return 0 if code mismatch +*/ +#define GScodeVerification(returnHere){\ + Base_tc *testTC = gHEAD_NODE_TCL;\ + uint16_t overflowCount = 0;\ + returnHere = 0xFF;\ + while( (overflowCount < TCL_OVERFLOW_CONSTANT) && (testTC != NULL) ){\ + if( (GETpacket_seq_count(testTC) == PSC_CALLSIGN) && (GETapid(testTC) == APID_CALLSIGN) ){\ + /*uint8_t temp8 = testTC->TC_string[1];*/\ + if( true ){\ + for( int i = 2 ; i <= 8 ; ++i ){\ + if( testTC->TC_string[i] != gGSCODE[i-2] ){\ + returnHere = 0;\ + break;\ + }\ + }\ + }\ + break;\ + }\ + testTC = testTC->next_TC;\ + ++overflowCount;\ + }\ +} + +/* +@brief: DELETE THE CRC FAILED TC FROM THE LIST TO FREE-UP MEMORY AND UPDATE + THE TOTAL VALID TC AND GENERATE L1_ACK_TM +@param: none +@return: none +*/ +/*tm_ptr is the next_TM of a linked list, and should have the value NULL, i.e. tm_ptr should be the next_TM pointer of thte last node */ +#define get_ack_l1( tm_ptr ){\ + Base_tc *current_TC = gHEAD_NODE_TCL;\ + Base_tm *l1_ack = new Short_tm;\ + /*APPEND TO THE tm_ptr HERE*/\ + tm_ptr = l1_ack;\ + fill_l1_ack(l1_ack);\ + int TC_count = 0;\ + int overflowCountL1 = 0;\ + while(current_TC != NULL){\ + if( overflowCountL1 < TCL_OVERFLOW_CONSTANT ){\ + /*IF CRC PASS*/\ + if( (GETcrc_pass(current_TC) == 1) ){\ + if(TC_count > 4){\ + /*PENDING: FILL TC_EXEC_CODE, APPEND CRC TO THE TM*/\ + put_crc_l1_ack( l1_ack );\ + /*extend the TM linked list*/\ + TC_count = 0;\ + l1_ack->next_TM = new Short_tm;\ + l1_ack = l1_ack->next_TM;\ + fill_l1_ack(l1_ack);\ + }\ + /*PSC starts from 7th byte*/\ + l1_ack->TM_string[6+TC_count] = GETpacket_seq_count(current_TC);\ + /*TC exec status*/\ + switch(TC_count){\ + case 0:\ + l1_ack->TM_string[3] = (GETexec_status(current_TC)) & 0x0F;\ + break;\ + case 1:\ + l1_ack->TM_string[4] = (GETexec_status(current_TC) << 4) & 0xF0;\ + break;\ + case 2:\ + l1_ack->TM_string[4] |= (GETexec_status(current_TC)) & 0x0F;\ + break;\ + case 3:\ + l1_ack->TM_string[5] = (GETexec_status(current_TC) << 4) & 0xF0;\ + break;\ + case 4:\ + l1_ack->TM_string[5] |= (GETexec_status(current_TC)) & 0x0F;\ + }\ + ++TC_count;\ + }\ + current_TC = current_TC->next_TC;\ + ++overflowCountL1;\ + }\ + else{\ + /*PENDING: RESET CDMS*/\ + break;\ + }\ + }\ + /*FILL UP THE REMAINING FIELDS WITH 0x00 as PSC, AND 0xF as tc exec status*/\ + if( (TC_count < 5) && (TC_count != 0) ){\ + while(TC_count < 5){\ + l1_ack->TM_string[6+TC_count] = 0x00;\ + switch(TC_count){\ + case 1:\ + l1_ack->TM_string[4] = 0xF0;\ + break;\ + case 2:\ + l1_ack->TM_string[4] |= 0x0F;\ + break;\ + case 3:\ + l1_ack->TM_string[5] = 0xF0;\ + break;\ + case 4:\ + l1_ack->TM_string[5] |= 0x0F;\ + }\ + ++TC_count;\ + }\ + }\ + put_crc_l1_ack(l1_ack);\ +} + +/*tm_ptr is the next_TM of a linked list, and should have the value NULL, i.e. tm_ptr should be the next_TM pointer of thte last node */ +#define get_tc_list(tm_ptr, thePSC){\ + uint8_t TM_PSC = 0xFF;\ + uint8_t TC_PSC = thePSC;\ + int overflowCount = 0;\ + uint8_t TC_LIST_TAG = 0x00;\ + Base_tc *temp_tc = gHEAD_NODE_TCL;\ + bool first_time = true;\ + Base_tm *current_tm = NULL;\ + while( temp_tc != NULL ){\ + if( overflowCount < TCL_OVERFLOW_CONSTANT ){\ + TM_PSC = TM_PSC + 1;\ + /*Increment TM_PSC for every new TM pointer created*/\ + Base_tm *temp_tm = new Long_tm;\ + temp_tm->next_TM = NULL;\ + temp_tm->TM_string[0] = 0x38;\ + /*Frame type(1) = 0; TMID = 0111; Spare = 000*/\ + temp_tm->TM_string[1] = TC_PSC;\ + temp_tm->TM_string[3] = TM_PSC;\ + int indexCustom = 4, num_of_short_tc = 0;\ + while(temp_tc != NULL){\ + if( overflowCount < TCL_OVERFLOW_CONSTANT ){\ + if( GETshort_or_long_tc(temp_tc) == SHORT_TC_CODE ){\ + for( int i = 0 ; i < TC_SHORT_SIZE ; ++i ){\ + temp_tm->TM_string[indexCustom + i] = temp_tc->TC_string[i];\ + }\ + indexCustom = indexCustom + TC_SHORT_SIZE;\ + ++overflowCount;\ + /*INCREMENT STUFF*/\ + temp_tc = temp_tc->next_TC;\ + num_of_short_tc = num_of_short_tc + 1;\ + if (temp_tc == NULL){\ + for (int i = indexCustom ; i < TM_LONG_SIZE-2 ; ++i){\ + temp_tm->TM_string[i] = 0;\ + /*Fill remaining values with 0*/\ + }\ + TC_LIST_TAG = num_of_short_tc;\ + break;\ + }\ + if( (GETshort_or_long_tc(temp_tc) == LONG_TC_CODE) || (num_of_short_tc == OBOSC_TCL_MAX_SHORT_SIZE) ){\ + /*Next TC is long or memory is filled*/\ + for(int i = indexCustom; i < TM_LONG_SIZE-2 ; ++i){\ + temp_tm->TM_string[i] = 0;\ + /*Fill remaining values with 0*/\ + }\ + TC_LIST_TAG = num_of_short_tc;\ + break;\ + }\ + }\ + else if (TC_LIST_TAG == OBOSC_TCL_TAG_LONG_FIRST_HALF){\ + /*Long TC, 2nd half*/\ + for (int i = 0; i < OBOSC_LONG_TC_SECOND_HALF_SIZE ; ++i){\ + temp_tm->TM_string[indexCustom + i] = temp_tc->TC_string[OBOSC_LONG_TC_FIRST_HALF_SIZE + i];\ + /*Fill the TM with TC_values*/\ + }\ + for (int i = OBOSC_LONG_TC_SECOND_HALF_SIZE + indexCustom ; i < TM_LONG_SIZE-2 ; ++i ){\ + temp_tm->TM_string[i] = 0;\ + /*Fill remaining values with 0*/\ + }\ + temp_tc = temp_tc->next_TC;\ + TC_LIST_TAG = OBOSC_TCL_TAG_LONG_SECOND_HALF;\ + ++overflowCount;\ + break;\ + }\ + else{\ + /*Long TC, 1st half */\ + for (int i = 0; i < OBOSC_LONG_TC_FIRST_HALF_SIZE; ++i){\ + /*gPC.printf("indexCustom = %d\r\n", indexCustom);*/\ + temp_tm->TM_string[indexCustom + i] = temp_tc->TC_string[i];\ + /*Fill the TM with TC_values*/\ + }\ + for (int i = OBOSC_LONG_TC_FIRST_HALF_SIZE + indexCustom ; i < TM_LONG_SIZE-2 ; ++i ){\ + temp_tm->TM_string[i] = 0;\ + /*Fill remaining values with 0*/\ + }\ + TC_LIST_TAG = OBOSC_TCL_TAG_LONG_FIRST_HALF;\ + break;\ + }\ + }\ + else{\ + /*PENDING: reset cdms*/\ + break;\ + }\ + }\ + temp_tm->TM_string[2] = TC_LIST_TAG;\ + /*TC_LIST_TAG as is updated in the inner while loop*/\ + uint16_t crc16 = crc16_gen(temp_tm->TM_string, TM_LONG_SIZE-2);\ + temp_tm->TM_string[TM_LONG_SIZE-2] = (crc16 & 0xFF00) >> 8 ;\ + temp_tm->TM_string[TM_LONG_SIZE-1] = crc16 & 0x00FF;\ + /*Attach this new node to the TM linked list*/\ + if( first_time ){\ + first_time = false;\ + tm_ptr = temp_tm;\ + current_tm = temp_tm;\ + }\ + else{\ + current_tm->next_TM = temp_tm;\ + current_tm = current_tm->next_TM;\ + }\ + /*Attach this new node at the end*/\ + }\ + else{\ + /*PENDING: reset CDMS*/\ + break;\ + }\ + }\ +} + +// CDMS TEAM CODE START +inline Base_tm* FCTN_CDMS_RLY_TMTC(Base_tc *tc_ptr){ + uint8_t ACKCODE = 0x00; + //printf("\rTC execution in progress\r\n"); + Base_tm *tm_pointer = new Long_tm; + Base_tm *tm_ptr = tm_pointer; + received = 0; + switch(GETapid(tc_ptr)) + { + case 1: //apid=01 implies it corresponds to bae + { + //printf("Telecommand is for BAE\r\n"); + //printf("Sending TC to BAE...\r\n"); //interrupt to be sent to the bae + FCTN_I2C_WRITE((char*)tc_ptr->TC_string); + while(1) + { + wait(1); //TimeOut instead of wait + if(tm_status_4m_slv == 1) + { + //printf("receiving...\r\n"); + FCTN_I2C_READ((char*)tm_pointer->TM_string,134); + //printf("%s", tm_pointer->TM_string); + received+=1; + tm_pointer = tm_pointer->next_TM; + break; //only for testing purpose + } + else + { + break; + } + } + if(received >= 1 ) + { + //printf("Telemetry is received from BAE\r\n"); + Base_tm *tm_print = tm_ptr; + for(uint8_t i=0;i<received;i++) + { + //printf("%s", tm_print->TM_string); + tm_print = tm_print->next_TM; //for check + } + received = 0; + tm_pointer->next_TM = NULL; return tm_ptr; + } + else + { + //printf("Telemetry is not received from BAE\r\n"); + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = 0x01; + tm_pointer->TM_string[3] = ACKCODE; //ackcode to be decided + tm_pointer->TM_string[4] = 0x01; + for(uint8_t i=0;i<6;i++) + { + tm_pointer->TM_string[i+5] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + } + break; + } + case 2: + { + //gPC.printf("Telecommand is for CDMS\r\n"); //apid = 10 corresponds to cdms + switch(GETservice_type(tc_ptr)) + { + case 0x60: + { + //gPC.printf("service:MMS\r\n"); + switch(GETservice_subtype(tc_ptr)) + { + case 0x1: + { + //printf("sub_service:Read from RAM_Memory\r\n"); + mid=(uint16_t)(tc_ptr->TC_string[3]<<4)+(uint16_t)(tc_ptr->TC_string[4]); + + //Data[0] = FCTN_CDMS_RD_FLASH(0); + //Data[1] = FCTN_CDMS_RD_FLASH(1); + //tm_pointer = new Long_tm; + tm_pointer->TM_string[0] = 0x30; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = (uint8_t)(flash_counter); + for(uint8_t i=0;i<4;i++) + { + tm_pointer->TM_string[3+i] = (uint8_t)((Data[0]>>(8*i))&0x00FF); + } + for(uint8_t i=4;i<8;i++) + { + tm_pointer->TM_string[3+i] = (uint8_t)((Data[1]>>(8*i))&0x00FF); + } + crc16 = crc16_gen(tm_ptr->TM_string,9); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + } + case 0x2: + { + //printf("sub_service:Read from Flash_Memory\r\n"); + mid=(uint16_t)(tc_ptr->TC_string[3]<<4)+(uint16_t)(tc_ptr->TC_string[4]); + + //Data[0] = FCTN_CDMS_RD_FLASH(0); + //Data[1] = FCTN_CDMS_RD_FLASH(1); + //tm_pointer = new Long_tm; + tm_pointer->TM_string[0] = 0x30; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = (uint8_t)(flash_counter); + for(uint8_t i=0;i<4;i++) + { + tm_pointer->TM_string[3+i] = (uint8_t)((Data[0]>>(8*i))&0x00FF); + } + for(uint8_t i=4;i<8;i++) + { + tm_pointer->TM_string[3+i] = (uint8_t)((Data[1]>>(8*i))&0x00FF); + } + crc16 = crc16_gen(tm_ptr->TM_string,9); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + } + case 0x5: + { + //printf("WRITE ON FLASH_MEMORY\r\n"); + mid=(uint16_t)(tc_ptr->TC_string[3]<<4)+(uint16_t)(tc_ptr->TC_string[4]); + block = (((uint32_t)(tc_ptr->TC_string[5])<<24)|((uint32_t)(tc_ptr->TC_string[5])<<16)|((uint32_t)(tc_ptr->TC_string[5])<<8)|((uint32_t)(tc_ptr->TC_string[5]))); + //FCTN_CDMS_WR_FLASH(mid,block); + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = 0x01; + tm_pointer->TM_string[3] = ACKCODE; //ackcode to be decided + tm_pointer->TM_string[4] = 0x01; + for(uint8_t i=0;i<6;i++) + { + tm_pointer->TM_string[i+5] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + break; + } + default: + { + //printf("INVALID TC\r\n"); //Send Invalid TC Telemetry + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = 0x01; + tm_pointer->TM_string[3] = ACKCODE; //ackcode to be decided + tm_pointer->TM_string[4] = 0x01; + for(uint8_t i=0;i<6;i++) + { + tm_pointer->TM_string[i+5] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + } + break; + } + } + case 0x8: + { + //printf("service:FUNCTION MANAGEMENT SERVICE\r\n"); + if(GETservice_subtype(tc_ptr)==0x1) + { + if(GETpid(tc_ptr)==0x01) + { + //printf("TC_PL_INIT\r\n"); // call PWR_SWCH_ON function + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = ACKCODE; + for(uint8_t i=3;i<11;i++) + { + tm_pointer->TM_string[i] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + break; + } + else if(GETpid(tc_ptr)==0x02) + { + //printf("TC_PL_MAIN\r\n"); // call PWR_SWCH_ON function + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = ACKCODE; + for(uint8_t i=3;i<11;i++) + { + tm_pointer->TM_string[i] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + break; + } + else if(GETpid(tc_ptr)==0x03) + { + //printf("TC_COM_INIT\r\n"); // call PWR_SWCH_ON function + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = ACKCODE; + for(uint8_t i=3;i<11;i++) + { + tm_pointer->TM_string[i] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + break; + } + else if(GETpid(tc_ptr)==0x04) + { + //printf("TC_CDMS_HK_MAIN\r\n"); // call PWR_SWCH_ON function + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = ACKCODE; + for(uint8_t i=3;i<11;i++) + { + tm_pointer->TM_string[i] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + break; + } + else if(GETpid(tc_ptr)==0x11) + { + //printf("TC_SW_ON_SD\r\n"); // call PWR_SWCH_ON function + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = ACKCODE; + for(uint8_t i=3;i<11;i++) + { + tm_pointer->TM_string[i] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + break; + } + else if(GETpid(tc_ptr)==0x12) + { + //printf("TC_SW_ON_RTC\r\n"); // call PWR_SWCH_ON function + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = ACKCODE; + for(uint8_t i=3;i<11;i++) + { + tm_pointer->TM_string[i] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + break; + } + else if(GETpid(tc_ptr)==0x13) + { + //printf("TC_SW_ON_BAE\r\n"); // call PWR_SWCH_ON function + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = ACKCODE; + for(uint8_t i=3;i<11;i++) + { + tm_pointer->TM_string[i] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + break; + } + else if(GETpid(tc_ptr)==0x14) + { + //printf("TC_SW_ON_PL_DL\r\n"); // call PWR_SWCH_ON function + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = ACKCODE; + for(uint8_t i=3;i<11;i++) + { + tm_pointer->TM_string[i] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + break; + } + else if(GETpid(tc_ptr)==0x15) + { + //printf("TC_SW_ON_PL_AG_HV\r\n"); // call PWR_SWCH_ON function + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = ACKCODE; + for(uint8_t i=3;i<11;i++) + { + tm_pointer->TM_string[i] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + break; + } + else if(GETpid(tc_ptr)==0x16) + { + //printf("TC_SW_ON_V_A_EN\r\n"); // call PWR_SWCH_ON function + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = ACKCODE; + for(uint8_t i=3;i<11;i++) + { + tm_pointer->TM_string[i] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + break; + } + else if(GETpid(tc_ptr)==0x21) + { + //printf("TC_SW_OFF_SD\r\n"); // call PWR_SWCH_ON function + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = ACKCODE; + for(uint8_t i=3;i<11;i++) + { + tm_pointer->TM_string[i] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + break; + } + else if(GETpid(tc_ptr)==0x22) + { + //printf("TC_SW_OFF_RTC\r\n"); // call PWR_SWCH_ON function + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = ACKCODE; + for(uint8_t i=3;i<11;i++) + { + tm_pointer->TM_string[i] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + break; + } + else if(GETpid(tc_ptr)==0x23) + { + //printf("TC_SW_OFF_BAE\r\n"); // call PWR_SWCH_ON function + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = ACKCODE; + for(uint8_t i=3;i<11;i++) + { + tm_pointer->TM_string[i] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + break; + } + else if(GETpid(tc_ptr)==0x24) + { + //printf("TC_SW_OFF_PL_DL\r\n"); // call PWR_SWCH_ON function + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = ACKCODE; + for(uint8_t i=3;i<11;i++) + { + tm_pointer->TM_string[i] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + break; + } + else if(GETpid(tc_ptr)==0x25) + { + //printf("TC_SW_OFF_PL_AG_HV\r\n"); // call PWR_SWCH_ON function + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = ACKCODE; + for(uint8_t i=3;i<11;i++) + { + tm_pointer->TM_string[i] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + break; + } + else if(GETpid(tc_ptr)==0x26) + { + //printf("TC_SW_OFF_V_A_EN\r\n"); // call PWR_SWCH_ON function + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = ACKCODE; + for(uint8_t i=3;i<11;i++) + { + tm_pointer->TM_string[i] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + break; + } + else if(GETpid(tc_ptr)==0x31) + { + //printf("TC_RST_SD\r\n"); // call PWR_SWCH_ON function + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = ACKCODE; + for(uint8_t i=3;i<11;i++) + { + tm_pointer->TM_string[i] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + break; + } + else if(GETpid(tc_ptr)==0x32) + { + //printf("TC_RST_RTC\r\n"); // call PWR_SWCH_ON function + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = ACKCODE; + for(uint8_t i=3;i<11;i++) + { + tm_pointer->TM_string[i] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + break; + } + else if(GETpid(tc_ptr)==0x33) + { + //printf("TC_RST_BAE\r\n"); // call PWR_SWCH_ON function + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = ACKCODE; + for(uint8_t i=3;i<11;i++) + { + tm_pointer->TM_string[i] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + break; + } + else if(GETpid(tc_ptr)==0x34) + { + //printf("TC_RST_PL_DL\r\n"); // call PWR_SWCH_ON function + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = ACKCODE; + for(uint8_t i=3;i<11;i++) + { + tm_pointer->TM_string[i] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + break; + break; + } + else if(GETpid(tc_ptr)==0xC1) + { + //printf("RESET_HK_COUNTER\r\n"); // call PWR_SWCH_ON function + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = ACKCODE; + for(uint8_t i=3;i<11;i++) + { + tm_pointer->TM_string[i] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + break; + } + else if(GETpid(tc_ptr)==0xF1) + { + //printf("RD_RTC\r\n"); //call RD_RTC + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xD0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = 0x01; + uint64_t time = FCTN_CDMS_RD_RTC(); + tm_pointer->TM_string[3] = (uint8_t)((time&0xFF00000000000000)>>56); + tm_pointer->TM_string[4] = (uint8_t)((time&0x00FF000000000000)>>48); + tm_pointer->TM_string[5] = (uint8_t)((time&0x0000FF0000000000)>>40); + tm_pointer->TM_string[6] = (uint8_t)((time&0x000000FF00000000)>>32); + tm_pointer->TM_string[7] = (uint8_t)((time&0x00000000FF000000)>>24); + tm_pointer->TM_string[8] = (uint8_t)((time&0x0000000000FF0000)>>16); + tm_pointer->TM_string[9] = (uint8_t)((time&0x000000000000FF00)>>8); + tm_pointer->TM_string[10] = (uint8_t)(time&0x00000000000000FF); + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + } + else + { + //printf("INVALID TC\r\n"); + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = 0x01; + tm_pointer->TM_string[3] = ACKCODE; //ackcode to be decided + tm_pointer->TM_string[4] = 0x01; + for(uint8_t i=0;i<6;i++) + { + tm_pointer->TM_string[i+5] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + } + } + + + } + default: + { + //printf("INVALID TC"); //send invalid TC TM + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = 0x01; + tm_pointer->TM_string[3] = ACKCODE; //ackcode to be decided + tm_pointer->TM_string[4] = 0x01; + for(uint8_t i=0;i<6;i++) + { + tm_pointer->TM_string[i+5] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + break; + } + } + } + case 3: + { + //printf("Telecommand is for PL\r\n"); + // printf("Informing PL about TC using I2C\r\n"); //interrupt to be sent to the bae + // FCTN_I2C_WRITE((char*)tc_ptr->TC_string); + // printf("sent the Telecommand to BAE\r\n"); //packet along with crc will be sent when bae is ready + // wait(1); //wait time is to be optimised + // if(tm_status_4m_slv == 1) + // { + // FCTN_I2C_READ((char*)tm_ptr->TM_string); + // received = 1; + // } + // if(received == 1 ) + // { + // printf("Telemetry is received from BAE\r\n"); + // printf("%s", tm_ptr->TM_string); + // received = 0; + // } // similar to BAE functions + break; + } + default: //invalid TC + { + //printf("INVALID TC\r\n"); + //tm_pointer = new Short_tm; + tm_pointer->TM_string[0] = 0xB0; + tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr); + tm_pointer->TM_string[2] = 0x01; + tm_pointer->TM_string[3] = ACKCODE; //ackcode to be decided + tm_pointer->TM_string[4] = 0x01; + for(uint8_t i=0;i<6;i++) + { + tm_pointer->TM_string[i+5] = 0; + } + crc16 = crc16_gen(tm_ptr->TM_string,11); + tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8); + tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF); + tm_pointer->next_TM = NULL; return tm_ptr; + break; + } + } +} +// CDMS TEAM CODE END +// EXECUTE OBOSC +#define execute_obosc_core(tc_ptr, tm_ptr, reset_flag) {\ + uint8_t service_subtype = (tc_ptr->TC_string[2]) & 0x0F;\ + uint8_t temp8 = 0x00;\ + Base_tc *modify_this = gHEAD_NODE_TCL;\ + int modify_overflow = 0x00;\ + switch( service_subtype ){\ + case OBOSC_SUB_DISABLE:\ + /*gPC.puts("target psc are ");*/\ + for(int i = 3 ; i < 9 ; ++i){\ + /*gPC.printf("%u ", tc_ptr->TC_string[i]);*/\ + }\ + /*gPC.puts("\r\n");*/\ + /*gPC.puts("disable type obosc\r\n");*/\ + while( modify_this != NULL ){\ + if( modify_overflow < TCL_OVERFLOW_CONSTANT ){\ + uint8_t modify_psc = GETpacket_seq_count(modify_this);\ + /*gPC.printf("mosify_psc = %u\r\n", modify_psc);*/\ + for( int i = 3 ; i < 9 ; ++i ){\ + uint8_t target_psc = tc_ptr->TC_string[i];\ + if( (target_psc == modify_psc) && (target_psc != 0) ){\ + uint16_t tempExec = TC_STATE_DISABLED;\ + PUTexec_status( modify_this, tempExec );\ + break;\ + }\ + }\ + modify_this = modify_this->next_TC;\ + ++modify_overflow;\ + }\ + else{\ + /*PENDING: RESET CDMS*/\ + break;\ + }\ + }\ + break;\ + case OBOSC_SUB_RETRY:\ + /*gPC.puts("retry type obosc\r\n");*/\ + while( modify_this != NULL ){\ + if( modify_overflow < TCL_OVERFLOW_CONSTANT ){\ + uint8_t modify_psc = GETpacket_seq_count(modify_this);\ + for( int i = 3 ; i < 9 ; ++i ){\ + uint8_t target_psc = tc_ptr->TC_string[i];\ + if( (target_psc == modify_psc) && (target_psc != 0) ){\ + uint16_t tempExec = TC_STATE_MARKED_RETRY;\ + PUTexec_status( modify_this, tempExec );\ + /*gPC.puts("reqquired tc found: disable\r\n");*/\ + break;\ + }\ + }\ + modify_this = modify_this->next_TC;\ + ++modify_overflow;\ + }\ + else{\ + /*PENDING: RESET CDMS*/\ + break;\ + }\ + }\ + break;\ + }\ + Base_tm *ackl234new = new Short_tm;\ + ackl234new->next_TM = NULL;\ + /*return telemetry pointer here*/\ + tm_ptr = ackl234new;\ + ackl234new->TM_string[0] = TMID_ACK_L234 << 4;\ + ackl234new->TM_string[1] = GETpacket_seq_count(tc_ptr);\ + ackl234new->TM_string[2] = 0xA0;\ + for(int i = 3; i < 11; ++i){\ + ackl234new->TM_string[i] = 0x00;\ + }\ + uint16_t crc = crc16_gen(ackl234new->TM_string, TM_SHORT_SIZE-2);\ + ackl234new->TM_string[11] = (crc & 0xFF00) >> 8;\ + ackl234new->TM_string[12] = crc & 0x00FF;\ + /*ack l234 old*/\ + if( service_subtype == OBOSC_SUB_REP_LE ){\ + if( gLAST_TM_SHORT_OR_LONG == SHORT_TM_CODE ){\ + Base_tm *ackl234old = new Short_tm;\ + ackl234old->next_TM = NULL;\ + /*APPEND TO ACK L234 NEW HERE*/\ + ackl234new->next_TM = ackl234old;\ + for( int i = 0 ; i < TM_SHORT_SIZE ; ++i ){\ + ackl234old->TM_string[i] = gLAST_TM[i];\ + }\ + }\ + else{\ + Base_tm *tempLongTM = new Long_tm;\ + tempLongTM->next_TM = NULL;\ + /*APPEND TO ACK L234 NEW HERE*/\ + ackl234new->next_TM = tempLongTM;\ + for( int i = 0 ; i < TM_LONG_SIZE ; ++i ){\ + tempLongTM->TM_string[i] = gLAST_TM[i];\ + }\ + }\ + }\ + else if( service_subtype == OBOSC_SUB_REP_TCLD ){\ + get_tc_list(ackl234new->next_TM, GETpacket_seq_count(tc_ptr));\ + }\ + else if( service_subtype == OBOSC_SUB_RESET ){\ + /*reset_all;*/\ + reset_flag = 1;\ + /*PENDING: VERIFY reset_all, RESET CDMS*/\ + }\ + else if( (service_subtype != OBOSC_SUB_DISABLE) && (service_subtype != OBOSC_SUB_RETRY) ){\ + /*CHANGE THE ACK CODE TO INVALID TC*/\ + ackl234new->TM_string[2] = 0xA2;\ + }\ + /*gPC.puts("completed obosc\r\n");*/\ +} + +/*tm_ptr is the next_TM of a linked list, and should have the value NULL, i.e. tm_ptr should be the next_TM pointer of thte last node */ +#define get_call_sign(tm_ptr) {\ + Base_tm* call_sign_tm = new Short_tm;\ + call_sign_tm->next_TM = NULL;\ + tm_ptr = call_sign_tm;\ + for( int i = 0 ; i < TM_SHORT_SIZE ; ++i ){\ + call_sign_tm->TM_string[i] = gCALL_SIGN_STRING[i];\ + }\ +} + +#define EXECUTE_OBOSC_ONLY {\ + int reset_flag = 0;\ + for(uint8_t execute_psc = PSC_START_VALUE ; execute_psc < gTOTAL_VALID_TC ; ++execute_psc){\ + Base_tc* current_TC = gHEAD_NODE_TCL;\ + int overCount = 0;\ + while( current_TC != NULL ){\ + if( overCount < TCL_OVERFLOW_CONSTANT ){\ + if( (GETcrc_pass(current_TC) == 1) && (GETpacket_seq_count(current_TC) == execute_psc) ){\ + /*CHECK FOR OBOSC*/\ + uint8_t temp82 = 0x00;\ + isit_obosc(current_TC, temp82);\ + if(temp82 == 0x01){\ + uint16_t current_exec_status = GETexec_status(current_TC);\ + if( (current_exec_status == TC_STATE_SUCCESSFULLY_EXECUTED) || (current_exec_status == TC_STATE_DISABLED) )\ + break;\ + else if( (current_exec_status == TC_STATE_UNEXECUTED) || (current_exec_status == TC_STATE_MARKED_RETRY) ){\ + /*gPC.printf("It is obosc: %u\r\n", execute_psc);*/\ + /*EXECUTION OF OBOSC TC*/\ + /*WARNING: LARGE MEMORY UTILIZATION FOR TC-LIST-REPORT */\ + Base_tm *obosc_tm_head = NULL;\ + get_call_sign(obosc_tm_head);\ + Base_tm *obosc_tm_core = NULL;\ + execute_obosc_core(current_TC, obosc_tm_core, reset_flag);\ + uint16_t temp16 = TC_STATE_SUCCESSFULLY_EXECUTED;\ + PUTexec_status(current_TC, temp16);\ + Base_tm *obosc_tm_current = obosc_tm_head;\ + get_ack_l1(obosc_tm_current->next_TM);\ + int overflowCountOBONLY = 0;\ + while( obosc_tm_current->next_TM != NULL ){\ + if( overflowCountOBONLY < TM_OVERFLOW_CONSTANT ){\ + obosc_tm_current = obosc_tm_current->next_TM;\ + ++overflowCountOBONLY;\ + }\ + else{\ + /*PENDING: RESET CDMS*/\ + break;\ + }\ + }\ + obosc_tm_current->next_TM = obosc_tm_core;\ + obosc_tm_current = obosc_tm_head;\ + while( obosc_tm_current != NULL ){\ + int length = TM_SHORT_SIZE;\ + if( GETshort_or_long_tm(obosc_tm_current) == SHORT_TM_CODE ){\ + length = TM_SHORT_SIZE;\ + }\ + else{\ + length = TM_LONG_SIZE;\ + }\ + for(int i = 0 ; i < length ; ++i){\ + /*gPC.putc(obosc_tm_current->TM_string[i]);*/\ + }\ + obosc_tm_current = obosc_tm_current->next_TM;\ + }\ + /*Sending OBOSC TM to GS*/\ + /*snd_tm.head_pointer(obosc_tm_head);*/\ + /*transmit_adf;*/\ + /*DELETE THE TM AFTER USE*/\ + obosc_tm_current = obosc_tm_head;\ + int overCount = 0;\ + while( obosc_tm_current != NULL ){\ + if( (overCount < TM_OVERFLOW_CONSTANT) ){\ + Base_tm *temp = obosc_tm_current->next_TM;\ + delete obosc_tm_current;\ + obosc_tm_current = temp;\ + ++overCount;\ + }\ + else{\ + /*PENDING: RESET CDMS: MEMORY LEAK FOUND*/\ + break;\ + }\ + }\ + if ( reset_flag ==1 ){\ + reset_all;\ + }\ + }\ + }\ + }\ + current_TC = current_TC->next_TC;\ + ++overCount;\ + }\ + else{\ + /*PENDING: REST CDMS: MEMORY LEAK FOUND*/\ + break;\ + }\ + }\ + }\ +} + +#define EXECUTE_TC {\ + gMASTER_STATE = TCL_STATE_EXECUTING;\ + /*gPC.printf("%u\r\n", gTOTAL_VALID_TC);*/\ + for(uint8_t execute_psc = PSC_START_VALUE ; execute_psc < gTOTAL_VALID_TC ; ++execute_psc ){\ + /*gPC.printf("executing normal %u\r\n", execute_psc);*/\ + /*gLEDG = !gLEDG;*/\ + /*gLEDR = !gLEDR;*/\ + Base_tc* current_TC = gHEAD_NODE_TCL;\ + int overflowCount = 0;\ + while(current_TC != NULL){\ + if( overflowCount < TCL_OVERFLOW_CONSTANT ){\ + if( (GETcrc_pass(current_TC) == 1) && (GETpacket_seq_count(current_TC) == execute_psc) ){\ + uint8_t current_exec_status = GETexec_status(current_TC);\ + if( (current_exec_status == TC_STATE_SUCCESSFULLY_EXECUTED) || (current_exec_status == TC_STATE_DISABLED) ){\ + /*gPC.printf("disabled or completed at %u\n", execute_psc);*/\ + break;\ + }\ + else if( (current_exec_status == TC_STATE_EXECUTION_FAILED) && (GETabort_on_nack(current_TC) == 1) ){\ + /*gPC.printf("abort on nack at %u psc\r\n", execute_psc);*/\ + gMASTER_STATE = TCL_STATE_ABORTED;\ + Base_tm *tm_ptr_head = NULL;\ + get_call_sign(tm_ptr_head);\ + Base_tm *tm_ptr = tm_ptr_head;\ + get_ack_l1(tm_ptr->next_TM);\ + tm_ptr = tm_ptr_head;\ + while( tm_ptr != NULL ){\ + int length = TM_SHORT_SIZE;\ + if( GETshort_or_long_tm(tm_ptr) == SHORT_TM_CODE ){\ + length = TM_SHORT_SIZE;\ + }\ + else{\ + length = TM_LONG_SIZE;\ + }\ + /*gPC.puts("Printing Call Sign, ACK_L1, TM list");*/\ + for(int i = 0 ; i < length ; ++i){\ + /*gPC.putc(tm_ptr->TM_string[i]);*/\ + }\ + tm_ptr = tm_ptr->next_TM;\ + }\ + /*Send only call sign, ACK_L1 to GS*/\ + /*snd_tm.head_pointer(tm_ptr_head);*/\ + /*transmit_adf;*/\ + /*DELETE THE TM AFTER USE*/\ + tm_ptr = tm_ptr_head;\ + int overflowCountExecute = 0;\ + while(tm_ptr != NULL){\ + if( overflowCountExecute < TM_OVERFLOW_CONSTANT ){\ + Base_tm *temp = tm_ptr->next_TM;\ + delete tm_ptr;\ + tm_ptr = temp;\ + ++overflowCountExecute;\ + }\ + else{\ + /*PENDING: RESET CDMS*/\ + break;\ + }\ + }\ + break;\ + }\ + else if( (current_exec_status == TC_STATE_UNEXECUTED) || (current_exec_status == TC_STATE_MARKED_RETRY) ){\ + /*EXECUTION OF TC START*/\ + uint8_t temp81 = 0x00;\ + isit_sdcard(current_TC, temp81);\ + if( temp81 == 0x00 ){\ + /*gPC.printf("non sd card at %u\r\n", execute_psc);*/\ + /*EXECUTION OF NON SD-CARD (BOTH OBOSC and CDMS functions)*/\ + Base_tm *tm_ptr_head = NULL;\ + get_call_sign(tm_ptr_head);\ + Base_tm *put_tm_here = NULL;\ + uint8_t temp82 = 0x00;\ + uint8_t tempPAhot = 0x00;\ + isit_obosc(current_TC, temp82);\ + if(temp82 == 0x01){\ + /*gPC.printf("obosc tc inside normal tc at %u\r\n", execute_psc);*/\ + /*EXECUTION OF OBOSC TC*/\ + /*SKIP EXECUTION OF OBOSC HERE*/\ + break;\ + }\ + else{\ + /*gPC.printf("cdms relay tmtc at %u\r\n", execute_psc);*/\ + /*call CDMS_RLY_TMTC*/\ + /*CDMS_RLY_TMTC(current_TC, put_tm_here);*/\ + put_tm_here = FCTN_CDMS_RLY_TMTC(current_TC);\ + }\ + /*DETECT ACK OR NACK*/\ + uint8_t temp83 = 0x00;\ + uint8_t temp84 = GETpacket_seq_count(current_TC);\ + detect_ack(put_tm_here, temp83, temp84);\ + if( temp83 == 0x01){\ + uint16_t temp16 = TC_STATE_SUCCESSFULLY_EXECUTED;\ + PUTexec_status(current_TC, temp16);\ + }\ + else{\ + /*gPC.puts("TC_STATE_EXECUTION_FAILED");*/\ + uint16_t temp16 = TC_STATE_EXECUTION_FAILED;\ + PUTexec_status(current_TC, temp16);\ + }\ + /*ABORT ON NACK AND TC LIST COMPLETED: UPDATE IN gMASTERSTATE*/\ + if( (GETexec_status(current_TC) == TC_STATE_EXECUTION_FAILED) && (GETabort_on_nack(current_TC) == 1) ){\ + gMASTER_STATE = TCL_STATE_ABORTED;\ + }\ + else if( execute_psc == (gTOTAL_VALID_TC-1) ){\ + /*LAST TC IS EXECUTED*/\ + gMASTER_STATE = TCL_STATE_COMPLETED;\ + }\ + else{\ + uint8_t check1 = 1;\ + for( uint8_t test_psc = execute_psc+1 ; test_psc < gTOTAL_VALID_TC ; ++test_psc ){\ + Base_tc* test_TC = gHEAD_NODE_TCL;\ + while(test_TC != NULL){\ + if( GETpacket_seq_count(test_TC) == test_psc ){\ + uint8_t checkval;\ + isit_obosc(test_TC, checkval);\ + if( checkval == 0 ){\ + check1 = 0;\ + }\ + }\ + test_TC = test_TC->next_TC;\ + }\ + }\ + if( check1 == 0x01 ){\ + gMASTER_STATE = TCL_STATE_COMPLETED;\ + }\ + }\ + /*update last executed L1_ack*/\ + if( put_tm_here != NULL ){\ + if( GETshort_or_long_tm(put_tm_here) == SHORT_TM_CODE ){\ + for(int i = 0 ; i < TM_SHORT_SIZE ; ++i){\ + gLAST_TM[i] = put_tm_here->TM_string[i];\ + gLAST_TM_SHORT_OR_LONG = SHORT_TM_CODE;\ + }\ + }\ + else{\ + for( int i = 0 ; i < TM_LONG_SIZE ; ++i ){\ + gLAST_TM[i] = put_tm_here->TM_string[i];\ + gLAST_TM_SHORT_OR_LONG = LONG_TM_CODE;\ + }\ + }\ + }\ + /*PENDING: APPEND ACK L1*/\ + Base_tm *tm_ptr = tm_ptr_head;\ + get_ack_l1(tm_ptr->next_TM);\ + int overflowCountExecute = 0;\ + while( tm_ptr->next_TM != NULL ){\ + if( overflowCountExecute < TM_OVERFLOW_CONSTANT ){\ + tm_ptr = tm_ptr->next_TM;\ + ++overflowCountExecute;\ + }\ + else{\ + /*PENDING: RESET CDMS*/\ + break;\ + }\ + }\ + tm_ptr->next_TM = put_tm_here;\ + /*CHECK FOR HOT PA*/\ + isPAhot(tempPAhot);\ + if( tempPAhot == 0x00 ){\ + gFLAGS = gFLAGS | COM_PA_HOT_FLAG;\ + }\ + tm_ptr = tm_ptr_head;\ + while( tm_ptr != NULL ){\ + int length = TM_SHORT_SIZE;\ + if( GETshort_or_long_tm(tm_ptr) == SHORT_TM_CODE ){\ + length = TM_SHORT_SIZE;\ + }\ + else{\ + length = TM_LONG_SIZE;\ + }\ + /*gPC.puts("Printing Call Sign, ACK_L1, TM list");*/\ + for(int i = 0 ; i < length ; ++i){\ + /*gPC.putc(tm_ptr->TM_string[i]);*/\ + }\ + tm_ptr = tm_ptr->next_TM;\ + }\ + /*SEND call sign, ACK_L1, NON OBSRS TM TO GS*/\ + snd_tm.head_pointer(tm_ptr_head);\ + gPC.puts("enter_adf\r\n");\ + transmit_adf;\ + gPC.puts("exit_adf\r\n");\ + /*DELETE THE TM AFTER USE*/\ + tm_ptr = tm_ptr_head;\ + overflowCountExecute = 0;\ + while(tm_ptr != NULL){\ + if( overflowCountExecute < TM_OVERFLOW_CONSTANT ){\ + Base_tm *temp = tm_ptr->next_TM;\ + delete tm_ptr;\ + tm_ptr = temp;\ + ++overflowCountExecute;\ + }\ + else{\ + /*PENDING: RESET CDMS*/\ + break;\ + }\ + }\ + }\ + else{\ + /*gPC.printf("sd card at %u\r\n", execute_psc);*/\ + /*EXECUTION OF SD-CARD DATA SENDING (OBSRS)*/\ + Base_tm *tm_ptr_head = NULL;\ + get_call_sign(tm_ptr_head);\ + Base_tm *put_tm_here = NULL;\ + /*execute_obsrs(current_TC, put_tm_here)*/\ + /*read_TC(current_TC);*/\ + execute_OBSRS_TC(current_TC);\ + gPC.puts("en_adf");\ + transmit_adf;\ + gPC.puts("ex_adf");\ + uint8_t tempExec = TC_STATE_SUCCESSFULLY_EXECUTED;\ + PUTexec_status(current_TC, tempExec);\ + /*PENDING: ABORT ON NACK CHECK, gMASTER_STATE VERIFICATION WITH SD CARD, session timeout, last executed ack l234*/\ + if( (GETexec_status(current_TC) == TC_STATE_EXECUTION_FAILED) && (GETabort_on_nack(current_TC) == 1) ){\ + gMASTER_STATE = TCL_STATE_ABORTED;\ + }\ + else if( execute_psc == (gTOTAL_VALID_TC-1) ){\ + gMASTER_STATE = TCL_STATE_COMPLETED;\ + }\ + else{\ + uint8_t check1 = 1;\ + for( uint8_t test_psc = execute_psc+1 ; test_psc < gTOTAL_VALID_TC ; ++test_psc ){\ + Base_tc* test_TC = gHEAD_NODE_TCL;\ + while(test_TC != NULL){\ + if( GETpacket_seq_count(test_TC) == test_psc ){\ + uint8_t checkval;\ + isit_obosc(test_TC, checkval);\ + if( checkval == 0 ){\ + check1 = 0;\ + }\ + }\ + test_TC = test_TC->next_TC;\ + }\ + }\ + if( check1 == 0x01 ){\ + gMASTER_STATE = TCL_STATE_COMPLETED;\ + }\ + }\ + /*update last executed L1_ack*/\ + if( put_tm_here != NULL ){\ + if( GETshort_or_long_tm(put_tm_here) == SHORT_TM_CODE ){\ + for(int i = 0 ; i < TM_SHORT_SIZE ; ++i){\ + gLAST_TM[i] = put_tm_here->TM_string[i];\ + gLAST_TM_SHORT_OR_LONG = SHORT_TM_CODE;\ + }\ + }\ + else{\ + for( int i = 0 ; i < TM_LONG_SIZE ; ++i ){\ + gLAST_TM[i] = put_tm_here->TM_string[i];\ + gLAST_TM_SHORT_OR_LONG = LONG_TM_CODE;\ + }\ + }\ + }\ + /*PENDING: APPEND ACK L1*/\ + Base_tm *tm_ptr = tm_ptr_head;\ + get_ack_l1(tm_ptr->next_TM);\ + int overflowCountExecute = 0;\ + while( tm_ptr->next_TM != NULL ){\ + if( overflowCountExecute < TM_OVERFLOW_CONSTANT ){\ + tm_ptr = tm_ptr->next_TM;\ + ++overflowCountExecute;\ + }\ + else{\ + /*PENDING: RESET CDMS*/\ + break;\ + }\ + }\ + tm_ptr->next_TM = put_tm_here;\ + /*CHECK FOR HOT PA*/\ + uint8_t tempPAhot = 0x00;\ + isPAhot(tempPAhot);\ + if( tempPAhot == 0x00 ){\ + gFLAGS = gFLAGS | COM_PA_HOT_FLAG;\ + }\ + tm_ptr = tm_ptr_head;\ + while( tm_ptr != NULL ){\ + int length = TM_SHORT_SIZE;\ + if( GETshort_or_long_tm(tm_ptr) == SHORT_TM_CODE ){\ + length = TM_SHORT_SIZE;\ + }\ + else{\ + length = TM_LONG_SIZE;\ + }\ + /*gPC.puts("Printing Call Sign, ACK_L1, TM list");*/\ + for(int i = 0 ; i < length ; ++i){\ + /*gPC.putc(tm_ptr->TM_string[i]);*/\ + }\ + tm_ptr = tm_ptr->next_TM;\ + }\ + /*SEND call sign, ACK_L1, OBSRS TO GS*/\ + /*snd_tm.head_pointer(tm_ptr_head);*/\ + /*adf_SDcard();*/\ + /*DELETE THE TM AFTER USE*/\ + tm_ptr = tm_ptr_head;\ + overflowCountExecute = 0;\ + while(tm_ptr != NULL){\ + if( overflowCountExecute < TM_OVERFLOW_CONSTANT ){\ + Base_tm *temp = tm_ptr->next_TM;\ + delete tm_ptr;\ + tm_ptr = temp;\ + ++overflowCountExecute;\ + }\ + else{\ + /*PENDING: RESET CDMS*/\ + break;\ + }\ + }\ + }\ + }\ + break;\ + }\ + current_TC = current_TC->next_TC;\ + ++overflowCount;\ + }\ + else{\ + /*PENDING: RESET CDMS*/\ + break;\ + }\ + }\ + if( gFLAGS & COM_SESSION_TIMEOUT_FLAG ){\ + break;\ + }\ + else if( gMASTER_STATE == TCL_STATE_ABORTED ){\ + /*gPC.puts("ABORTING DUE TO ABORT ON NACK\r\n");*/\ + /*EXITED DUE TO ABORT ON NACK:*/\ + /*PENDING : POWER OFF COM TX*/\ + RX1M.attach(&rx_read, Serial::RxIrq);\ + gFLAGS = gFLAGS & (~COM_MNG_TMTC_RUNNING_FLAG);\ + break;\ + }\ + else if( gFLAGS & COM_PA_HOT_FLAG ){\ + /*PA HOT: WAIT FOR TIMEOUT*/\ + gCOM_PA_COOLING_TIMEOUT.attach(&after_cooling_pa, COM_PA_COOLING_TIME_LIMIT);\ + /*PENDING : POWER OFF COMM TX*/\ + RX1M.attach(&rx_read, Serial::RxIrq);\ + gFLAGS = gFLAGS & (~COM_MNG_TMTC_RUNNING_FLAG);\ + break;\ + }\ + /*gPC.printf("successflly executed %u tc\r\n", execute_psc);*/\ + }\ + if( (gMASTER_STATE == TCL_STATE_COMPLETED) || (gFLAGS & COM_SESSION_TIMEOUT_FLAG) ){\ + /*gPC.printf("completed or session timed out: %x\r\n", gMASTER_STATE);*/\ + /*COMPLETED EXECUTION OF TC*/\ + gMASTER_STATE = TCL_STATE_COMPLETED;\ + COM_POWER_OFF_TX;\ + reset_all;\ + /*PENDING : ENABLE THREADS*/\ + gSESSION_TIMEOUT.detach();\ + gFLAGS = gFLAGS & (~COM_MNG_TMTC_RUNNING_FLAG);\ + gFLAGS = gFLAGS & (~COM_SESSION_FLAG);\ + }\ +} \ No newline at end of file