pl ack in tmtc

Dependencies:   FreescaleIAP SimpleDMA mbed-rtos mbed

Fork of COM_MNG_TMTC_SIMPLE_pl123 by shubham c

Committer:
shreeshas95
Date:
Fri Jan 29 17:09:41 2016 +0000
Revision:
102:80c911a6e736
Parent:
98:fd99ddc0e0a1
Child:
103:b55559925dc1
Changed Structures.h: removed Base_tm functions and corresponding errors everywhere

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