pl ack in tmtc

Dependencies:   FreescaleIAP SimpleDMA mbed-rtos mbed

Fork of COM_MNG_TMTC_SIMPLE_pl123 by shubham c

Committer:
ee12b079
Date:
Fri Jan 15 08:59:09 2016 +0000
Revision:
57:bf998cb2a104
Parent:
55:39e59903bc3a
Child:
59:29a37f943ba6
Child:
60:768056b558b2
Made changes for printing type1 and type0 tm frames in snd_tm. This is for bypassing adf and sending directly to APS.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
shreeshas95 0:f016e9e8d48b 1 // 8 Jul
shreeshas95 0:f016e9e8d48b 2 // did flowchart of states
shreeshas95 0:f016e9e8d48b 3
shreeshas95 0:f016e9e8d48b 4 // handle sd card with cdms team
shreeshas95 0:f016e9e8d48b 5
shreeshas95 0:f016e9e8d48b 6 // Jun 6
shreeshas95 0:f016e9e8d48b 7 // WHAT IS TC exec code in L1 ack ?
shreeshas95 0:f016e9e8d48b 8
aniruddhv 52:0bd68655c651 9 //Jan 7
aniruddhv 52:0bd68655c651 10 //added RLY_TMTC function
aniruddhv 52:0bd68655c651 11 //added included related files
aniruddhv 52:0bd68655c651 12
ee12b079 57:bf998cb2a104 13 #define print_in_snd_tm 1
ee12b079 57:bf998cb2a104 14
aniruddhv 52:0bd68655c651 15 #include "pinconfig.h"
aniruddhv 52:0bd68655c651 16 #include "i2c.h"
aniruddhv 52:0bd68655c651 17 #include "Flash.h"
aniruddhv 52:0bd68655c651 18 #include "cdms_rtc.h"
aniruddhv 52:0bd68655c651 19
aniruddhv 52:0bd68655c651 20 DigitalIn tm_status_4m_slv(PIN39); //I2C interrupt to CDMS from BAE
aniruddhv 52:0bd68655c651 21 //DigitalIn tm_status_4m_pl(PIN61); //I2C interrupt to CDMS from PL
aniruddhv 52:0bd68655c651 22
aniruddhv 52:0bd68655c651 23 uint8_t received = 0;
aniruddhv 52:0bd68655c651 24 uint16_t mid1;
aniruddhv 52:0bd68655c651 25 uint16_t mid2;
aniruddhv 52:0bd68655c651 26 uint16_t Nbytes;
aniruddhv 52:0bd68655c651 27 uint32_t Data[2];
aniruddhv 52:0bd68655c651 28 uint16_t nbytes;
aniruddhv 52:0bd68655c651 29 uint8_t flash_counter = 0;
aniruddhv 52:0bd68655c651 30 uint16_t crc16;
aniruddhv 52:0bd68655c651 31 uint16_t mid;
aniruddhv 52:0bd68655c651 32 uint32_t block;
aniruddhv 52:0bd68655c651 33
shreeshas95 0:f016e9e8d48b 34 #define delete_TC(tc_ptr) {\
shreeshas95 0:f016e9e8d48b 35 if(tc_ptr == gHEAD_NODE_TCL){\
shreeshas95 0:f016e9e8d48b 36 gHEAD_NODE_TCL = tc_ptr->next_TC;\
shreeshas95 0:f016e9e8d48b 37 }\
shreeshas95 0:f016e9e8d48b 38 delete tc_ptr;\
shreeshas95 0:f016e9e8d48b 39 }
shreeshas95 0:f016e9e8d48b 40
shreeshas95 0:f016e9e8d48b 41 // typeof tm_ptr: Base_tm
shreeshas95 0:f016e9e8d48b 42 // typeof tc_ptr: Base_tc
shreeshas95 0:f016e9e8d48b 43 // typeof temp_xxxx: uint8_t
shreeshas95 0:f016e9e8d48b 44 #define fill_l1_ack(tm_ptr) {\
shreeshas95 0:f016e9e8d48b 45 uint8_t temp8;\
shreeshas95 0:f016e9e8d48b 46 tm_ptr->next_TM = NULL;\
shreeshas95 4:104dd82c99b8 47 temp8 = TMID_ACK_L1;\
shreeshas95 0:f016e9e8d48b 48 PUTtmid(tm_ptr->fields, temp8);\
shreeshas95 4:104dd82c99b8 49 temp8 = SHORT_TM_CODE;\
shreeshas95 0:f016e9e8d48b 50 PUTshort_or_long_tm(tm_ptr->fields, temp8);\
shreeshas95 0:f016e9e8d48b 51 tm_ptr->TM_string[0] = TMID_ACK_L1 << 4;\
shreeshas95 4:104dd82c99b8 52 /*PENDING: PA TEMPERATURE*/\
shreeshas95 0:f016e9e8d48b 53 tm_ptr->TM_string[1] = gTOTAL_INCORRECT_SIZE_TC & 0xFF;\
shreeshas95 0:f016e9e8d48b 54 tm_ptr->TM_string[2] = gTOTAL_CRC_FAIL_TC & 0xFF;\
shreeshas95 0:f016e9e8d48b 55 }
shreeshas95 0:f016e9e8d48b 56
shreeshas95 4:104dd82c99b8 57 #define put_crc_l1_ack(tm_ptr) {\
shreeshas95 4:104dd82c99b8 58 tm_ptr->TM_string[2] = gTOTAL_CRC_FAIL_TC & 0xFF;\
shreeshas95 4:104dd82c99b8 59 /*TC LIST STATUS*/\
shreeshas95 4:104dd82c99b8 60 tm_ptr->TM_string[3] |= (gMASTER_STATE << 5) & 0xE0;\
shreeshas95 4:104dd82c99b8 61 /*PA HOT*/\
shreeshas95 4:104dd82c99b8 62 if( gFLAGS & COM_PA_HOT_FLAG ){\
shreeshas95 4:104dd82c99b8 63 tm_ptr->TM_string[3] |= (1 << 4);\
shreeshas95 4:104dd82c99b8 64 }\
shreeshas95 4:104dd82c99b8 65 else{\
shreeshas95 4:104dd82c99b8 66 tm_ptr->TM_string[3] &= ~(1 << 4);\
shreeshas95 4:104dd82c99b8 67 }\
shreeshas95 4:104dd82c99b8 68 uint16_t crc_checksum = crc16_gen(tm_ptr->TM_string, TM_SHORT_SIZE-2);\
shreeshas95 0:f016e9e8d48b 69 tm_ptr->TM_string[TM_SHORT_SIZE-2] = (crc_checksum >> 8) & 0xFF;\
shreeshas95 0:f016e9e8d48b 70 tm_ptr->TM_string[TM_SHORT_SIZE-1] = crc_checksum & 0xFF;\
shreeshas95 0:f016e9e8d48b 71 }
shreeshas95 0:f016e9e8d48b 72
shreeshas95 4:104dd82c99b8 73 #define detect_ack(tm_ptr, temp_ack, tc_psc) {\
shreeshas95 5:ab276a17ca07 74 if( tm_ptr != NULL ){\
aniruddhv 14:08c2c887ea09 75 int length = TM_SHORT_SIZE;\
aniruddhv 14:08c2c887ea09 76 if( GETshort_or_long_tm(tm_ptr->fields) == SHORT_TM_CODE ){\
aniruddhv 14:08c2c887ea09 77 length = TM_SHORT_SIZE;\
aniruddhv 14:08c2c887ea09 78 }\
aniruddhv 14:08c2c887ea09 79 else{\
aniruddhv 14:08c2c887ea09 80 length = TM_LONG_SIZE;\
aniruddhv 14:08c2c887ea09 81 }\
aniruddhv 14:08c2c887ea09 82 uint16_t crc = crc16_gen(tm_ptr->TM_string, length-2);\
shreeshas95 5:ab276a17ca07 83 if( (((crc & 0xFF00) >> 8) == tm_ptr->TM_string[length-2]) && ( (crc & 0x00FF) == tm_ptr->TM_string[length-1] ) ){\
shreeshas95 4:104dd82c99b8 84 uint8_t temp8;\
shreeshas95 4:104dd82c99b8 85 temp8 = tm_ptr->TM_string[TM_ACK_CODE_INDEX];\
shreeshas95 4:104dd82c99b8 86 temp8 = temp8 & 0xE0;\
shreeshas95 4:104dd82c99b8 87 if( (temp8 == 0xC0) || (temp8 == 0xA0) )\
shreeshas95 4:104dd82c99b8 88 temp_ack = 0x01;\
shreeshas95 4:104dd82c99b8 89 else{\
shreeshas95 4:104dd82c99b8 90 temp_ack = 0x00;\
shreeshas95 4:104dd82c99b8 91 /*CHECK FOR NACK CODE: CRC FAIL NACK*/\
shreeshas95 4:104dd82c99b8 92 temp8 = tm_ptr->TM_string[TM_ACK_CODE_INDEX];\
shreeshas95 4:104dd82c99b8 93 temp8 = temp8 & 0x0F;\
shreeshas95 5:ab276a17ca07 94 if( temp8 == CRC_FAIL_NACK_CODE ){\
shreeshas95 4:104dd82c99b8 95 tm_ptr->TM_string[2] = tc_psc;\
shreeshas95 4:104dd82c99b8 96 }\
shreeshas95 4:104dd82c99b8 97 }\
shreeshas95 4:104dd82c99b8 98 }\
shreeshas95 0:f016e9e8d48b 99 else\
shreeshas95 0:f016e9e8d48b 100 temp_ack = 0x00;\
shreeshas95 0:f016e9e8d48b 101 }\
shreeshas95 4:104dd82c99b8 102 else{\
shreeshas95 0:f016e9e8d48b 103 temp_ack = 0x00;\
shreeshas95 4:104dd82c99b8 104 }\
shreeshas95 0:f016e9e8d48b 105 }
shreeshas95 0:f016e9e8d48b 106
shreeshas95 0:f016e9e8d48b 107 #define isit_obosc(tc_ptr, temp_obosc) {\
shreeshas95 0:f016e9e8d48b 108 temp_obosc = 0x00;\
aniruddhv 52:0bd68655c651 109 if( GETapid(tc_ptr) == APID_COM ){\
aniruddhv 52:0bd68655c651 110 if( ((tc_ptr->TC_string[2]) >> 4) == SERVICE_OBOSC ){\
aniruddhv 52:0bd68655c651 111 temp_obosc = 0x01;\
shreeshas95 0:f016e9e8d48b 112 }\
shreeshas95 0:f016e9e8d48b 113 }\
shreeshas95 0:f016e9e8d48b 114 }
shreeshas95 0:f016e9e8d48b 115
shreeshas95 0:f016e9e8d48b 116 #define isit_sdcard(tc_ptr, temp_sdcard) {\
shreeshas95 0:f016e9e8d48b 117 temp_sdcard = 0x00;\
aniruddhv 52:0bd68655c651 118 if( GETapid(tc_ptr) == APID_COM ){\
aniruddhv 52:0bd68655c651 119 if( ( (tc_ptr->TC_string[2]) >> 4) == SERVICE_OBSRS ){\
aniruddhv 52:0bd68655c651 120 temp_sdcard = 0x01;\
shreeshas95 0:f016e9e8d48b 121 }\
shreeshas95 0:f016e9e8d48b 122 }\
shreeshas95 0:f016e9e8d48b 123 }
shreeshas95 0:f016e9e8d48b 124
shreeshas95 2:2caf2a9a13aa 125 #define isPAhot(returnHere){\
shreeshas95 2:2caf2a9a13aa 126 /*PENDING : COMPLETE THIS FUNCTION*/\
shreeshas95 2:2caf2a9a13aa 127 returnHere = 0xFF;\
shreeshas95 2:2caf2a9a13aa 128 }
shreeshas95 2:2caf2a9a13aa 129
shreeshas95 2:2caf2a9a13aa 130 void after_cooling_pa(){
shreeshas95 2:2caf2a9a13aa 131 gCOM_MNG_TMTC_THREAD->signal_set(COM_MNG_TMTC_SIGNAL_UART_INT);
shreeshas95 2:2caf2a9a13aa 132 }
shreeshas95 2:2caf2a9a13aa 133
shreeshas95 0:f016e9e8d48b 134 /*
shreeshas95 0:f016e9e8d48b 135 @brief: check for missing tc, also check crc, i.e.
shreeshas95 0:f016e9e8d48b 136 if true execution can be started else have to wait
shreeshas95 0:f016e9e8d48b 137 decide the next state
shreeshas95 0:f016e9e8d48b 138 @param: none
shreeshas95 0:f016e9e8d48b 139 @return: bool indicating whether there are missing tc
shreeshas95 0:f016e9e8d48b 140 */
shreeshas95 0:f016e9e8d48b 141 // PENDING: LAST FRAME BIT
shreeshas95 0:f016e9e8d48b 142 /*
shreeshas95 0:f016e9e8d48b 143 for loop: check for missing tc
shreeshas95 0:f016e9e8d48b 144 if: check for incorrect sized tc
shreeshas95 0:f016e9e8d48b 145 if: check for last frame bit
shreeshas95 0:f016e9e8d48b 146 */
shreeshas95 0:f016e9e8d48b 147 #define continueToExecute(returnHere) {\
shreeshas95 0:f016e9e8d48b 148 uint8_t tempReturn = 0x00;\
shreeshas95 5:ab276a17ca07 149 /*search for missing psc*/\
shreeshas95 15:1c1ca992b43b 150 for(uint8_t p = 0x00 ; p < (gTOTAL_VALID_TC) ; ++p){\
shreeshas95 0:f016e9e8d48b 151 bool flag = false;\
shreeshas95 0:f016e9e8d48b 152 Base_tc *node_ptr = gHEAD_NODE_TCL;\
shreeshas95 0:f016e9e8d48b 153 while(node_ptr != NULL){\
shreeshas95 0:f016e9e8d48b 154 if( (GETpacket_seq_count(node_ptr) == p) && (GETcrc_pass(node_ptr) == 1) ){\
shreeshas95 0:f016e9e8d48b 155 flag = true;\
shreeshas95 0:f016e9e8d48b 156 break;\
shreeshas95 0:f016e9e8d48b 157 }\
shreeshas95 0:f016e9e8d48b 158 else{\
shreeshas95 0:f016e9e8d48b 159 node_ptr = node_ptr->next_TC;\
shreeshas95 0:f016e9e8d48b 160 }\
shreeshas95 0:f016e9e8d48b 161 }\
shreeshas95 0:f016e9e8d48b 162 if(flag == false){\
shreeshas95 0:f016e9e8d48b 163 tempReturn = 0x02;\
shreeshas95 0:f016e9e8d48b 164 break;\
shreeshas95 0:f016e9e8d48b 165 }\
shreeshas95 0:f016e9e8d48b 166 }\
shreeshas95 5:ab276a17ca07 167 /*search for last packet bit*/\
shreeshas95 5:ab276a17ca07 168 tempReturn = tempReturn + 0x01;\
shreeshas95 0:f016e9e8d48b 169 Base_tc *tcp = gHEAD_NODE_TCL;\
shreeshas95 0:f016e9e8d48b 170 while(tcp != NULL){\
rohit3342 16:538de1b20b3a 171 if(GETpacket_seq_count(tcp) == (gTOTAL_VALID_TC - 1)){\
shreeshas95 5:ab276a17ca07 172 if( ( (tcp->TC_string[1]) & 0x20 ) == 0x20 ){\
shreeshas95 5:ab276a17ca07 173 tempReturn = tempReturn - 0x01;\
shreeshas95 0:f016e9e8d48b 174 }\
shreeshas95 0:f016e9e8d48b 175 break;\
shreeshas95 0:f016e9e8d48b 176 }\
shreeshas95 0:f016e9e8d48b 177 tcp = tcp->next_TC;\
shreeshas95 0:f016e9e8d48b 178 }\
shreeshas95 0:f016e9e8d48b 179 returnHere = tempReturn;\
shreeshas95 5:ab276a17ca07 180 /*UPDATE gMASTER STATE*/\
shreeshas95 5:ab276a17ca07 181 if( (returnHere == 0x00) ){\
aniruddhv 37:c9a739750806 182 if( (gMASTER_STATE == TCL_STATE_INCOMPLETE) || (gMASTER_STATE == TCL_STATE_COMPLETED) || (gMASTER_STATE == TCL_STATE_ABORTED) ){\
aniruddhv 37:c9a739750806 183 gMASTER_STATE = TCL_STATE_EXECUTING;\
shreeshas95 5:ab276a17ca07 184 }\
shreeshas95 5:ab276a17ca07 185 }\
shreeshas95 5:ab276a17ca07 186 else{\
shreeshas95 5:ab276a17ca07 187 if( (gMASTER_STATE == TCL_STATE_INCOMPLETE) || (gMASTER_STATE == TCL_STATE_COMPLETED) ){\
shreeshas95 5:ab276a17ca07 188 gMASTER_STATE = TCL_STATE_INCOMPLETE;\
shreeshas95 5:ab276a17ca07 189 }\
shreeshas95 5:ab276a17ca07 190 }\
shreeshas95 0:f016e9e8d48b 191 }
shreeshas95 0:f016e9e8d48b 192
shreeshas95 0:f016e9e8d48b 193 /*
shreeshas95 2:2caf2a9a13aa 194 return 1 if code match
shreeshas95 2:2caf2a9a13aa 195 return 0 if code mismatch
shreeshas95 2:2caf2a9a13aa 196 */
shreeshas95 2:2caf2a9a13aa 197 #define GScodeVerification(returnHere){\
shreeshas95 2:2caf2a9a13aa 198 Base_tc *testTC = gHEAD_NODE_TCL;\
shreeshas95 2:2caf2a9a13aa 199 uint16_t overflowCount = 0;\
shreeshas95 15:1c1ca992b43b 200 returnHere = 0xFF;\
shreeshas95 2:2caf2a9a13aa 201 while( (overflowCount < TCL_OVERFLOW_CONSTANT) && (testTC != NULL) ){\
shreeshas95 2:2caf2a9a13aa 202 if( (GETpacket_seq_count(testTC) == PSC_CALLSIGN) && (GETapid(testTC) == APID_CALLSIGN) ){\
aniruddhv 37:c9a739750806 203 /*uint8_t temp8 = testTC->TC_string[1];*/\
aniruddhv 37:c9a739750806 204 if( true ){\
shreeshas95 2:2caf2a9a13aa 205 for( int i = 2 ; i <= 8 ; ++i ){\
shreeshas95 2:2caf2a9a13aa 206 if( testTC->TC_string[i] != gGSCODE[i-2] ){\
shreeshas95 2:2caf2a9a13aa 207 returnHere = 0;\
shreeshas95 2:2caf2a9a13aa 208 break;\
shreeshas95 2:2caf2a9a13aa 209 }\
shreeshas95 2:2caf2a9a13aa 210 }\
shreeshas95 2:2caf2a9a13aa 211 }\
shreeshas95 2:2caf2a9a13aa 212 break;\
shreeshas95 2:2caf2a9a13aa 213 }\
shreeshas95 2:2caf2a9a13aa 214 testTC = testTC->next_TC;\
shreeshas95 2:2caf2a9a13aa 215 ++overflowCount;\
shreeshas95 2:2caf2a9a13aa 216 }\
shreeshas95 2:2caf2a9a13aa 217 }
shreeshas95 2:2caf2a9a13aa 218
shreeshas95 2:2caf2a9a13aa 219 /*
shreeshas95 0:f016e9e8d48b 220 @brief: DELETE THE CRC FAILED TC FROM THE LIST TO FREE-UP MEMORY AND UPDATE
shreeshas95 0:f016e9e8d48b 221 THE TOTAL VALID TC AND GENERATE L1_ACK_TM
shreeshas95 0:f016e9e8d48b 222 @param: none
shreeshas95 0:f016e9e8d48b 223 @return: none
shreeshas95 0:f016e9e8d48b 224 */
shreeshas95 4:104dd82c99b8 225 /*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 */
shreeshas95 4:104dd82c99b8 226 #define get_ack_l1( tm_ptr ){\
shreeshas95 0:f016e9e8d48b 227 Base_tc *current_TC = gHEAD_NODE_TCL;\
shreeshas95 0:f016e9e8d48b 228 Base_tm *l1_ack = new Short_tm;\
shreeshas95 4:104dd82c99b8 229 /*APPEND TO THE tm_ptr HERE*/\
shreeshas95 4:104dd82c99b8 230 tm_ptr = l1_ack;\
shreeshas95 0:f016e9e8d48b 231 fill_l1_ack(l1_ack);\
shreeshas95 0:f016e9e8d48b 232 int TC_count = 0;\
shreeshas95 4:104dd82c99b8 233 int overflowCountL1 = 0;\
shreeshas95 0:f016e9e8d48b 234 while(current_TC != NULL){\
shreeshas95 4:104dd82c99b8 235 if( overflowCountL1 < TCL_OVERFLOW_CONSTANT ){\
shreeshas95 4:104dd82c99b8 236 /*IF CRC PASS*/\
shreeshas95 4:104dd82c99b8 237 if( (GETcrc_pass(current_TC) == 1) ){\
shreeshas95 4:104dd82c99b8 238 if(TC_count > 4){\
shreeshas95 5:ab276a17ca07 239 /*PENDING: FILL TC_EXEC_CODE, APPEND CRC TO THE TM*/\
shreeshas95 5:ab276a17ca07 240 put_crc_l1_ack( l1_ack );\
shreeshas95 4:104dd82c99b8 241 /*extend the TM linked list*/\
shreeshas95 4:104dd82c99b8 242 TC_count = 0;\
shreeshas95 4:104dd82c99b8 243 l1_ack->next_TM = new Short_tm;\
shreeshas95 4:104dd82c99b8 244 l1_ack = l1_ack->next_TM;\
shreeshas95 4:104dd82c99b8 245 fill_l1_ack(l1_ack);\
shreeshas95 4:104dd82c99b8 246 }\
shreeshas95 4:104dd82c99b8 247 /*PSC starts from 7th byte*/\
shreeshas95 4:104dd82c99b8 248 l1_ack->TM_string[6+TC_count] = GETpacket_seq_count(current_TC);\
shreeshas95 4:104dd82c99b8 249 /*TC exec status*/\
shreeshas95 4:104dd82c99b8 250 switch(TC_count){\
shreeshas95 4:104dd82c99b8 251 case 0:\
shreeshas95 4:104dd82c99b8 252 l1_ack->TM_string[3] = (GETexec_status(current_TC)) & 0x0F;\
shreeshas95 4:104dd82c99b8 253 break;\
shreeshas95 4:104dd82c99b8 254 case 1:\
shreeshas95 4:104dd82c99b8 255 l1_ack->TM_string[4] = (GETexec_status(current_TC) << 4) & 0xF0;\
shreeshas95 4:104dd82c99b8 256 break;\
shreeshas95 4:104dd82c99b8 257 case 2:\
shreeshas95 4:104dd82c99b8 258 l1_ack->TM_string[4] |= (GETexec_status(current_TC)) & 0x0F;\
shreeshas95 4:104dd82c99b8 259 break;\
shreeshas95 4:104dd82c99b8 260 case 3:\
shreeshas95 4:104dd82c99b8 261 l1_ack->TM_string[5] = (GETexec_status(current_TC) << 4) & 0xF0;\
shreeshas95 4:104dd82c99b8 262 break;\
shreeshas95 4:104dd82c99b8 263 case 4:\
shreeshas95 4:104dd82c99b8 264 l1_ack->TM_string[5] |= (GETexec_status(current_TC)) & 0x0F;\
shreeshas95 4:104dd82c99b8 265 }\
shreeshas95 4:104dd82c99b8 266 ++TC_count;\
shreeshas95 0:f016e9e8d48b 267 }\
shreeshas95 4:104dd82c99b8 268 current_TC = current_TC->next_TC;\
shreeshas95 4:104dd82c99b8 269 ++overflowCountL1;\
shreeshas95 4:104dd82c99b8 270 }\
shreeshas95 4:104dd82c99b8 271 else{\
shreeshas95 4:104dd82c99b8 272 /*PENDING: RESET CDMS*/\
shreeshas95 4:104dd82c99b8 273 break;\
shreeshas95 4:104dd82c99b8 274 }\
shreeshas95 4:104dd82c99b8 275 }\
shreeshas95 4:104dd82c99b8 276 /*FILL UP THE REMAINING FIELDS WITH 0x00 as PSC, AND 0xF as tc exec status*/\
shreeshas95 4:104dd82c99b8 277 if( (TC_count < 5) && (TC_count != 0) ){\
shreeshas95 4:104dd82c99b8 278 while(TC_count < 5){\
shreeshas95 4:104dd82c99b8 279 l1_ack->TM_string[6+TC_count] = 0x00;\
shreeshas95 0:f016e9e8d48b 280 switch(TC_count){\
shreeshas95 0:f016e9e8d48b 281 case 1:\
shreeshas95 4:104dd82c99b8 282 l1_ack->TM_string[4] = 0xF0;\
shreeshas95 0:f016e9e8d48b 283 break;\
shreeshas95 0:f016e9e8d48b 284 case 2:\
shreeshas95 4:104dd82c99b8 285 l1_ack->TM_string[4] |= 0x0F;\
shreeshas95 0:f016e9e8d48b 286 break;\
shreeshas95 0:f016e9e8d48b 287 case 3:\
shreeshas95 4:104dd82c99b8 288 l1_ack->TM_string[5] = 0xF0;\
shreeshas95 0:f016e9e8d48b 289 break;\
shreeshas95 0:f016e9e8d48b 290 case 4:\
shreeshas95 4:104dd82c99b8 291 l1_ack->TM_string[5] |= 0x0F;\
shreeshas95 0:f016e9e8d48b 292 }\
shreeshas95 0:f016e9e8d48b 293 ++TC_count;\
shreeshas95 0:f016e9e8d48b 294 }\
shreeshas95 0:f016e9e8d48b 295 }\
shreeshas95 5:ab276a17ca07 296 put_crc_l1_ack(l1_ack);\
shreeshas95 4:104dd82c99b8 297 }
shreeshas95 4:104dd82c99b8 298
shreeshas95 4:104dd82c99b8 299 /*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 */
shreeshas95 4:104dd82c99b8 300 #define get_tc_list(tm_ptr, thePSC){\
shreeshas95 5:ab276a17ca07 301 uint8_t TM_PSC = 0xFF;\
shreeshas95 4:104dd82c99b8 302 uint8_t TC_PSC = thePSC;\
shreeshas95 4:104dd82c99b8 303 int overflowCount = 0;\
shreeshas95 4:104dd82c99b8 304 uint8_t TC_LIST_TAG = 0x00;\
shreeshas95 4:104dd82c99b8 305 Base_tc *temp_tc = gHEAD_NODE_TCL;\
shreeshas95 4:104dd82c99b8 306 bool first_time = true;\
shreeshas95 5:ab276a17ca07 307 Base_tm *current_tm = NULL;\
shreeshas95 4:104dd82c99b8 308 while( temp_tc != NULL ){\
shreeshas95 4:104dd82c99b8 309 if( overflowCount < TCL_OVERFLOW_CONSTANT ){\
shreeshas95 4:104dd82c99b8 310 TM_PSC = TM_PSC + 1;\
shreeshas95 4:104dd82c99b8 311 /*Increment TM_PSC for every new TM pointer created*/\
shreeshas95 4:104dd82c99b8 312 Base_tm *temp_tm = new Long_tm;\
shreeshas95 4:104dd82c99b8 313 temp_tm->next_TM = NULL;\
shreeshas95 4:104dd82c99b8 314 uint8_t temp8 = LONG_TM_CODE;\
shreeshas95 4:104dd82c99b8 315 PUTshort_or_long_tm(temp_tm->fields, temp8);\
shreeshas95 4:104dd82c99b8 316 temp8 = TMID_TCL;\
shreeshas95 4:104dd82c99b8 317 PUTtmid((temp_tm->fields), temp8);\
shreeshas95 4:104dd82c99b8 318 temp_tm->TM_string[0] = 0x38;\
shreeshas95 4:104dd82c99b8 319 /*Frame type(1) = 0; TMID = 0111; Spare = 000*/\
shreeshas95 4:104dd82c99b8 320 temp_tm->TM_string[1] = TC_PSC;\
shreeshas95 4:104dd82c99b8 321 temp_tm->TM_string[3] = TM_PSC;\
shreeshas95 5:ab276a17ca07 322 int indexCustom = 4, num_of_short_tc = 0;\
shreeshas95 4:104dd82c99b8 323 while(temp_tc != NULL){\
shreeshas95 4:104dd82c99b8 324 if( overflowCount < TCL_OVERFLOW_CONSTANT ){\
shreeshas95 4:104dd82c99b8 325 if( GETshort_or_long_tc(temp_tc) == SHORT_TC_CODE ){\
shreeshas95 4:104dd82c99b8 326 for( int i = 0 ; i < TC_SHORT_SIZE ; ++i ){\
shreeshas95 5:ab276a17ca07 327 temp_tm->TM_string[indexCustom + i] = temp_tc->TC_string[i];\
shreeshas95 4:104dd82c99b8 328 }\
shreeshas95 5:ab276a17ca07 329 indexCustom = indexCustom + TC_SHORT_SIZE;\
shreeshas95 4:104dd82c99b8 330 ++overflowCount;\
shreeshas95 4:104dd82c99b8 331 /*INCREMENT STUFF*/\
shreeshas95 4:104dd82c99b8 332 temp_tc = temp_tc->next_TC;\
shreeshas95 4:104dd82c99b8 333 num_of_short_tc = num_of_short_tc + 1;\
shreeshas95 4:104dd82c99b8 334 if (temp_tc == NULL){\
shreeshas95 5:ab276a17ca07 335 for (int i = indexCustom ; i < TM_LONG_SIZE-2 ; ++i){\
shreeshas95 4:104dd82c99b8 336 temp_tm->TM_string[i] = 0;\
shreeshas95 4:104dd82c99b8 337 /*Fill remaining values with 0*/\
shreeshas95 4:104dd82c99b8 338 }\
shreeshas95 4:104dd82c99b8 339 TC_LIST_TAG = num_of_short_tc;\
shreeshas95 4:104dd82c99b8 340 break;\
shreeshas95 4:104dd82c99b8 341 }\
shreeshas95 4:104dd82c99b8 342 if( (GETshort_or_long_tc(temp_tc) == LONG_TC_CODE) || (num_of_short_tc == OBOSC_TCL_MAX_SHORT_SIZE) ){\
shreeshas95 4:104dd82c99b8 343 /*Next TC is long or memory is filled*/\
shreeshas95 5:ab276a17ca07 344 for(int i = indexCustom; i < TM_LONG_SIZE-2 ; ++i){\
shreeshas95 4:104dd82c99b8 345 temp_tm->TM_string[i] = 0;\
shreeshas95 4:104dd82c99b8 346 /*Fill remaining values with 0*/\
shreeshas95 4:104dd82c99b8 347 }\
shreeshas95 4:104dd82c99b8 348 TC_LIST_TAG = num_of_short_tc;\
shreeshas95 4:104dd82c99b8 349 break;\
shreeshas95 4:104dd82c99b8 350 }\
shreeshas95 4:104dd82c99b8 351 }\
shreeshas95 4:104dd82c99b8 352 else if (TC_LIST_TAG == OBOSC_TCL_TAG_LONG_FIRST_HALF){\
shreeshas95 4:104dd82c99b8 353 /*Long TC, 2nd half*/\
shreeshas95 4:104dd82c99b8 354 for (int i = 0; i < OBOSC_LONG_TC_SECOND_HALF_SIZE ; ++i){\
shreeshas95 5:ab276a17ca07 355 temp_tm->TM_string[indexCustom + i] = temp_tc->TC_string[OBOSC_LONG_TC_FIRST_HALF_SIZE + i];\
shreeshas95 4:104dd82c99b8 356 /*Fill the TM with TC_values*/\
shreeshas95 4:104dd82c99b8 357 }\
shreeshas95 5:ab276a17ca07 358 for (int i = OBOSC_LONG_TC_SECOND_HALF_SIZE + indexCustom ; i < TM_LONG_SIZE-2 ; ++i ){\
shreeshas95 4:104dd82c99b8 359 temp_tm->TM_string[i] = 0;\
shreeshas95 4:104dd82c99b8 360 /*Fill remaining values with 0*/\
shreeshas95 4:104dd82c99b8 361 }\
shreeshas95 4:104dd82c99b8 362 temp_tc = temp_tc->next_TC;\
shreeshas95 4:104dd82c99b8 363 TC_LIST_TAG = OBOSC_TCL_TAG_LONG_SECOND_HALF;\
shreeshas95 4:104dd82c99b8 364 ++overflowCount;\
shreeshas95 4:104dd82c99b8 365 break;\
shreeshas95 4:104dd82c99b8 366 }\
shreeshas95 4:104dd82c99b8 367 else{\
shreeshas95 4:104dd82c99b8 368 /*Long TC, 1st half */\
shreeshas95 4:104dd82c99b8 369 for (int i = 0; i < OBOSC_LONG_TC_FIRST_HALF_SIZE; ++i){\
shreeshas95 5:ab276a17ca07 370 /*gPC.printf("indexCustom = %d\r\n", indexCustom);*/\
shreeshas95 5:ab276a17ca07 371 temp_tm->TM_string[indexCustom + i] = temp_tc->TC_string[i];\
shreeshas95 4:104dd82c99b8 372 /*Fill the TM with TC_values*/\
shreeshas95 4:104dd82c99b8 373 }\
shreeshas95 5:ab276a17ca07 374 for (int i = OBOSC_LONG_TC_FIRST_HALF_SIZE + indexCustom ; i < TM_LONG_SIZE-2 ; ++i ){\
shreeshas95 5:ab276a17ca07 375 temp_tm->TM_string[i] = 0;\
shreeshas95 4:104dd82c99b8 376 /*Fill remaining values with 0*/\
shreeshas95 4:104dd82c99b8 377 }\
shreeshas95 4:104dd82c99b8 378 TC_LIST_TAG = OBOSC_TCL_TAG_LONG_FIRST_HALF;\
shreeshas95 4:104dd82c99b8 379 break;\
shreeshas95 4:104dd82c99b8 380 }\
shreeshas95 4:104dd82c99b8 381 }\
shreeshas95 4:104dd82c99b8 382 else{\
shreeshas95 4:104dd82c99b8 383 /*PENDING: reset cdms*/\
shreeshas95 0:f016e9e8d48b 384 break;\
shreeshas95 4:104dd82c99b8 385 }\
shreeshas95 0:f016e9e8d48b 386 }\
shreeshas95 4:104dd82c99b8 387 temp_tm->TM_string[2] = TC_LIST_TAG;\
shreeshas95 4:104dd82c99b8 388 /*TC_LIST_TAG as is updated in the inner while loop*/\
shreeshas95 4:104dd82c99b8 389 uint16_t crc16 = crc16_gen(temp_tm->TM_string, TM_LONG_SIZE-2);\
shreeshas95 4:104dd82c99b8 390 temp_tm->TM_string[TM_LONG_SIZE-2] = (crc16 & 0xFF00) >> 8 ;\
shreeshas95 4:104dd82c99b8 391 temp_tm->TM_string[TM_LONG_SIZE-1] = crc16 & 0x00FF;\
shreeshas95 4:104dd82c99b8 392 /*Attach this new node to the TM linked list*/\
shreeshas95 5:ab276a17ca07 393 if( first_time ){\
shreeshas95 5:ab276a17ca07 394 first_time = false;\
shreeshas95 5:ab276a17ca07 395 tm_ptr = temp_tm;\
shreeshas95 5:ab276a17ca07 396 current_tm = temp_tm;\
shreeshas95 5:ab276a17ca07 397 }\
shreeshas95 5:ab276a17ca07 398 else{\
shreeshas95 5:ab276a17ca07 399 current_tm->next_TM = temp_tm;\
shreeshas95 5:ab276a17ca07 400 current_tm = current_tm->next_TM;\
shreeshas95 5:ab276a17ca07 401 }\
shreeshas95 4:104dd82c99b8 402 /*Attach this new node at the end*/\
shreeshas95 0:f016e9e8d48b 403 }\
shreeshas95 4:104dd82c99b8 404 else{\
shreeshas95 4:104dd82c99b8 405 /*PENDING: reset CDMS*/\
shreeshas95 4:104dd82c99b8 406 break;\
shreeshas95 4:104dd82c99b8 407 }\
shreeshas95 0:f016e9e8d48b 408 }\
shreeshas95 0:f016e9e8d48b 409 }
shreeshas95 0:f016e9e8d48b 410
shreeshas95 0:f016e9e8d48b 411 // CDMS TEAM CODE START
aniruddhv 52:0bd68655c651 412 inline Base_tm* FCTN_CDMS_RLY_TMTC(Base_tc *tc_ptr){
aniruddhv 52:0bd68655c651 413 uint8_t ACKCODE = 0x00;
ee12b079 55:39e59903bc3a 414 //printf("\rTC execution in progress\r\n");
aniruddhv 52:0bd68655c651 415 Base_tm *tm_pointer = new Long_tm;
aniruddhv 52:0bd68655c651 416 Base_tm *tm_ptr = tm_pointer;
aniruddhv 52:0bd68655c651 417 received = 0;
aniruddhv 52:0bd68655c651 418 switch(GETapid(tc_ptr))
aniruddhv 52:0bd68655c651 419 {
aniruddhv 52:0bd68655c651 420 case 1: //apid=01 implies it corresponds to bae
aniruddhv 52:0bd68655c651 421 {
ee12b079 55:39e59903bc3a 422 //printf("Telecommand is for BAE\r\n");
ee12b079 55:39e59903bc3a 423 //printf("Sending TC to BAE...\r\n"); //interrupt to be sent to the bae
aniruddhv 52:0bd68655c651 424 FCTN_I2C_WRITE((char*)tc_ptr->TC_string);
aniruddhv 52:0bd68655c651 425 while(1)
aniruddhv 52:0bd68655c651 426 {
aniruddhv 52:0bd68655c651 427 wait(1); //TimeOut instead of wait
aniruddhv 52:0bd68655c651 428 if(tm_status_4m_slv == 1)
aniruddhv 52:0bd68655c651 429 {
ee12b079 55:39e59903bc3a 430 //printf("receiving...\r\n");
aniruddhv 52:0bd68655c651 431 FCTN_I2C_READ((char*)tm_pointer->TM_string);
aniruddhv 52:0bd68655c651 432 //printf("%s", tm_pointer->TM_string);
aniruddhv 52:0bd68655c651 433 received+=1;
aniruddhv 52:0bd68655c651 434 tm_pointer = tm_pointer->next_TM;
aniruddhv 52:0bd68655c651 435 break; //only for testing purpose
aniruddhv 52:0bd68655c651 436 }
aniruddhv 52:0bd68655c651 437 else
aniruddhv 52:0bd68655c651 438 {
aniruddhv 52:0bd68655c651 439 break;
aniruddhv 52:0bd68655c651 440 }
aniruddhv 52:0bd68655c651 441 }
aniruddhv 52:0bd68655c651 442 if(received >= 1 )
aniruddhv 52:0bd68655c651 443 {
ee12b079 55:39e59903bc3a 444 //printf("Telemetry is received from BAE\r\n");
aniruddhv 52:0bd68655c651 445 Base_tm *tm_print = tm_ptr;
aniruddhv 52:0bd68655c651 446 for(uint8_t i=0;i<received;i++)
aniruddhv 52:0bd68655c651 447 {
ee12b079 55:39e59903bc3a 448 //printf("%s", tm_print->TM_string);
aniruddhv 52:0bd68655c651 449 tm_print = tm_print->next_TM; //for check
aniruddhv 52:0bd68655c651 450 }
aniruddhv 52:0bd68655c651 451 received = 0;
ee12b079 53:18db568f1098 452 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 453 }
aniruddhv 52:0bd68655c651 454 else
aniruddhv 52:0bd68655c651 455 {
ee12b079 55:39e59903bc3a 456 //printf("Telemetry is not received from BAE\r\n");
aniruddhv 52:0bd68655c651 457 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 458 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 459 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 460 tm_pointer->TM_string[2] = 0x01;
aniruddhv 52:0bd68655c651 461 tm_pointer->TM_string[3] = ACKCODE; //ackcode to be decided
aniruddhv 52:0bd68655c651 462 tm_pointer->TM_string[4] = 0x01;
aniruddhv 52:0bd68655c651 463 for(uint8_t i=0;i<6;i++)
aniruddhv 52:0bd68655c651 464 {
aniruddhv 52:0bd68655c651 465 tm_pointer->TM_string[i+5] = 0;
aniruddhv 52:0bd68655c651 466 }
aniruddhv 52:0bd68655c651 467 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 468 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 469 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 470 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 471 }
aniruddhv 52:0bd68655c651 472 break;
aniruddhv 52:0bd68655c651 473 }
aniruddhv 52:0bd68655c651 474 case 2:
aniruddhv 52:0bd68655c651 475 {
ee12b079 55:39e59903bc3a 476 //printf("Telecommand is for CDMS\r\n"); //apid = 10 corresponds to cdms
aniruddhv 52:0bd68655c651 477 switch(GETservice_type(tc_ptr))
aniruddhv 52:0bd68655c651 478 {
aniruddhv 52:0bd68655c651 479 case 0x60:
aniruddhv 52:0bd68655c651 480 {
ee12b079 55:39e59903bc3a 481 //printf("service:MMS\r\n");
aniruddhv 52:0bd68655c651 482 switch(GETservice_subtype(tc_ptr))
aniruddhv 52:0bd68655c651 483 {
aniruddhv 52:0bd68655c651 484 case 0x1:
aniruddhv 52:0bd68655c651 485 {
ee12b079 55:39e59903bc3a 486 //printf("sub_service:Read from RAM_Memory\r\n");
aniruddhv 52:0bd68655c651 487 mid=(uint16_t)(tc_ptr->TC_string[3]<<4)+(uint16_t)(tc_ptr->TC_string[4]);
aniruddhv 52:0bd68655c651 488
aniruddhv 52:0bd68655c651 489 Data[0] = FCTN_CDMS_RD_FLASH(0);
aniruddhv 52:0bd68655c651 490 Data[1] = FCTN_CDMS_RD_FLASH(1);
aniruddhv 52:0bd68655c651 491 //tm_pointer = new Long_tm;
aniruddhv 52:0bd68655c651 492 tm_pointer->TM_string[0] = 0x30;
aniruddhv 52:0bd68655c651 493 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 494 tm_pointer->TM_string[2] = (uint8_t)(flash_counter);
aniruddhv 52:0bd68655c651 495 for(uint8_t i=0;i<4;i++)
aniruddhv 52:0bd68655c651 496 {
aniruddhv 52:0bd68655c651 497 tm_pointer->TM_string[3+i] = (uint8_t)((Data[0]>>(8*i))&0x00FF);
aniruddhv 52:0bd68655c651 498 }
aniruddhv 52:0bd68655c651 499 for(uint8_t i=4;i<8;i++)
aniruddhv 52:0bd68655c651 500 {
aniruddhv 52:0bd68655c651 501 tm_pointer->TM_string[3+i] = (uint8_t)((Data[1]>>(8*i))&0x00FF);
aniruddhv 52:0bd68655c651 502 }
aniruddhv 52:0bd68655c651 503 crc16 = crc16_gen(tm_ptr->TM_string,9);
aniruddhv 52:0bd68655c651 504 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 505 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 506 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 507 }
aniruddhv 52:0bd68655c651 508 case 0x2:
aniruddhv 52:0bd68655c651 509 {
ee12b079 55:39e59903bc3a 510 //printf("sub_service:Read from Flash_Memory\r\n");
aniruddhv 52:0bd68655c651 511 mid=(uint16_t)(tc_ptr->TC_string[3]<<4)+(uint16_t)(tc_ptr->TC_string[4]);
aniruddhv 52:0bd68655c651 512
aniruddhv 52:0bd68655c651 513 Data[0] = FCTN_CDMS_RD_FLASH(0);
aniruddhv 52:0bd68655c651 514 Data[1] = FCTN_CDMS_RD_FLASH(1);
aniruddhv 52:0bd68655c651 515 //tm_pointer = new Long_tm;
aniruddhv 52:0bd68655c651 516 tm_pointer->TM_string[0] = 0x30;
aniruddhv 52:0bd68655c651 517 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 518 tm_pointer->TM_string[2] = (uint8_t)(flash_counter);
aniruddhv 52:0bd68655c651 519 for(uint8_t i=0;i<4;i++)
aniruddhv 52:0bd68655c651 520 {
aniruddhv 52:0bd68655c651 521 tm_pointer->TM_string[3+i] = (uint8_t)((Data[0]>>(8*i))&0x00FF);
aniruddhv 52:0bd68655c651 522 }
aniruddhv 52:0bd68655c651 523 for(uint8_t i=4;i<8;i++)
aniruddhv 52:0bd68655c651 524 {
aniruddhv 52:0bd68655c651 525 tm_pointer->TM_string[3+i] = (uint8_t)((Data[1]>>(8*i))&0x00FF);
aniruddhv 52:0bd68655c651 526 }
aniruddhv 52:0bd68655c651 527 crc16 = crc16_gen(tm_ptr->TM_string,9);
aniruddhv 52:0bd68655c651 528 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 529 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 530 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 531 }
aniruddhv 52:0bd68655c651 532 case 0x5:
aniruddhv 52:0bd68655c651 533 {
ee12b079 55:39e59903bc3a 534 //printf("WRITE ON FLASH_MEMORY\r\n");
aniruddhv 52:0bd68655c651 535 mid=(uint16_t)(tc_ptr->TC_string[3]<<4)+(uint16_t)(tc_ptr->TC_string[4]);
aniruddhv 52:0bd68655c651 536 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])));
aniruddhv 52:0bd68655c651 537 FCTN_CDMS_WR_FLASH(mid,block);
aniruddhv 52:0bd68655c651 538 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 539 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 540 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 541 tm_pointer->TM_string[2] = 0x01;
aniruddhv 52:0bd68655c651 542 tm_pointer->TM_string[3] = ACKCODE; //ackcode to be decided
aniruddhv 52:0bd68655c651 543 tm_pointer->TM_string[4] = 0x01;
aniruddhv 52:0bd68655c651 544 for(uint8_t i=0;i<6;i++)
aniruddhv 52:0bd68655c651 545 {
aniruddhv 52:0bd68655c651 546 tm_pointer->TM_string[i+5] = 0;
aniruddhv 52:0bd68655c651 547 }
aniruddhv 52:0bd68655c651 548 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 549 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 550 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 551 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 552 break;
aniruddhv 52:0bd68655c651 553 }
aniruddhv 52:0bd68655c651 554 default:
aniruddhv 52:0bd68655c651 555 {
ee12b079 55:39e59903bc3a 556 //printf("INVALID TC\r\n"); //Send Invalid TC Telemetry
aniruddhv 52:0bd68655c651 557 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 558 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 559 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 560 tm_pointer->TM_string[2] = 0x01;
aniruddhv 52:0bd68655c651 561 tm_pointer->TM_string[3] = ACKCODE; //ackcode to be decided
aniruddhv 52:0bd68655c651 562 tm_pointer->TM_string[4] = 0x01;
aniruddhv 52:0bd68655c651 563 for(uint8_t i=0;i<6;i++)
aniruddhv 52:0bd68655c651 564 {
aniruddhv 52:0bd68655c651 565 tm_pointer->TM_string[i+5] = 0;
aniruddhv 52:0bd68655c651 566 }
aniruddhv 52:0bd68655c651 567 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 568 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 569 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 570 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 571 }
aniruddhv 52:0bd68655c651 572 break;
aniruddhv 52:0bd68655c651 573 }
aniruddhv 52:0bd68655c651 574 }
aniruddhv 52:0bd68655c651 575 case 0x8:
aniruddhv 52:0bd68655c651 576 {
ee12b079 55:39e59903bc3a 577 //printf("service:FUNCTION MANAGEMENT SERVICE\r\n");
aniruddhv 52:0bd68655c651 578 if(GETservice_subtype(tc_ptr)==0x1)
aniruddhv 52:0bd68655c651 579 {
aniruddhv 52:0bd68655c651 580 if(GETpid(tc_ptr)==0x01)
aniruddhv 52:0bd68655c651 581 {
ee12b079 55:39e59903bc3a 582 //printf("TC_PL_INIT\r\n"); // call PWR_SWCH_ON function
aniruddhv 52:0bd68655c651 583 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 584 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 585 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 586 tm_pointer->TM_string[2] = ACKCODE;
aniruddhv 52:0bd68655c651 587 for(uint8_t i=3;i<11;i++)
aniruddhv 52:0bd68655c651 588 {
aniruddhv 52:0bd68655c651 589 tm_pointer->TM_string[i] = 0;
aniruddhv 52:0bd68655c651 590 }
aniruddhv 52:0bd68655c651 591 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 592 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 593 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 594 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 595 break;
aniruddhv 52:0bd68655c651 596 }
aniruddhv 52:0bd68655c651 597 else if(GETpid(tc_ptr)==0x02)
aniruddhv 52:0bd68655c651 598 {
ee12b079 55:39e59903bc3a 599 //printf("TC_PL_MAIN\r\n"); // call PWR_SWCH_ON function
aniruddhv 52:0bd68655c651 600 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 601 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 602 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 603 tm_pointer->TM_string[2] = ACKCODE;
aniruddhv 52:0bd68655c651 604 for(uint8_t i=3;i<11;i++)
aniruddhv 52:0bd68655c651 605 {
aniruddhv 52:0bd68655c651 606 tm_pointer->TM_string[i] = 0;
aniruddhv 52:0bd68655c651 607 }
aniruddhv 52:0bd68655c651 608 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 609 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 610 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 611 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 612 break;
aniruddhv 52:0bd68655c651 613 }
aniruddhv 52:0bd68655c651 614 else if(GETpid(tc_ptr)==0x03)
aniruddhv 52:0bd68655c651 615 {
ee12b079 55:39e59903bc3a 616 //printf("TC_COM_INIT\r\n"); // call PWR_SWCH_ON function
aniruddhv 52:0bd68655c651 617 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 618 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 619 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 620 tm_pointer->TM_string[2] = ACKCODE;
aniruddhv 52:0bd68655c651 621 for(uint8_t i=3;i<11;i++)
aniruddhv 52:0bd68655c651 622 {
aniruddhv 52:0bd68655c651 623 tm_pointer->TM_string[i] = 0;
aniruddhv 52:0bd68655c651 624 }
aniruddhv 52:0bd68655c651 625 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 626 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 627 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 628 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 629 break;
aniruddhv 52:0bd68655c651 630 }
aniruddhv 52:0bd68655c651 631 else if(GETpid(tc_ptr)==0x04)
aniruddhv 52:0bd68655c651 632 {
ee12b079 55:39e59903bc3a 633 //printf("TC_CDMS_HK_MAIN\r\n"); // call PWR_SWCH_ON function
aniruddhv 52:0bd68655c651 634 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 635 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 636 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 637 tm_pointer->TM_string[2] = ACKCODE;
aniruddhv 52:0bd68655c651 638 for(uint8_t i=3;i<11;i++)
aniruddhv 52:0bd68655c651 639 {
aniruddhv 52:0bd68655c651 640 tm_pointer->TM_string[i] = 0;
aniruddhv 52:0bd68655c651 641 }
aniruddhv 52:0bd68655c651 642 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 643 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 644 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 645 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 646 break;
aniruddhv 52:0bd68655c651 647 }
aniruddhv 52:0bd68655c651 648 else if(GETpid(tc_ptr)==0x11)
aniruddhv 52:0bd68655c651 649 {
ee12b079 55:39e59903bc3a 650 //printf("TC_SW_ON_SD\r\n"); // call PWR_SWCH_ON function
aniruddhv 52:0bd68655c651 651 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 652 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 653 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 654 tm_pointer->TM_string[2] = ACKCODE;
aniruddhv 52:0bd68655c651 655 for(uint8_t i=3;i<11;i++)
aniruddhv 52:0bd68655c651 656 {
aniruddhv 52:0bd68655c651 657 tm_pointer->TM_string[i] = 0;
aniruddhv 52:0bd68655c651 658 }
aniruddhv 52:0bd68655c651 659 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 660 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 661 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 662 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 663 break;
aniruddhv 52:0bd68655c651 664 }
aniruddhv 52:0bd68655c651 665 else if(GETpid(tc_ptr)==0x12)
aniruddhv 52:0bd68655c651 666 {
ee12b079 55:39e59903bc3a 667 //printf("TC_SW_ON_RTC\r\n"); // call PWR_SWCH_ON function
aniruddhv 52:0bd68655c651 668 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 669 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 670 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 671 tm_pointer->TM_string[2] = ACKCODE;
aniruddhv 52:0bd68655c651 672 for(uint8_t i=3;i<11;i++)
aniruddhv 52:0bd68655c651 673 {
aniruddhv 52:0bd68655c651 674 tm_pointer->TM_string[i] = 0;
aniruddhv 52:0bd68655c651 675 }
aniruddhv 52:0bd68655c651 676 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 677 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 678 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 679 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 680 break;
aniruddhv 52:0bd68655c651 681 }
aniruddhv 52:0bd68655c651 682 else if(GETpid(tc_ptr)==0x13)
aniruddhv 52:0bd68655c651 683 {
ee12b079 55:39e59903bc3a 684 //printf("TC_SW_ON_BAE\r\n"); // call PWR_SWCH_ON function
aniruddhv 52:0bd68655c651 685 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 686 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 687 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 688 tm_pointer->TM_string[2] = ACKCODE;
aniruddhv 52:0bd68655c651 689 for(uint8_t i=3;i<11;i++)
aniruddhv 52:0bd68655c651 690 {
aniruddhv 52:0bd68655c651 691 tm_pointer->TM_string[i] = 0;
aniruddhv 52:0bd68655c651 692 }
aniruddhv 52:0bd68655c651 693 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 694 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 695 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 696 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 697 break;
aniruddhv 52:0bd68655c651 698 }
aniruddhv 52:0bd68655c651 699 else if(GETpid(tc_ptr)==0x14)
aniruddhv 52:0bd68655c651 700 {
ee12b079 55:39e59903bc3a 701 //printf("TC_SW_ON_PL_DL\r\n"); // call PWR_SWCH_ON function
aniruddhv 52:0bd68655c651 702 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 703 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 704 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 705 tm_pointer->TM_string[2] = ACKCODE;
aniruddhv 52:0bd68655c651 706 for(uint8_t i=3;i<11;i++)
aniruddhv 52:0bd68655c651 707 {
aniruddhv 52:0bd68655c651 708 tm_pointer->TM_string[i] = 0;
aniruddhv 52:0bd68655c651 709 }
aniruddhv 52:0bd68655c651 710 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 711 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 712 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 713 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 714 break;
aniruddhv 52:0bd68655c651 715 }
aniruddhv 52:0bd68655c651 716 else if(GETpid(tc_ptr)==0x15)
aniruddhv 52:0bd68655c651 717 {
ee12b079 55:39e59903bc3a 718 //printf("TC_SW_ON_PL_AG_HV\r\n"); // call PWR_SWCH_ON function
aniruddhv 52:0bd68655c651 719 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 720 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 721 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 722 tm_pointer->TM_string[2] = ACKCODE;
aniruddhv 52:0bd68655c651 723 for(uint8_t i=3;i<11;i++)
aniruddhv 52:0bd68655c651 724 {
aniruddhv 52:0bd68655c651 725 tm_pointer->TM_string[i] = 0;
aniruddhv 52:0bd68655c651 726 }
aniruddhv 52:0bd68655c651 727 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 728 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 729 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 730 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 731 break;
aniruddhv 52:0bd68655c651 732 }
aniruddhv 52:0bd68655c651 733 else if(GETpid(tc_ptr)==0x16)
aniruddhv 52:0bd68655c651 734 {
ee12b079 55:39e59903bc3a 735 //printf("TC_SW_ON_V_A_EN\r\n"); // call PWR_SWCH_ON function
aniruddhv 52:0bd68655c651 736 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 737 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 738 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 739 tm_pointer->TM_string[2] = ACKCODE;
aniruddhv 52:0bd68655c651 740 for(uint8_t i=3;i<11;i++)
aniruddhv 52:0bd68655c651 741 {
aniruddhv 52:0bd68655c651 742 tm_pointer->TM_string[i] = 0;
aniruddhv 52:0bd68655c651 743 }
aniruddhv 52:0bd68655c651 744 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 745 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 746 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 747 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 748 break;
aniruddhv 52:0bd68655c651 749 }
aniruddhv 52:0bd68655c651 750 else if(GETpid(tc_ptr)==0x21)
aniruddhv 52:0bd68655c651 751 {
ee12b079 55:39e59903bc3a 752 //printf("TC_SW_OFF_SD\r\n"); // call PWR_SWCH_ON function
aniruddhv 52:0bd68655c651 753 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 754 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 755 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 756 tm_pointer->TM_string[2] = ACKCODE;
aniruddhv 52:0bd68655c651 757 for(uint8_t i=3;i<11;i++)
aniruddhv 52:0bd68655c651 758 {
aniruddhv 52:0bd68655c651 759 tm_pointer->TM_string[i] = 0;
aniruddhv 52:0bd68655c651 760 }
aniruddhv 52:0bd68655c651 761 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 762 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 763 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 764 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 765 break;
aniruddhv 52:0bd68655c651 766 }
aniruddhv 52:0bd68655c651 767 else if(GETpid(tc_ptr)==0x22)
aniruddhv 52:0bd68655c651 768 {
ee12b079 55:39e59903bc3a 769 //printf("TC_SW_OFF_RTC\r\n"); // call PWR_SWCH_ON function
aniruddhv 52:0bd68655c651 770 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 771 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 772 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 773 tm_pointer->TM_string[2] = ACKCODE;
aniruddhv 52:0bd68655c651 774 for(uint8_t i=3;i<11;i++)
aniruddhv 52:0bd68655c651 775 {
aniruddhv 52:0bd68655c651 776 tm_pointer->TM_string[i] = 0;
aniruddhv 52:0bd68655c651 777 }
aniruddhv 52:0bd68655c651 778 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 779 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 780 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 781 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 782 break;
aniruddhv 52:0bd68655c651 783 }
aniruddhv 52:0bd68655c651 784 else if(GETpid(tc_ptr)==0x23)
aniruddhv 52:0bd68655c651 785 {
ee12b079 55:39e59903bc3a 786 //printf("TC_SW_OFF_BAE\r\n"); // call PWR_SWCH_ON function
aniruddhv 52:0bd68655c651 787 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 788 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 789 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 790 tm_pointer->TM_string[2] = ACKCODE;
aniruddhv 52:0bd68655c651 791 for(uint8_t i=3;i<11;i++)
aniruddhv 52:0bd68655c651 792 {
aniruddhv 52:0bd68655c651 793 tm_pointer->TM_string[i] = 0;
aniruddhv 52:0bd68655c651 794 }
aniruddhv 52:0bd68655c651 795 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 796 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 797 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 798 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 799 break;
aniruddhv 52:0bd68655c651 800 }
aniruddhv 52:0bd68655c651 801 else if(GETpid(tc_ptr)==0x24)
aniruddhv 52:0bd68655c651 802 {
ee12b079 55:39e59903bc3a 803 //printf("TC_SW_OFF_PL_DL\r\n"); // call PWR_SWCH_ON function
aniruddhv 52:0bd68655c651 804 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 805 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 806 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 807 tm_pointer->TM_string[2] = ACKCODE;
aniruddhv 52:0bd68655c651 808 for(uint8_t i=3;i<11;i++)
aniruddhv 52:0bd68655c651 809 {
aniruddhv 52:0bd68655c651 810 tm_pointer->TM_string[i] = 0;
aniruddhv 52:0bd68655c651 811 }
aniruddhv 52:0bd68655c651 812 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 813 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 814 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 815 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 816 break;
aniruddhv 52:0bd68655c651 817 }
aniruddhv 52:0bd68655c651 818 else if(GETpid(tc_ptr)==0x25)
aniruddhv 52:0bd68655c651 819 {
ee12b079 55:39e59903bc3a 820 //printf("TC_SW_OFF_PL_AG_HV\r\n"); // call PWR_SWCH_ON function
aniruddhv 52:0bd68655c651 821 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 822 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 823 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 824 tm_pointer->TM_string[2] = ACKCODE;
aniruddhv 52:0bd68655c651 825 for(uint8_t i=3;i<11;i++)
aniruddhv 52:0bd68655c651 826 {
aniruddhv 52:0bd68655c651 827 tm_pointer->TM_string[i] = 0;
aniruddhv 52:0bd68655c651 828 }
aniruddhv 52:0bd68655c651 829 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 830 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 831 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 832 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 833 break;
aniruddhv 52:0bd68655c651 834 }
aniruddhv 52:0bd68655c651 835 else if(GETpid(tc_ptr)==0x26)
aniruddhv 52:0bd68655c651 836 {
ee12b079 55:39e59903bc3a 837 //printf("TC_SW_OFF_V_A_EN\r\n"); // call PWR_SWCH_ON function
aniruddhv 52:0bd68655c651 838 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 839 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 840 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 841 tm_pointer->TM_string[2] = ACKCODE;
aniruddhv 52:0bd68655c651 842 for(uint8_t i=3;i<11;i++)
aniruddhv 52:0bd68655c651 843 {
aniruddhv 52:0bd68655c651 844 tm_pointer->TM_string[i] = 0;
aniruddhv 52:0bd68655c651 845 }
aniruddhv 52:0bd68655c651 846 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 847 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 848 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 849 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 850 break;
aniruddhv 52:0bd68655c651 851 }
aniruddhv 52:0bd68655c651 852 else if(GETpid(tc_ptr)==0x31)
aniruddhv 52:0bd68655c651 853 {
ee12b079 55:39e59903bc3a 854 //printf("TC_RST_SD\r\n"); // call PWR_SWCH_ON function
aniruddhv 52:0bd68655c651 855 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 856 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 857 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 858 tm_pointer->TM_string[2] = ACKCODE;
aniruddhv 52:0bd68655c651 859 for(uint8_t i=3;i<11;i++)
aniruddhv 52:0bd68655c651 860 {
aniruddhv 52:0bd68655c651 861 tm_pointer->TM_string[i] = 0;
aniruddhv 52:0bd68655c651 862 }
aniruddhv 52:0bd68655c651 863 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 864 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 865 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 866 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 867 break;
aniruddhv 52:0bd68655c651 868 }
aniruddhv 52:0bd68655c651 869 else if(GETpid(tc_ptr)==0x32)
aniruddhv 52:0bd68655c651 870 {
ee12b079 55:39e59903bc3a 871 //printf("TC_RST_RTC\r\n"); // call PWR_SWCH_ON function
aniruddhv 52:0bd68655c651 872 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 873 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 874 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 875 tm_pointer->TM_string[2] = ACKCODE;
aniruddhv 52:0bd68655c651 876 for(uint8_t i=3;i<11;i++)
aniruddhv 52:0bd68655c651 877 {
aniruddhv 52:0bd68655c651 878 tm_pointer->TM_string[i] = 0;
aniruddhv 52:0bd68655c651 879 }
aniruddhv 52:0bd68655c651 880 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 881 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 882 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 883 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 884 break;
aniruddhv 52:0bd68655c651 885 }
aniruddhv 52:0bd68655c651 886 else if(GETpid(tc_ptr)==0x33)
aniruddhv 52:0bd68655c651 887 {
ee12b079 55:39e59903bc3a 888 //printf("TC_RST_BAE\r\n"); // call PWR_SWCH_ON function
aniruddhv 52:0bd68655c651 889 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 890 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 891 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 892 tm_pointer->TM_string[2] = ACKCODE;
aniruddhv 52:0bd68655c651 893 for(uint8_t i=3;i<11;i++)
aniruddhv 52:0bd68655c651 894 {
aniruddhv 52:0bd68655c651 895 tm_pointer->TM_string[i] = 0;
aniruddhv 52:0bd68655c651 896 }
aniruddhv 52:0bd68655c651 897 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 898 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 899 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 900 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 901 break;
aniruddhv 52:0bd68655c651 902 }
aniruddhv 52:0bd68655c651 903 else if(GETpid(tc_ptr)==0x34)
aniruddhv 52:0bd68655c651 904 {
ee12b079 55:39e59903bc3a 905 //printf("TC_RST_PL_DL\r\n"); // call PWR_SWCH_ON function
aniruddhv 52:0bd68655c651 906 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 907 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 908 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 909 tm_pointer->TM_string[2] = ACKCODE;
aniruddhv 52:0bd68655c651 910 for(uint8_t i=3;i<11;i++)
aniruddhv 52:0bd68655c651 911 {
aniruddhv 52:0bd68655c651 912 tm_pointer->TM_string[i] = 0;
aniruddhv 52:0bd68655c651 913 }
aniruddhv 52:0bd68655c651 914 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 915 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 916 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 917 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 918 break;
aniruddhv 52:0bd68655c651 919 break;
aniruddhv 52:0bd68655c651 920 }
aniruddhv 52:0bd68655c651 921 else if(GETpid(tc_ptr)==0xC1)
aniruddhv 52:0bd68655c651 922 {
ee12b079 55:39e59903bc3a 923 //printf("RESET_HK_COUNTER\r\n"); // call PWR_SWCH_ON function
aniruddhv 52:0bd68655c651 924 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 925 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 926 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 927 tm_pointer->TM_string[2] = ACKCODE;
aniruddhv 52:0bd68655c651 928 for(uint8_t i=3;i<11;i++)
aniruddhv 52:0bd68655c651 929 {
aniruddhv 52:0bd68655c651 930 tm_pointer->TM_string[i] = 0;
aniruddhv 52:0bd68655c651 931 }
aniruddhv 52:0bd68655c651 932 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 933 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 934 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 935 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 936 break;
aniruddhv 52:0bd68655c651 937 }
aniruddhv 52:0bd68655c651 938 else if(GETpid(tc_ptr)==0xF1)
aniruddhv 52:0bd68655c651 939 {
ee12b079 55:39e59903bc3a 940 //printf("RD_RTC\r\n"); //call RD_RTC
aniruddhv 52:0bd68655c651 941 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 942 tm_pointer->TM_string[0] = 0xD0;
aniruddhv 52:0bd68655c651 943 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 944 tm_pointer->TM_string[2] = 0x01;
aniruddhv 52:0bd68655c651 945 uint64_t time = FCTN_CDMS_RD_RTC();
aniruddhv 52:0bd68655c651 946 tm_pointer->TM_string[3] = (uint8_t)((time&0xFF00000000000000)>>56);
aniruddhv 52:0bd68655c651 947 tm_pointer->TM_string[4] = (uint8_t)((time&0x00FF000000000000)>>48);
aniruddhv 52:0bd68655c651 948 tm_pointer->TM_string[5] = (uint8_t)((time&0x0000FF0000000000)>>40);
aniruddhv 52:0bd68655c651 949 tm_pointer->TM_string[6] = (uint8_t)((time&0x000000FF00000000)>>32);
aniruddhv 52:0bd68655c651 950 tm_pointer->TM_string[7] = (uint8_t)((time&0x00000000FF000000)>>24);
aniruddhv 52:0bd68655c651 951 tm_pointer->TM_string[8] = (uint8_t)((time&0x0000000000FF0000)>>16);
aniruddhv 52:0bd68655c651 952 tm_pointer->TM_string[9] = (uint8_t)((time&0x000000000000FF00)>>8);
aniruddhv 52:0bd68655c651 953 tm_pointer->TM_string[10] = (uint8_t)(time&0x00000000000000FF);
aniruddhv 52:0bd68655c651 954 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 955 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 956 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 957 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 958 }
aniruddhv 52:0bd68655c651 959 else
aniruddhv 52:0bd68655c651 960 {
ee12b079 55:39e59903bc3a 961 //printf("INVALID TC\r\n");
aniruddhv 52:0bd68655c651 962 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 963 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 964 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 965 tm_pointer->TM_string[2] = 0x01;
aniruddhv 52:0bd68655c651 966 tm_pointer->TM_string[3] = ACKCODE; //ackcode to be decided
aniruddhv 52:0bd68655c651 967 tm_pointer->TM_string[4] = 0x01;
aniruddhv 52:0bd68655c651 968 for(uint8_t i=0;i<6;i++)
aniruddhv 52:0bd68655c651 969 {
aniruddhv 52:0bd68655c651 970 tm_pointer->TM_string[i+5] = 0;
aniruddhv 52:0bd68655c651 971 }
aniruddhv 52:0bd68655c651 972 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 973 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 974 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 975 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 976 }
aniruddhv 52:0bd68655c651 977 }
aniruddhv 52:0bd68655c651 978
aniruddhv 52:0bd68655c651 979
aniruddhv 52:0bd68655c651 980 }
aniruddhv 52:0bd68655c651 981 default:
aniruddhv 52:0bd68655c651 982 {
ee12b079 55:39e59903bc3a 983 //printf("INVALID TC"); //send invalid TC TM
aniruddhv 52:0bd68655c651 984 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 985 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 986 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 987 tm_pointer->TM_string[2] = 0x01;
aniruddhv 52:0bd68655c651 988 tm_pointer->TM_string[3] = ACKCODE; //ackcode to be decided
aniruddhv 52:0bd68655c651 989 tm_pointer->TM_string[4] = 0x01;
aniruddhv 52:0bd68655c651 990 for(uint8_t i=0;i<6;i++)
aniruddhv 52:0bd68655c651 991 {
aniruddhv 52:0bd68655c651 992 tm_pointer->TM_string[i+5] = 0;
aniruddhv 52:0bd68655c651 993 }
aniruddhv 52:0bd68655c651 994 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 995 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 996 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 997 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 998 break;
aniruddhv 52:0bd68655c651 999 }
aniruddhv 52:0bd68655c651 1000 }
aniruddhv 52:0bd68655c651 1001 }
aniruddhv 52:0bd68655c651 1002 case 3:
aniruddhv 52:0bd68655c651 1003 {
ee12b079 55:39e59903bc3a 1004 //printf("Telecommand is for PL\r\n");
aniruddhv 52:0bd68655c651 1005 // printf("Informing PL about TC using I2C\r\n"); //interrupt to be sent to the bae
aniruddhv 52:0bd68655c651 1006 // FCTN_I2C_WRITE((char*)tc_ptr->TC_string);
aniruddhv 52:0bd68655c651 1007 // printf("sent the Telecommand to BAE\r\n"); //packet along with crc will be sent when bae is ready
aniruddhv 52:0bd68655c651 1008 // wait(1); //wait time is to be optimised
aniruddhv 52:0bd68655c651 1009 // if(tm_status_4m_slv == 1)
aniruddhv 52:0bd68655c651 1010 // {
aniruddhv 52:0bd68655c651 1011 // FCTN_I2C_READ((char*)tm_ptr->TM_string);
aniruddhv 52:0bd68655c651 1012 // received = 1;
aniruddhv 52:0bd68655c651 1013 // }
aniruddhv 52:0bd68655c651 1014 // if(received == 1 )
aniruddhv 52:0bd68655c651 1015 // {
aniruddhv 52:0bd68655c651 1016 // printf("Telemetry is received from BAE\r\n");
aniruddhv 52:0bd68655c651 1017 // printf("%s", tm_ptr->TM_string);
aniruddhv 52:0bd68655c651 1018 // received = 0;
aniruddhv 52:0bd68655c651 1019 // } // similar to BAE functions
aniruddhv 52:0bd68655c651 1020 break;
aniruddhv 52:0bd68655c651 1021 }
aniruddhv 52:0bd68655c651 1022 default: //invalid TC
aniruddhv 52:0bd68655c651 1023 {
ee12b079 55:39e59903bc3a 1024 //printf("INVALID TC\r\n");
aniruddhv 52:0bd68655c651 1025 //tm_pointer = new Short_tm;
aniruddhv 52:0bd68655c651 1026 tm_pointer->TM_string[0] = 0xB0;
aniruddhv 52:0bd68655c651 1027 tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
aniruddhv 52:0bd68655c651 1028 tm_pointer->TM_string[2] = 0x01;
aniruddhv 52:0bd68655c651 1029 tm_pointer->TM_string[3] = ACKCODE; //ackcode to be decided
aniruddhv 52:0bd68655c651 1030 tm_pointer->TM_string[4] = 0x01;
aniruddhv 52:0bd68655c651 1031 for(uint8_t i=0;i<6;i++)
aniruddhv 52:0bd68655c651 1032 {
aniruddhv 52:0bd68655c651 1033 tm_pointer->TM_string[i+5] = 0;
aniruddhv 52:0bd68655c651 1034 }
aniruddhv 52:0bd68655c651 1035 crc16 = crc16_gen(tm_ptr->TM_string,11);
aniruddhv 52:0bd68655c651 1036 tm_pointer->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
aniruddhv 52:0bd68655c651 1037 tm_pointer->TM_string[12] = (uint8_t)(crc16&0x00FF);
ee12b079 53:18db568f1098 1038 tm_pointer->next_TM = NULL; return tm_ptr;
aniruddhv 52:0bd68655c651 1039 break;
aniruddhv 52:0bd68655c651 1040 }
aniruddhv 52:0bd68655c651 1041 }
aniruddhv 52:0bd68655c651 1042 }
shreeshas95 0:f016e9e8d48b 1043 // CDMS TEAM CODE END
shreeshas95 0:f016e9e8d48b 1044 // EXECUTE OBOSC
aniruddhv 51:da85d84768e2 1045 #define execute_obosc_core(tc_ptr, tm_ptr, reset_flag) {\
shreeshas95 0:f016e9e8d48b 1046 uint8_t service_subtype = (tc_ptr->TC_string[2]) & 0x0F;\
shreeshas95 4:104dd82c99b8 1047 uint8_t temp8 = 0x00;\
shreeshas95 4:104dd82c99b8 1048 Base_tc *modify_this = gHEAD_NODE_TCL;\
shreeshas95 4:104dd82c99b8 1049 int modify_overflow = 0x00;\
shreeshas95 4:104dd82c99b8 1050 switch( service_subtype ){\
shreeshas95 4:104dd82c99b8 1051 case OBOSC_SUB_DISABLE:\
aniruddhv 12:ffdb29353058 1052 /*gPC.puts("target psc are ");*/\
shreeshas95 5:ab276a17ca07 1053 for(int i = 3 ; i < 9 ; ++i){\
aniruddhv 12:ffdb29353058 1054 /*gPC.printf("%u ", tc_ptr->TC_string[i]);*/\
shreeshas95 5:ab276a17ca07 1055 }\
aniruddhv 12:ffdb29353058 1056 /*gPC.puts("\r\n");*/\
shreeshas95 5:ab276a17ca07 1057 /*gPC.puts("disable type obosc\r\n");*/\
shreeshas95 4:104dd82c99b8 1058 while( modify_this != NULL ){\
shreeshas95 4:104dd82c99b8 1059 if( modify_overflow < TCL_OVERFLOW_CONSTANT ){\
shreeshas95 5:ab276a17ca07 1060 uint8_t modify_psc = GETpacket_seq_count(modify_this);\
shreeshas95 5:ab276a17ca07 1061 /*gPC.printf("mosify_psc = %u\r\n", modify_psc);*/\
shreeshas95 4:104dd82c99b8 1062 for( int i = 3 ; i < 9 ; ++i ){\
shreeshas95 5:ab276a17ca07 1063 uint8_t target_psc = tc_ptr->TC_string[i];\
shreeshas95 5:ab276a17ca07 1064 if( (target_psc == modify_psc) && (target_psc != 0) ){\
shreeshas95 4:104dd82c99b8 1065 uint16_t tempExec = TC_STATE_DISABLED;\
shreeshas95 4:104dd82c99b8 1066 PUTexec_status( modify_this, tempExec );\
shreeshas95 4:104dd82c99b8 1067 break;\
shreeshas95 4:104dd82c99b8 1068 }\
shreeshas95 4:104dd82c99b8 1069 }\
shreeshas95 4:104dd82c99b8 1070 modify_this = modify_this->next_TC;\
shreeshas95 4:104dd82c99b8 1071 ++modify_overflow;\
shreeshas95 4:104dd82c99b8 1072 }\
shreeshas95 4:104dd82c99b8 1073 else{\
shreeshas95 4:104dd82c99b8 1074 /*PENDING: RESET CDMS*/\
shreeshas95 4:104dd82c99b8 1075 break;\
shreeshas95 4:104dd82c99b8 1076 }\
shreeshas95 4:104dd82c99b8 1077 }\
shreeshas95 4:104dd82c99b8 1078 break;\
shreeshas95 4:104dd82c99b8 1079 case OBOSC_SUB_RETRY:\
aniruddhv 12:ffdb29353058 1080 /*gPC.puts("retry type obosc\r\n");*/\
shreeshas95 4:104dd82c99b8 1081 while( modify_this != NULL ){\
shreeshas95 4:104dd82c99b8 1082 if( modify_overflow < TCL_OVERFLOW_CONSTANT ){\
shreeshas95 5:ab276a17ca07 1083 uint8_t modify_psc = GETpacket_seq_count(modify_this);\
shreeshas95 4:104dd82c99b8 1084 for( int i = 3 ; i < 9 ; ++i ){\
shreeshas95 5:ab276a17ca07 1085 uint8_t target_psc = tc_ptr->TC_string[i];\
shreeshas95 5:ab276a17ca07 1086 if( (target_psc == modify_psc) && (target_psc != 0) ){\
shreeshas95 4:104dd82c99b8 1087 uint16_t tempExec = TC_STATE_MARKED_RETRY;\
shreeshas95 4:104dd82c99b8 1088 PUTexec_status( modify_this, tempExec );\
aniruddhv 12:ffdb29353058 1089 /*gPC.puts("reqquired tc found: disable\r\n");*/\
shreeshas95 4:104dd82c99b8 1090 break;\
shreeshas95 4:104dd82c99b8 1091 }\
shreeshas95 4:104dd82c99b8 1092 }\
shreeshas95 4:104dd82c99b8 1093 modify_this = modify_this->next_TC;\
shreeshas95 4:104dd82c99b8 1094 ++modify_overflow;\
shreeshas95 4:104dd82c99b8 1095 }\
shreeshas95 4:104dd82c99b8 1096 else{\
shreeshas95 4:104dd82c99b8 1097 /*PENDING: RESET CDMS*/\
shreeshas95 4:104dd82c99b8 1098 break;\
shreeshas95 4:104dd82c99b8 1099 }\
shreeshas95 4:104dd82c99b8 1100 }\
shreeshas95 4:104dd82c99b8 1101 break;\
shreeshas95 4:104dd82c99b8 1102 }\
shreeshas95 4:104dd82c99b8 1103 Base_tm *ackl234new = new Short_tm;\
shreeshas95 4:104dd82c99b8 1104 ackl234new->next_TM = NULL;\
shreeshas95 4:104dd82c99b8 1105 /*return telemetry pointer here*/\
shreeshas95 4:104dd82c99b8 1106 tm_ptr = ackl234new;\
shreeshas95 4:104dd82c99b8 1107 temp8 = SHORT_TM_CODE;\
shreeshas95 4:104dd82c99b8 1108 PUTshort_or_long_tm(ackl234new->fields, temp8);\
shreeshas95 4:104dd82c99b8 1109 temp8 = TMID_ACK_L234;\
shreeshas95 4:104dd82c99b8 1110 PUTtmid((ackl234new->fields), temp8);\
shreeshas95 4:104dd82c99b8 1111 ackl234new->TM_string[0] = TMID_ACK_L234 << 4;\
shreeshas95 4:104dd82c99b8 1112 ackl234new->TM_string[1] = GETpacket_seq_count(tc_ptr);\
shreeshas95 4:104dd82c99b8 1113 ackl234new->TM_string[2] = 0xA0;\
shreeshas95 4:104dd82c99b8 1114 for(int i = 3; i < 11; ++i){\
shreeshas95 4:104dd82c99b8 1115 ackl234new->TM_string[i] = 0x00;\
shreeshas95 4:104dd82c99b8 1116 }\
shreeshas95 4:104dd82c99b8 1117 uint16_t crc = crc16_gen(ackl234new->TM_string, TM_SHORT_SIZE-2);\
shreeshas95 4:104dd82c99b8 1118 ackl234new->TM_string[11] = (crc & 0xFF00) >> 8;\
shreeshas95 4:104dd82c99b8 1119 ackl234new->TM_string[12] = crc & 0x00FF;\
shreeshas95 4:104dd82c99b8 1120 /*ack l234 old*/\
shreeshas95 4:104dd82c99b8 1121 if( service_subtype == OBOSC_SUB_REP_LE ){\
shreeshas95 4:104dd82c99b8 1122 if( gLAST_TM_SHORT_OR_LONG == SHORT_TM_CODE ){\
shreeshas95 4:104dd82c99b8 1123 Base_tm *ackl234old = new Short_tm;\
shreeshas95 4:104dd82c99b8 1124 ackl234old->next_TM = NULL;\
shreeshas95 4:104dd82c99b8 1125 /*APPEND TO ACK L234 NEW HERE*/\
shreeshas95 4:104dd82c99b8 1126 ackl234new->next_TM = ackl234old;\
shreeshas95 4:104dd82c99b8 1127 uint8_t temp82 = TM_SHORT_SIZE;\
shreeshas95 4:104dd82c99b8 1128 PUTshort_or_long_tm(ackl234old->fields, temp82);\
shreeshas95 4:104dd82c99b8 1129 /*TMID FOR SHORT TM*/\
shreeshas95 4:104dd82c99b8 1130 uint8_t y = (gLAST_TM[0] & 0xF0) >> 4;\
shreeshas95 4:104dd82c99b8 1131 PUTtmid((ackl234old->fields), y);\
shreeshas95 4:104dd82c99b8 1132 for( int i = 0 ; i < TM_SHORT_SIZE ; ++i ){\
shreeshas95 4:104dd82c99b8 1133 ackl234old->TM_string[i] = gLAST_TM[i];\
shreeshas95 4:104dd82c99b8 1134 }\
shreeshas95 0:f016e9e8d48b 1135 }\
shreeshas95 4:104dd82c99b8 1136 else{\
shreeshas95 4:104dd82c99b8 1137 Base_tm *tempLongTM = new Long_tm;\
shreeshas95 4:104dd82c99b8 1138 tempLongTM->next_TM = NULL;\
shreeshas95 4:104dd82c99b8 1139 /*APPEND TO ACK L234 NEW HERE*/\
shreeshas95 4:104dd82c99b8 1140 ackl234new->next_TM = tempLongTM;\
shreeshas95 4:104dd82c99b8 1141 uint8_t temp82 = TM_LONG_SIZE;\
shreeshas95 4:104dd82c99b8 1142 PUTshort_or_long_tm(tempLongTM->fields, temp82);\
shreeshas95 4:104dd82c99b8 1143 /*TMID FOR LONG TM*/\
shreeshas95 4:104dd82c99b8 1144 uint8_t y = (gLAST_TM[0] & 0x78) >> 3;\
shreeshas95 4:104dd82c99b8 1145 PUTtmid((tempLongTM->fields), y);\
shreeshas95 4:104dd82c99b8 1146 for( int i = 0 ; i < TM_LONG_SIZE ; ++i ){\
shreeshas95 4:104dd82c99b8 1147 tempLongTM->TM_string[i] = gLAST_TM[i];\
shreeshas95 4:104dd82c99b8 1148 }\
shreeshas95 4:104dd82c99b8 1149 }\
shreeshas95 4:104dd82c99b8 1150 }\
shreeshas95 4:104dd82c99b8 1151 else if( service_subtype == OBOSC_SUB_REP_TCLD ){\
shreeshas95 4:104dd82c99b8 1152 get_tc_list(ackl234new->next_TM, GETpacket_seq_count(tc_ptr));\
shreeshas95 4:104dd82c99b8 1153 }\
shreeshas95 4:104dd82c99b8 1154 else if( service_subtype == OBOSC_SUB_RESET ){\
aniruddhv 51:da85d84768e2 1155 /*reset_all;*/\
aniruddhv 51:da85d84768e2 1156 reset_flag = 1;\
shreeshas95 4:104dd82c99b8 1157 /*PENDING: VERIFY reset_all, RESET CDMS*/\
shreeshas95 0:f016e9e8d48b 1158 }\
shreeshas95 5:ab276a17ca07 1159 else if( (service_subtype != OBOSC_SUB_DISABLE) && (service_subtype != OBOSC_SUB_RETRY) ){\
shreeshas95 4:104dd82c99b8 1160 /*CHANGE THE ACK CODE TO INVALID TC*/\
shreeshas95 4:104dd82c99b8 1161 ackl234new->TM_string[2] = 0xA2;\
shreeshas95 0:f016e9e8d48b 1162 }\
aniruddhv 12:ffdb29353058 1163 /*gPC.puts("completed obosc\r\n");*/\
shreeshas95 4:104dd82c99b8 1164 }
shreeshas95 4:104dd82c99b8 1165
shreeshas95 4:104dd82c99b8 1166 /*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 */
shreeshas95 4:104dd82c99b8 1167 #define get_call_sign(tm_ptr) {\
shreeshas95 4:104dd82c99b8 1168 Base_tm* call_sign_tm = new Short_tm;\
shreeshas95 4:104dd82c99b8 1169 call_sign_tm->next_TM = NULL;\
shreeshas95 4:104dd82c99b8 1170 tm_ptr = call_sign_tm;\
shreeshas95 4:104dd82c99b8 1171 uint8_t temp8 = TMID_CALL_SIGN;\
shreeshas95 4:104dd82c99b8 1172 PUTtmid(call_sign_tm->fields, temp8);\
shreeshas95 4:104dd82c99b8 1173 temp8 = SHORT_TM_CODE;\
shreeshas95 4:104dd82c99b8 1174 PUTshort_or_long_tm(call_sign_tm->fields, temp8);\
shreeshas95 4:104dd82c99b8 1175 for( int i = 0 ; i < TM_SHORT_SIZE ; ++i ){\
shreeshas95 4:104dd82c99b8 1176 call_sign_tm->TM_string[i] = gCALL_SIGN_STRING[i];\
shreeshas95 4:104dd82c99b8 1177 }\
shreeshas95 0:f016e9e8d48b 1178 }
shreeshas95 0:f016e9e8d48b 1179
shreeshas95 0:f016e9e8d48b 1180 #define EXECUTE_OBOSC_ONLY {\
aniruddhv 51:da85d84768e2 1181 int reset_flag = 0;\
shreeshas95 15:1c1ca992b43b 1182 for(uint8_t execute_psc = PSC_START_VALUE ; execute_psc < gTOTAL_VALID_TC ; ++execute_psc){\
shreeshas95 4:104dd82c99b8 1183 Base_tc* current_TC = gHEAD_NODE_TCL;\
shreeshas95 4:104dd82c99b8 1184 int overCount = 0;\
shreeshas95 0:f016e9e8d48b 1185 while( current_TC != NULL ){\
shreeshas95 4:104dd82c99b8 1186 if( overCount < TCL_OVERFLOW_CONSTANT ){\
shreeshas95 4:104dd82c99b8 1187 if( (GETcrc_pass(current_TC) == 1) && (GETpacket_seq_count(current_TC) == execute_psc) ){\
shreeshas95 4:104dd82c99b8 1188 /*CHECK FOR OBOSC*/\
shreeshas95 0:f016e9e8d48b 1189 uint8_t temp82 = 0x00;\
shreeshas95 0:f016e9e8d48b 1190 isit_obosc(current_TC, temp82);\
shreeshas95 0:f016e9e8d48b 1191 if(temp82 == 0x01){\
shreeshas95 4:104dd82c99b8 1192 uint16_t current_exec_status = GETexec_status(current_TC);\
shreeshas95 4:104dd82c99b8 1193 if( (current_exec_status == TC_STATE_SUCCESSFULLY_EXECUTED) || (current_exec_status == TC_STATE_DISABLED) )\
shreeshas95 4:104dd82c99b8 1194 break;\
shreeshas95 4:104dd82c99b8 1195 else if( (current_exec_status == TC_STATE_UNEXECUTED) || (current_exec_status == TC_STATE_MARKED_RETRY) ){\
aniruddhv 12:ffdb29353058 1196 /*gPC.printf("It is obosc: %u\r\n", execute_psc);*/\
shreeshas95 4:104dd82c99b8 1197 /*EXECUTION OF OBOSC TC*/\
shreeshas95 4:104dd82c99b8 1198 /*WARNING: LARGE MEMORY UTILIZATION FOR TC-LIST-REPORT */\
aniruddhv 37:c9a739750806 1199 Base_tm *obosc_tm_head = NULL;\
aniruddhv 37:c9a739750806 1200 get_call_sign(obosc_tm_head);\
aniruddhv 37:c9a739750806 1201 Base_tm *obosc_tm_core = NULL;\
aniruddhv 51:da85d84768e2 1202 execute_obosc_core(current_TC, obosc_tm_core, reset_flag);\
aniruddhv 45:4c10559cd886 1203 uint16_t temp16 = TC_STATE_SUCCESSFULLY_EXECUTED;\
aniruddhv 45:4c10559cd886 1204 PUTexec_status(current_TC, temp16);\
aniruddhv 37:c9a739750806 1205 Base_tm *obosc_tm_current = obosc_tm_head;\
aniruddhv 37:c9a739750806 1206 get_ack_l1(obosc_tm_current->next_TM);\
aniruddhv 37:c9a739750806 1207 int overflowCountOBONLY = 0;\
shreeshas95 4:104dd82c99b8 1208 while( obosc_tm_current->next_TM != NULL ){\
aniruddhv 37:c9a739750806 1209 if( overflowCountOBONLY < TM_OVERFLOW_CONSTANT ){\
shreeshas95 4:104dd82c99b8 1210 obosc_tm_current = obosc_tm_current->next_TM;\
aniruddhv 37:c9a739750806 1211 ++overflowCountOBONLY;\
shreeshas95 4:104dd82c99b8 1212 }\
shreeshas95 4:104dd82c99b8 1213 else{\
shreeshas95 4:104dd82c99b8 1214 /*PENDING: RESET CDMS*/\
shreeshas95 4:104dd82c99b8 1215 break;\
shreeshas95 4:104dd82c99b8 1216 }\
shreeshas95 4:104dd82c99b8 1217 }\
aniruddhv 37:c9a739750806 1218 obosc_tm_current->next_TM = obosc_tm_core;\
aniruddhv 37:c9a739750806 1219 obosc_tm_current = obosc_tm_head;\
aniruddhv 37:c9a739750806 1220 while( obosc_tm_current != NULL ){\
aniruddhv 37:c9a739750806 1221 int length = TM_SHORT_SIZE;\
aniruddhv 37:c9a739750806 1222 if( GETshort_or_long_tm(obosc_tm_current->fields) == SHORT_TM_CODE ){\
aniruddhv 37:c9a739750806 1223 length = TM_SHORT_SIZE;\
aniruddhv 37:c9a739750806 1224 }\
aniruddhv 37:c9a739750806 1225 else{\
aniruddhv 37:c9a739750806 1226 length = TM_LONG_SIZE;\
aniruddhv 37:c9a739750806 1227 }\
aniruddhv 37:c9a739750806 1228 for(int i = 0 ; i < length ; ++i){\
ee12b079 55:39e59903bc3a 1229 /*gPC.putc(obosc_tm_current->TM_string[i]);*/\
aniruddhv 37:c9a739750806 1230 }\
aniruddhv 37:c9a739750806 1231 obosc_tm_current = obosc_tm_current->next_TM;\
aniruddhv 37:c9a739750806 1232 }\
aniruddhv 37:c9a739750806 1233 /*snd_tm.head_pointer(obosc_tm_head);*/\
aniruddhv 37:c9a739750806 1234 /*adf_not_SDcard();*/\
aniruddhv 37:c9a739750806 1235 /*DELETE THE TM AFTER USE*/\
aniruddhv 37:c9a739750806 1236 obosc_tm_current = obosc_tm_head;\
aniruddhv 37:c9a739750806 1237 int overCount = 0;\
aniruddhv 37:c9a739750806 1238 while( obosc_tm_current != NULL ){\
aniruddhv 37:c9a739750806 1239 if( (overCount < TM_OVERFLOW_CONSTANT) ){\
aniruddhv 37:c9a739750806 1240 Base_tm *temp = obosc_tm_current->next_TM;\
aniruddhv 37:c9a739750806 1241 delete obosc_tm_current;\
aniruddhv 37:c9a739750806 1242 obosc_tm_current = temp;\
aniruddhv 37:c9a739750806 1243 ++overCount;\
aniruddhv 37:c9a739750806 1244 }\
aniruddhv 37:c9a739750806 1245 else{\
aniruddhv 37:c9a739750806 1246 /*PENDING: RESET CDMS: MEMORY LEAK FOUND*/\
aniruddhv 37:c9a739750806 1247 break;\
aniruddhv 37:c9a739750806 1248 }\
aniruddhv 37:c9a739750806 1249 }\
aniruddhv 51:da85d84768e2 1250 if ( reset_flag ==1 ){\
aniruddhv 51:da85d84768e2 1251 reset_all;\
aniruddhv 51:da85d84768e2 1252 }\
shreeshas95 0:f016e9e8d48b 1253 }\
shreeshas95 0:f016e9e8d48b 1254 }\
shreeshas95 0:f016e9e8d48b 1255 }\
shreeshas95 4:104dd82c99b8 1256 current_TC = current_TC->next_TC;\
shreeshas95 4:104dd82c99b8 1257 ++overCount;\
shreeshas95 0:f016e9e8d48b 1258 }\
shreeshas95 4:104dd82c99b8 1259 else{\
shreeshas95 4:104dd82c99b8 1260 /*PENDING: REST CDMS: MEMORY LEAK FOUND*/\
shreeshas95 4:104dd82c99b8 1261 break;\
shreeshas95 4:104dd82c99b8 1262 }\
shreeshas95 4:104dd82c99b8 1263 }\
shreeshas95 4:104dd82c99b8 1264 }\
shreeshas95 0:f016e9e8d48b 1265 }
shreeshas95 0:f016e9e8d48b 1266
shreeshas95 0:f016e9e8d48b 1267 #define EXECUTE_TC {\
shreeshas95 5:ab276a17ca07 1268 gMASTER_STATE = TCL_STATE_EXECUTING;\
rohit3342 23:c89376564196 1269 /*gPC.printf("%u\r\n", gTOTAL_VALID_TC);*/\
rohit3342 16:538de1b20b3a 1270 for(uint8_t execute_psc = PSC_START_VALUE ; execute_psc < gTOTAL_VALID_TC ; ++execute_psc ){\
rohit3342 23:c89376564196 1271 /*gPC.printf("executing normal %u\r\n", execute_psc);*/\
shreeshas95 2:2caf2a9a13aa 1272 /*gLEDG = !gLEDG;*/\
shreeshas95 2:2caf2a9a13aa 1273 /*gLEDR = !gLEDR;*/\
shreeshas95 0:f016e9e8d48b 1274 Base_tc* current_TC = gHEAD_NODE_TCL;\
shreeshas95 4:104dd82c99b8 1275 int overflowCount = 0;\
shreeshas95 0:f016e9e8d48b 1276 while(current_TC != NULL){\
shreeshas95 4:104dd82c99b8 1277 if( overflowCount < TCL_OVERFLOW_CONSTANT ){\
shreeshas95 4:104dd82c99b8 1278 if( (GETcrc_pass(current_TC) == 1) && (GETpacket_seq_count(current_TC) == execute_psc) ){\
shreeshas95 4:104dd82c99b8 1279 uint8_t current_exec_status = GETexec_status(current_TC);\
shreeshas95 5:ab276a17ca07 1280 if( (current_exec_status == TC_STATE_SUCCESSFULLY_EXECUTED) || (current_exec_status == TC_STATE_DISABLED) ){\
aniruddhv 12:ffdb29353058 1281 /*gPC.printf("disabled or completed at %u\n", execute_psc);*/\
shreeshas95 4:104dd82c99b8 1282 break;\
shreeshas95 5:ab276a17ca07 1283 }\
shreeshas95 4:104dd82c99b8 1284 else if( (current_exec_status == TC_STATE_EXECUTION_FAILED) && (GETabort_on_nack(current_TC) == 1) ){\
aniruddhv 12:ffdb29353058 1285 /*gPC.printf("abort on nack at %u psc\r\n", execute_psc);*/\
shreeshas95 4:104dd82c99b8 1286 gMASTER_STATE = TCL_STATE_ABORTED;\
rohit3342 44:b9b067d0559f 1287 Base_tm *tm_ptr_head = NULL;\
rohit3342 44:b9b067d0559f 1288 get_call_sign(tm_ptr_head);\
rohit3342 44:b9b067d0559f 1289 Base_tm *tm_ptr = tm_ptr_head;\
rohit3342 44:b9b067d0559f 1290 get_ack_l1(tm_ptr->next_TM);\
rohit3342 44:b9b067d0559f 1291 tm_ptr = tm_ptr_head;\
rohit3342 44:b9b067d0559f 1292 while( tm_ptr != NULL ){\
rohit3342 44:b9b067d0559f 1293 int length = TM_SHORT_SIZE;\
rohit3342 44:b9b067d0559f 1294 if( GETshort_or_long_tm(tm_ptr->fields) == SHORT_TM_CODE ){\
rohit3342 44:b9b067d0559f 1295 length = TM_SHORT_SIZE;\
rohit3342 44:b9b067d0559f 1296 }\
rohit3342 44:b9b067d0559f 1297 else{\
rohit3342 44:b9b067d0559f 1298 length = TM_LONG_SIZE;\
rohit3342 44:b9b067d0559f 1299 }\
rohit3342 44:b9b067d0559f 1300 /*gPC.puts("Printing Call Sign, ACK_L1, TM list");*/\
rohit3342 44:b9b067d0559f 1301 for(int i = 0 ; i < length ; ++i){\
ee12b079 57:bf998cb2a104 1302 /*gPC.putc(tm_ptr->TM_string[i]);*/\
rohit3342 44:b9b067d0559f 1303 }\
rohit3342 44:b9b067d0559f 1304 tm_ptr = tm_ptr->next_TM;\
rohit3342 44:b9b067d0559f 1305 }\
rohit3342 44:b9b067d0559f 1306 /*snd_tm.head_pointer(tm_ptr_head);*/\
aniruddhv 51:da85d84768e2 1307 /*DELETE THE TM AFTER USE*/\
aniruddhv 51:da85d84768e2 1308 tm_ptr = tm_ptr_head;\
aniruddhv 51:da85d84768e2 1309 int overflowCountExecute = 0;\
aniruddhv 51:da85d84768e2 1310 while(tm_ptr != NULL){\
aniruddhv 51:da85d84768e2 1311 if( overflowCountExecute < TM_OVERFLOW_CONSTANT ){\
aniruddhv 51:da85d84768e2 1312 Base_tm *temp = tm_ptr->next_TM;\
aniruddhv 51:da85d84768e2 1313 delete tm_ptr;\
aniruddhv 51:da85d84768e2 1314 tm_ptr = temp;\
aniruddhv 51:da85d84768e2 1315 ++overflowCountExecute;\
aniruddhv 51:da85d84768e2 1316 }\
aniruddhv 51:da85d84768e2 1317 else{\
aniruddhv 51:da85d84768e2 1318 /*PENDING: RESET CDMS*/\
aniruddhv 51:da85d84768e2 1319 break;\
aniruddhv 51:da85d84768e2 1320 }\
aniruddhv 51:da85d84768e2 1321 }\
shreeshas95 4:104dd82c99b8 1322 break;\
shreeshas95 4:104dd82c99b8 1323 }\
shreeshas95 4:104dd82c99b8 1324 else if( (current_exec_status == TC_STATE_UNEXECUTED) || (current_exec_status == TC_STATE_MARKED_RETRY) ){\
shreeshas95 4:104dd82c99b8 1325 /*EXECUTION OF TC START*/\
shreeshas95 4:104dd82c99b8 1326 uint8_t temp81 = 0x00;\
shreeshas95 4:104dd82c99b8 1327 isit_sdcard(current_TC, temp81);\
shreeshas95 4:104dd82c99b8 1328 if( temp81 == 0x00 ){\
aniruddhv 12:ffdb29353058 1329 /*gPC.printf("non sd card at %u\r\n", execute_psc);*/\
shreeshas95 4:104dd82c99b8 1330 /*EXECUTION OF NON SD-CARD (BOTH OBOSC and CDMS functions)*/\
shreeshas95 4:104dd82c99b8 1331 Base_tm *tm_ptr_head = NULL;\
shreeshas95 4:104dd82c99b8 1332 get_call_sign(tm_ptr_head);\
shreeshas95 4:104dd82c99b8 1333 Base_tm *put_tm_here = NULL;\
shreeshas95 4:104dd82c99b8 1334 uint8_t temp82 = 0x00;\
shreeshas95 4:104dd82c99b8 1335 uint8_t tempPAhot = 0x00;\
shreeshas95 4:104dd82c99b8 1336 isit_obosc(current_TC, temp82);\
shreeshas95 4:104dd82c99b8 1337 if(temp82 == 0x01){\
aniruddhv 12:ffdb29353058 1338 /*gPC.printf("obosc tc inside normal tc at %u\r\n", execute_psc);*/\
shreeshas95 4:104dd82c99b8 1339 /*EXECUTION OF OBOSC TC*/\
shreeshas95 4:104dd82c99b8 1340 /*SKIP EXECUTION OF OBOSC HERE*/\
aniruddhv 37:c9a739750806 1341 break;\
shreeshas95 4:104dd82c99b8 1342 }\
shreeshas95 4:104dd82c99b8 1343 else{\
rohit3342 23:c89376564196 1344 /*gPC.printf("cdms relay tmtc at %u\r\n", execute_psc);*/\
shreeshas95 4:104dd82c99b8 1345 /*call CDMS_RLY_TMTC*/\
shreeshas95 4:104dd82c99b8 1346 /*CDMS_RLY_TMTC(current_TC, put_tm_here);*/\
aniruddhv 52:0bd68655c651 1347 put_tm_here = FCTN_CDMS_RLY_TMTC(current_TC);\
shreeshas95 4:104dd82c99b8 1348 }\
shreeshas95 4:104dd82c99b8 1349 /*DETECT ACK OR NACK*/\
shreeshas95 4:104dd82c99b8 1350 uint8_t temp83 = 0x00;\
shreeshas95 4:104dd82c99b8 1351 uint8_t temp84 = GETpacket_seq_count(current_TC);\
shreeshas95 4:104dd82c99b8 1352 detect_ack(put_tm_here, temp83, temp84);\
shreeshas95 4:104dd82c99b8 1353 if( temp83 == 0x01){\
shreeshas95 4:104dd82c99b8 1354 uint16_t temp16 = TC_STATE_SUCCESSFULLY_EXECUTED;\
shreeshas95 4:104dd82c99b8 1355 PUTexec_status(current_TC, temp16);\
shreeshas95 4:104dd82c99b8 1356 }\
shreeshas95 4:104dd82c99b8 1357 else{\
rohit3342 23:c89376564196 1358 /*gPC.puts("TC_STATE_EXECUTION_FAILED");*/\
shreeshas95 4:104dd82c99b8 1359 uint16_t temp16 = TC_STATE_EXECUTION_FAILED;\
shreeshas95 4:104dd82c99b8 1360 PUTexec_status(current_TC, temp16);\
shreeshas95 4:104dd82c99b8 1361 }\
shreeshas95 4:104dd82c99b8 1362 /*ABORT ON NACK AND TC LIST COMPLETED: UPDATE IN gMASTERSTATE*/\
shreeshas95 4:104dd82c99b8 1363 if( (GETexec_status(current_TC) == TC_STATE_EXECUTION_FAILED) && (GETabort_on_nack(current_TC) == 1) ){\
shreeshas95 4:104dd82c99b8 1364 gMASTER_STATE = TCL_STATE_ABORTED;\
shreeshas95 4:104dd82c99b8 1365 }\
shreeshas95 15:1c1ca992b43b 1366 else if( execute_psc == (gTOTAL_VALID_TC-1) ){\
shreeshas95 4:104dd82c99b8 1367 /*LAST TC IS EXECUTED*/\
shreeshas95 4:104dd82c99b8 1368 gMASTER_STATE = TCL_STATE_COMPLETED;\
shreeshas95 4:104dd82c99b8 1369 }\
aniruddhv 37:c9a739750806 1370 else{\
aniruddhv 37:c9a739750806 1371 uint8_t check1 = 1;\
aniruddhv 37:c9a739750806 1372 for( uint8_t test_psc = execute_psc+1 ; test_psc < gTOTAL_VALID_TC ; ++test_psc ){\
aniruddhv 37:c9a739750806 1373 Base_tc* test_TC = gHEAD_NODE_TCL;\
aniruddhv 37:c9a739750806 1374 while(test_TC != NULL){\
aniruddhv 37:c9a739750806 1375 if( GETpacket_seq_count(test_TC) == test_psc ){\
aniruddhv 37:c9a739750806 1376 uint8_t checkval;\
aniruddhv 37:c9a739750806 1377 isit_obosc(test_TC, checkval);\
aniruddhv 37:c9a739750806 1378 if( checkval == 0 ){\
aniruddhv 37:c9a739750806 1379 check1 = 0;\
aniruddhv 37:c9a739750806 1380 }\
aniruddhv 37:c9a739750806 1381 }\
aniruddhv 37:c9a739750806 1382 test_TC = test_TC->next_TC;\
aniruddhv 37:c9a739750806 1383 }\
aniruddhv 37:c9a739750806 1384 }\
aniruddhv 37:c9a739750806 1385 if( check1 == 0x01 ){\
aniruddhv 37:c9a739750806 1386 gMASTER_STATE = TCL_STATE_COMPLETED;\
aniruddhv 37:c9a739750806 1387 }\
aniruddhv 37:c9a739750806 1388 }\
shreeshas95 4:104dd82c99b8 1389 /*update last executed L1_ack*/\
shreeshas95 4:104dd82c99b8 1390 if( put_tm_here != NULL ){\
shreeshas95 4:104dd82c99b8 1391 if( GETshort_or_long_tm(put_tm_here->fields) == SHORT_TM_CODE ){\
shreeshas95 4:104dd82c99b8 1392 for(int i = 0 ; i < TM_SHORT_SIZE ; ++i){\
shreeshas95 4:104dd82c99b8 1393 gLAST_TM[i] = put_tm_here->TM_string[i];\
shreeshas95 4:104dd82c99b8 1394 gLAST_TM_SHORT_OR_LONG = SHORT_TM_CODE;\
shreeshas95 4:104dd82c99b8 1395 }\
shreeshas95 4:104dd82c99b8 1396 }\
shreeshas95 4:104dd82c99b8 1397 else{\
shreeshas95 4:104dd82c99b8 1398 for( int i = 0 ; i < TM_LONG_SIZE ; ++i ){\
shreeshas95 4:104dd82c99b8 1399 gLAST_TM[i] = put_tm_here->TM_string[i];\
shreeshas95 4:104dd82c99b8 1400 gLAST_TM_SHORT_OR_LONG = LONG_TM_CODE;\
shreeshas95 4:104dd82c99b8 1401 }\
shreeshas95 4:104dd82c99b8 1402 }\
shreeshas95 4:104dd82c99b8 1403 }\
shreeshas95 4:104dd82c99b8 1404 /*PENDING: APPEND ACK L1*/\
shreeshas95 4:104dd82c99b8 1405 Base_tm *tm_ptr = tm_ptr_head;\
shreeshas95 4:104dd82c99b8 1406 get_ack_l1(tm_ptr->next_TM);\
shreeshas95 4:104dd82c99b8 1407 int overflowCountExecute = 0;\
shreeshas95 4:104dd82c99b8 1408 while( tm_ptr->next_TM != NULL ){\
shreeshas95 4:104dd82c99b8 1409 if( overflowCountExecute < TM_OVERFLOW_CONSTANT ){\
shreeshas95 4:104dd82c99b8 1410 tm_ptr = tm_ptr->next_TM;\
shreeshas95 4:104dd82c99b8 1411 ++overflowCountExecute;\
shreeshas95 4:104dd82c99b8 1412 }\
shreeshas95 4:104dd82c99b8 1413 else{\
shreeshas95 4:104dd82c99b8 1414 /*PENDING: RESET CDMS*/\
shreeshas95 4:104dd82c99b8 1415 break;\
shreeshas95 4:104dd82c99b8 1416 }\
shreeshas95 4:104dd82c99b8 1417 }\
shreeshas95 4:104dd82c99b8 1418 tm_ptr->next_TM = put_tm_here;\
shreeshas95 4:104dd82c99b8 1419 /*CHECK FOR HOT PA*/\
shreeshas95 4:104dd82c99b8 1420 isPAhot(tempPAhot);\
shreeshas95 4:104dd82c99b8 1421 if( tempPAhot == 0x00 ){\
shreeshas95 4:104dd82c99b8 1422 gFLAGS = gFLAGS | COM_PA_HOT_FLAG;\
shreeshas95 4:104dd82c99b8 1423 }\
shreeshas95 15:1c1ca992b43b 1424 tm_ptr = tm_ptr_head;\
shreeshas95 15:1c1ca992b43b 1425 while( tm_ptr != NULL ){\
shreeshas95 15:1c1ca992b43b 1426 int length = TM_SHORT_SIZE;\
shreeshas95 15:1c1ca992b43b 1427 if( GETshort_or_long_tm(tm_ptr->fields) == SHORT_TM_CODE ){\
shreeshas95 15:1c1ca992b43b 1428 length = TM_SHORT_SIZE;\
shreeshas95 15:1c1ca992b43b 1429 }\
shreeshas95 15:1c1ca992b43b 1430 else{\
shreeshas95 15:1c1ca992b43b 1431 length = TM_LONG_SIZE;\
shreeshas95 15:1c1ca992b43b 1432 }\
rohit3342 23:c89376564196 1433 /*gPC.puts("Printing Call Sign, ACK_L1, TM list");*/\
shreeshas95 15:1c1ca992b43b 1434 for(int i = 0 ; i < length ; ++i){\
ee12b079 57:bf998cb2a104 1435 /*gPC.putc(tm_ptr->TM_string[i]);*/\
shreeshas95 15:1c1ca992b43b 1436 }\
shreeshas95 15:1c1ca992b43b 1437 tm_ptr = tm_ptr->next_TM;\
shreeshas95 15:1c1ca992b43b 1438 }\
shreeshas95 4:104dd82c99b8 1439 /*SEND DATA TO GS*/\
aniruddhv 52:0bd68655c651 1440 snd_tm.head_pointer(tm_ptr_head);\
aniruddhv 52:0bd68655c651 1441 adf_not_SDcard;\
shreeshas95 4:104dd82c99b8 1442 /*DELETE THE TM AFTER USE*/\
shreeshas95 4:104dd82c99b8 1443 tm_ptr = tm_ptr_head;\
shreeshas95 4:104dd82c99b8 1444 overflowCountExecute = 0;\
shreeshas95 4:104dd82c99b8 1445 while(tm_ptr != NULL){\
shreeshas95 4:104dd82c99b8 1446 if( overflowCountExecute < TM_OVERFLOW_CONSTANT ){\
shreeshas95 4:104dd82c99b8 1447 Base_tm *temp = tm_ptr->next_TM;\
shreeshas95 4:104dd82c99b8 1448 delete tm_ptr;\
shreeshas95 4:104dd82c99b8 1449 tm_ptr = temp;\
shreeshas95 4:104dd82c99b8 1450 ++overflowCountExecute;\
shreeshas95 4:104dd82c99b8 1451 }\
shreeshas95 4:104dd82c99b8 1452 else{\
shreeshas95 4:104dd82c99b8 1453 /*PENDING: RESET CDMS*/\
shreeshas95 4:104dd82c99b8 1454 break;\
aniruddhv 52:0bd68655c651 1455 }\
shreeshas95 4:104dd82c99b8 1456 }\
shreeshas95 0:f016e9e8d48b 1457 }\
shreeshas95 0:f016e9e8d48b 1458 else{\
aniruddhv 12:ffdb29353058 1459 /*gPC.printf("sd card at %u\r\n", execute_psc);*/\
shreeshas95 4:104dd82c99b8 1460 /*EXECUTION OF SD-CARD DATA SENDING (OBSRS)*/\
aniruddhv 37:c9a739750806 1461 Base_tm *tm_ptr_head = NULL;\
aniruddhv 37:c9a739750806 1462 get_call_sign(tm_ptr_head);\
aniruddhv 37:c9a739750806 1463 Base_tm *put_tm_here = NULL;\
aniruddhv 37:c9a739750806 1464 /*execute_obsrs(current_TC, put_tm_here)*/\
shreeshas95 4:104dd82c99b8 1465 /*read_TC(current_TC);*/\
shreeshas95 6:79d422d1ed42 1466 uint8_t tempExec = TC_STATE_SUCCESSFULLY_EXECUTED;\
shreeshas95 6:79d422d1ed42 1467 PUTexec_status(current_TC, tempExec);\
shreeshas95 6:79d422d1ed42 1468 /*PENDING: ABORT ON NACK CHECK, gMASTER_STATE VERIFICATION WITH SD CARD, session timeout, last executed ack l234*/\
shreeshas95 4:104dd82c99b8 1469 if( (GETexec_status(current_TC) == TC_STATE_EXECUTION_FAILED) && (GETabort_on_nack(current_TC) == 1) ){\
shreeshas95 4:104dd82c99b8 1470 gMASTER_STATE = TCL_STATE_ABORTED;\
shreeshas95 0:f016e9e8d48b 1471 }\
shreeshas95 15:1c1ca992b43b 1472 else if( execute_psc == (gTOTAL_VALID_TC-1) ){\
shreeshas95 6:79d422d1ed42 1473 gMASTER_STATE = TCL_STATE_COMPLETED;\
shreeshas95 6:79d422d1ed42 1474 }\
aniruddhv 37:c9a739750806 1475 else{\
aniruddhv 37:c9a739750806 1476 uint8_t check1 = 1;\
aniruddhv 37:c9a739750806 1477 for( uint8_t test_psc = execute_psc+1 ; test_psc < gTOTAL_VALID_TC ; ++test_psc ){\
aniruddhv 37:c9a739750806 1478 Base_tc* test_TC = gHEAD_NODE_TCL;\
aniruddhv 37:c9a739750806 1479 while(test_TC != NULL){\
aniruddhv 37:c9a739750806 1480 if( GETpacket_seq_count(test_TC) == test_psc ){\
aniruddhv 37:c9a739750806 1481 uint8_t checkval;\
aniruddhv 37:c9a739750806 1482 isit_obosc(test_TC, checkval);\
aniruddhv 37:c9a739750806 1483 if( checkval == 0 ){\
aniruddhv 37:c9a739750806 1484 check1 = 0;\
aniruddhv 37:c9a739750806 1485 }\
aniruddhv 37:c9a739750806 1486 }\
aniruddhv 37:c9a739750806 1487 test_TC = test_TC->next_TC;\
aniruddhv 37:c9a739750806 1488 }\
aniruddhv 37:c9a739750806 1489 }\
aniruddhv 37:c9a739750806 1490 if( check1 == 0x01 ){\
aniruddhv 37:c9a739750806 1491 gMASTER_STATE = TCL_STATE_COMPLETED;\
aniruddhv 37:c9a739750806 1492 }\
aniruddhv 37:c9a739750806 1493 }\
aniruddhv 51:da85d84768e2 1494 /*update last executed L1_ack*/\
aniruddhv 51:da85d84768e2 1495 if( put_tm_here != NULL ){\
aniruddhv 51:da85d84768e2 1496 if( GETshort_or_long_tm(put_tm_here->fields) == SHORT_TM_CODE ){\
aniruddhv 51:da85d84768e2 1497 for(int i = 0 ; i < TM_SHORT_SIZE ; ++i){\
aniruddhv 51:da85d84768e2 1498 gLAST_TM[i] = put_tm_here->TM_string[i];\
aniruddhv 51:da85d84768e2 1499 gLAST_TM_SHORT_OR_LONG = SHORT_TM_CODE;\
aniruddhv 51:da85d84768e2 1500 }\
aniruddhv 51:da85d84768e2 1501 }\
aniruddhv 51:da85d84768e2 1502 else{\
aniruddhv 51:da85d84768e2 1503 for( int i = 0 ; i < TM_LONG_SIZE ; ++i ){\
aniruddhv 51:da85d84768e2 1504 gLAST_TM[i] = put_tm_here->TM_string[i];\
aniruddhv 51:da85d84768e2 1505 gLAST_TM_SHORT_OR_LONG = LONG_TM_CODE;\
aniruddhv 51:da85d84768e2 1506 }\
aniruddhv 51:da85d84768e2 1507 }\
aniruddhv 51:da85d84768e2 1508 }\
rohit3342 44:b9b067d0559f 1509 /*PENDING: APPEND ACK L1*/\
rohit3342 44:b9b067d0559f 1510 Base_tm *tm_ptr = tm_ptr_head;\
rohit3342 44:b9b067d0559f 1511 get_ack_l1(tm_ptr->next_TM);\
rohit3342 44:b9b067d0559f 1512 int overflowCountExecute = 0;\
rohit3342 44:b9b067d0559f 1513 while( tm_ptr->next_TM != NULL ){\
rohit3342 44:b9b067d0559f 1514 if( overflowCountExecute < TM_OVERFLOW_CONSTANT ){\
rohit3342 44:b9b067d0559f 1515 tm_ptr = tm_ptr->next_TM;\
rohit3342 44:b9b067d0559f 1516 ++overflowCountExecute;\
rohit3342 44:b9b067d0559f 1517 }\
rohit3342 44:b9b067d0559f 1518 else{\
rohit3342 44:b9b067d0559f 1519 /*PENDING: RESET CDMS*/\
rohit3342 44:b9b067d0559f 1520 break;\
rohit3342 44:b9b067d0559f 1521 }\
rohit3342 44:b9b067d0559f 1522 }\
rohit3342 44:b9b067d0559f 1523 tm_ptr->next_TM = put_tm_here;\
rohit3342 44:b9b067d0559f 1524 /*CHECK FOR HOT PA*/\
rohit3342 44:b9b067d0559f 1525 uint8_t tempPAhot = 0x00;\
rohit3342 44:b9b067d0559f 1526 isPAhot(tempPAhot);\
rohit3342 44:b9b067d0559f 1527 if( tempPAhot == 0x00 ){\
rohit3342 44:b9b067d0559f 1528 gFLAGS = gFLAGS | COM_PA_HOT_FLAG;\
rohit3342 44:b9b067d0559f 1529 }\
aniruddhv 37:c9a739750806 1530 tm_ptr = tm_ptr_head;\
aniruddhv 37:c9a739750806 1531 while( tm_ptr != NULL ){\
aniruddhv 37:c9a739750806 1532 int length = TM_SHORT_SIZE;\
aniruddhv 37:c9a739750806 1533 if( GETshort_or_long_tm(tm_ptr->fields) == SHORT_TM_CODE ){\
aniruddhv 37:c9a739750806 1534 length = TM_SHORT_SIZE;\
aniruddhv 37:c9a739750806 1535 }\
aniruddhv 37:c9a739750806 1536 else{\
aniruddhv 37:c9a739750806 1537 length = TM_LONG_SIZE;\
aniruddhv 37:c9a739750806 1538 }\
aniruddhv 37:c9a739750806 1539 /*gPC.puts("Printing Call Sign, ACK_L1, TM list");*/\
aniruddhv 37:c9a739750806 1540 for(int i = 0 ; i < length ; ++i){\
ee12b079 57:bf998cb2a104 1541 /*gPC.putc(tm_ptr->TM_string[i]);*/\
aniruddhv 37:c9a739750806 1542 }\
aniruddhv 37:c9a739750806 1543 tm_ptr = tm_ptr->next_TM;\
aniruddhv 37:c9a739750806 1544 }\
aniruddhv 37:c9a739750806 1545 /*SEND DATA TO GS*/\
aniruddhv 37:c9a739750806 1546 /*snd_tm.head_pointer(tm_ptr_head);*/\
aniruddhv 37:c9a739750806 1547 /*adf_SDcard();*/\
aniruddhv 37:c9a739750806 1548 /*DELETE THE TM AFTER USE*/\
aniruddhv 37:c9a739750806 1549 tm_ptr = tm_ptr_head;\
aniruddhv 37:c9a739750806 1550 overflowCountExecute = 0;\
aniruddhv 37:c9a739750806 1551 while(tm_ptr != NULL){\
aniruddhv 37:c9a739750806 1552 if( overflowCountExecute < TM_OVERFLOW_CONSTANT ){\
aniruddhv 37:c9a739750806 1553 Base_tm *temp = tm_ptr->next_TM;\
aniruddhv 37:c9a739750806 1554 delete tm_ptr;\
aniruddhv 37:c9a739750806 1555 tm_ptr = temp;\
aniruddhv 37:c9a739750806 1556 ++overflowCountExecute;\
aniruddhv 37:c9a739750806 1557 }\
aniruddhv 37:c9a739750806 1558 else{\
aniruddhv 37:c9a739750806 1559 /*PENDING: RESET CDMS*/\
aniruddhv 37:c9a739750806 1560 break;\
aniruddhv 37:c9a739750806 1561 }\
aniruddhv 37:c9a739750806 1562 }\
shreeshas95 0:f016e9e8d48b 1563 }\
shreeshas95 0:f016e9e8d48b 1564 }\
shreeshas95 4:104dd82c99b8 1565 break;\
shreeshas95 0:f016e9e8d48b 1566 }\
shreeshas95 4:104dd82c99b8 1567 current_TC = current_TC->next_TC;\
shreeshas95 4:104dd82c99b8 1568 ++overflowCount;\
shreeshas95 0:f016e9e8d48b 1569 }\
shreeshas95 4:104dd82c99b8 1570 else{\
shreeshas95 4:104dd82c99b8 1571 /*PENDING: RESET CDMS*/\
shreeshas95 2:2caf2a9a13aa 1572 break;\
shreeshas95 2:2caf2a9a13aa 1573 }\
shreeshas95 2:2caf2a9a13aa 1574 }\
shreeshas95 6:79d422d1ed42 1575 if( gFLAGS & COM_SESSION_TIMEOUT_FLAG ){\
shreeshas95 6:79d422d1ed42 1576 break;\
shreeshas95 6:79d422d1ed42 1577 }\
shreeshas95 6:79d422d1ed42 1578 else if( gMASTER_STATE == TCL_STATE_ABORTED ){\
aniruddhv 12:ffdb29353058 1579 /*gPC.puts("ABORTING DUE TO ABORT ON NACK\r\n");*/\
shreeshas95 4:104dd82c99b8 1580 /*EXITED DUE TO ABORT ON NACK:*/\
shreeshas95 2:2caf2a9a13aa 1581 /*PENDING : POWER OFF COM TX*/\
shreeshas95 2:2caf2a9a13aa 1582 RX1M.attach(&rx_read, Serial::RxIrq);\
shreeshas95 2:2caf2a9a13aa 1583 gFLAGS = gFLAGS & (~COM_MNG_TMTC_RUNNING_FLAG);\
shreeshas95 0:f016e9e8d48b 1584 break;\
shreeshas95 2:2caf2a9a13aa 1585 }\
shreeshas95 4:104dd82c99b8 1586 else if( gFLAGS & COM_PA_HOT_FLAG ){\
shreeshas95 4:104dd82c99b8 1587 /*PA HOT: WAIT FOR TIMEOUT*/\
shreeshas95 4:104dd82c99b8 1588 gCOM_PA_COOLING_TIMEOUT.attach(&after_cooling_pa, COM_PA_COOLING_TIME_LIMIT);\
shreeshas95 4:104dd82c99b8 1589 /*PENDING : POWER OFF COMM TX*/\
shreeshas95 4:104dd82c99b8 1590 RX1M.attach(&rx_read, Serial::RxIrq);\
shreeshas95 4:104dd82c99b8 1591 gFLAGS = gFLAGS & (~COM_MNG_TMTC_RUNNING_FLAG);\
shreeshas95 2:2caf2a9a13aa 1592 break;\
shreeshas95 2:2caf2a9a13aa 1593 }\
aniruddhv 12:ffdb29353058 1594 /*gPC.printf("successflly executed %u tc\r\n", execute_psc);*/\
shreeshas95 0:f016e9e8d48b 1595 }\
shreeshas95 6:79d422d1ed42 1596 if( (gMASTER_STATE == TCL_STATE_COMPLETED) || (gFLAGS & COM_SESSION_TIMEOUT_FLAG) ){\
aniruddhv 12:ffdb29353058 1597 /*gPC.printf("completed or session timed out: %x\r\n", gMASTER_STATE);*/\
shreeshas95 5:ab276a17ca07 1598 /*COMPLETED EXECUTION OF TC*/\
shreeshas95 5:ab276a17ca07 1599 gMASTER_STATE = TCL_STATE_COMPLETED;\
shreeshas95 5:ab276a17ca07 1600 COM_POWER_OFF_TX;\
shreeshas95 5:ab276a17ca07 1601 reset_all;\
shreeshas95 5:ab276a17ca07 1602 /*PENDING : ENABLE THREADS*/\
shreeshas95 5:ab276a17ca07 1603 gSESSION_TIMEOUT.detach();\
shreeshas95 5:ab276a17ca07 1604 gFLAGS = gFLAGS & (~COM_MNG_TMTC_RUNNING_FLAG);\
shreeshas95 5:ab276a17ca07 1605 gFLAGS = gFLAGS & (~COM_SESSION_FLAG);\
shreeshas95 5:ab276a17ca07 1606 }\
shreeshas95 0:f016e9e8d48b 1607 }