pl ack in tmtc

Dependencies:   FreescaleIAP SimpleDMA mbed-rtos mbed

Fork of COM_MNG_TMTC_SIMPLE_pl123 by shubham c

Committer:
ee12b079
Date:
Wed Feb 10 17:01:26 2016 +0000
Revision:
126:b7c024b5632d
Parent:
125:a3b95a9c16ef
Child:
128:a232a4352664
I2C code integrated, to be tested with PL

Who changed what in which revision?

UserRevisionLine numberNew contents of line
shreeshas95 0:f016e9e8d48b 1 // UART ISR
shreeshas95 0:f016e9e8d48b 2 void rx_read(){
shreeshas95 2:2caf2a9a13aa 3 gRX_CURRENT_DATA_NODE->values[gRX_COUNT] = RX1M.getc();
shreeshas95 2:2caf2a9a13aa 4 gFLAGS = gFLAGS | UART_INT_FLAG;
shreeshas95 0:f016e9e8d48b 5 gCOM_MNG_TMTC_THREAD->signal_set(COM_MNG_TMTC_SIGNAL_UART_INT);
shreeshas95 0:f016e9e8d48b 6 }
shreeshas95 0:f016e9e8d48b 7
shreeshas95 0:f016e9e8d48b 8 // RX_TIMEOUT ISR
shreeshas95 0:f016e9e8d48b 9 void after_receive(){
shreeshas95 0:f016e9e8d48b 10 gRX_TIMEOUT.detach();
shreeshas95 2:2caf2a9a13aa 11 gFLAGS = gFLAGS | NEW_TC_RECEIVED;
shreeshas95 0:f016e9e8d48b 12 gCOM_MNG_TMTC_THREAD->signal_set(COM_MNG_TMTC_SIGNAL_UART_INT);
shreeshas95 0:f016e9e8d48b 13 }
shreeshas95 0:f016e9e8d48b 14
shreeshas95 0:f016e9e8d48b 15 // SESSION_TIMOUT ISR
shreeshas95 0:f016e9e8d48b 16 void after_session(){
shreeshas95 0:f016e9e8d48b 17 gSESSION_TIMEOUT.detach();
shreeshas95 6:79d422d1ed42 18 gFLAGS = gFLAGS | COM_SESSION_TIMEOUT_FLAG;
shreeshas95 6:79d422d1ed42 19 if( gMASTER_STATE != TCL_STATE_EXECUTING ){
shreeshas95 6:79d422d1ed42 20 gCOM_MNG_TMTC_THREAD->signal_set(COM_MNG_TMTC_SIGNAL_UART_INT);
shreeshas95 6:79d422d1ed42 21 }
shreeshas95 0:f016e9e8d48b 22 }
shreeshas95 0:f016e9e8d48b 23
shreeshas95 0:f016e9e8d48b 24 #define reset_all {\
shreeshas95 0:f016e9e8d48b 25 Base_tc *tcp = gHEAD_NODE_TCL;\
aniruddhv 12:ffdb29353058 26 /*gPC.puts("inside reset\r\n");*/\
shreeshas95 5:ab276a17ca07 27 gFLAGS = 0x0000;\
shreeshas95 0:f016e9e8d48b 28 while(tcp != NULL){\
shreeshas95 0:f016e9e8d48b 29 Base_tc *temp = tcp->next_TC;\
shreeshas95 0:f016e9e8d48b 30 delete tcp;\
shreeshas95 0:f016e9e8d48b 31 tcp = temp;\
shreeshas95 0:f016e9e8d48b 32 }\
shreeshas95 5:ab276a17ca07 33 gHEAD_NODE_TCL = NULL;\
shreeshas95 5:ab276a17ca07 34 gLAST_NODE_TCL = NULL;\
shreeshas95 5:ab276a17ca07 35 gMASTER_STATE = TCL_STATE_INCOMPLETE;\
shreeshas95 0:f016e9e8d48b 36 gTOTAL_INCORRECT_SIZE_TC = 0;\
shreeshas95 0:f016e9e8d48b 37 gTOTAL_CRC_FAIL_TC = 0;\
shreeshas95 2:2caf2a9a13aa 38 gTOTAL_REPEATED_TC = 0;\
shreeshas95 5:ab276a17ca07 39 gTOTAL_VALID_TC = 0;\
shreeshas95 5:ab276a17ca07 40 for(int i = 0 ; i < TM_LONG_SIZE ; ++i){\
shreeshas95 5:ab276a17ca07 41 gLAST_TM[i] = 0x00;\
shreeshas95 5:ab276a17ca07 42 }\
shreeshas95 5:ab276a17ca07 43 gLAST_TM_SHORT_OR_LONG = SHORT_TM_CODE;\
shreeshas95 0:f016e9e8d48b 44 COM_RX_DATA_NODE *dataptr = gRX_HEAD_DATA_NODE;\
shreeshas95 0:f016e9e8d48b 45 while( dataptr != NULL ){\
shreeshas95 0:f016e9e8d48b 46 COM_RX_DATA_NODE *temp = dataptr->next_node;\
shreeshas95 0:f016e9e8d48b 47 delete dataptr;\
shreeshas95 0:f016e9e8d48b 48 dataptr = temp;\
shreeshas95 0:f016e9e8d48b 49 }\
shreeshas95 0:f016e9e8d48b 50 gRX_HEAD_DATA_NODE = new COM_RX_DATA_NODE;\
shreeshas95 0:f016e9e8d48b 51 gRX_HEAD_DATA_NODE->next_node = NULL;\
shreeshas95 0:f016e9e8d48b 52 gRX_CURRENT_DATA_NODE = gRX_HEAD_DATA_NODE;\
shreeshas95 0:f016e9e8d48b 53 gRX_COUNT = 0;\
shreeshas95 2:2caf2a9a13aa 54 /*PENDING : ALL GLOBAL VAARIABLES AND FLAGS*/\
aniruddhv 12:ffdb29353058 55 /*gPC.puts("finished reset all\r\n");*/\
shreeshas95 2:2caf2a9a13aa 56 }
shreeshas95 2:2caf2a9a13aa 57
shreeshas95 2:2caf2a9a13aa 58 #define PUT_RAW_BYTE {\
shreeshas95 2:2caf2a9a13aa 59 if( gRX_COUNT < (RX_BUFFER_LENGTH-1) ){\
shreeshas95 2:2caf2a9a13aa 60 ++gRX_COUNT;\
shreeshas95 2:2caf2a9a13aa 61 }\
shreeshas95 2:2caf2a9a13aa 62 else{\
shreeshas95 2:2caf2a9a13aa 63 gRX_COUNT = 0;\
shreeshas95 2:2caf2a9a13aa 64 gRX_CURRENT_DATA_NODE->next_node = new COM_RX_DATA_NODE;\
shreeshas95 2:2caf2a9a13aa 65 gRX_CURRENT_DATA_NODE = gRX_CURRENT_DATA_NODE->next_node;\
shreeshas95 2:2caf2a9a13aa 66 gRX_CURRENT_DATA_NODE->next_node = NULL;\
shreeshas95 2:2caf2a9a13aa 67 }\
shreeshas95 2:2caf2a9a13aa 68 gRX_TIMEOUT.attach(&after_receive, RX_TIMEOUT_LIMIT);\
shreeshas95 0:f016e9e8d48b 69 }
shreeshas95 0:f016e9e8d48b 70
shreeshas95 0:f016e9e8d48b 71 void COM_MNG_TMTC_FUN(void const *args){
shreeshas95 4:104dd82c99b8 72 if( !(gFLAGS & COM_SESSION_FLAG) ){
ee12b079 96:4ca92f9775e0 73 //gLEDR = 1;
ee12b079 96:4ca92f9775e0 74 //gLEDG = 1;
shreeshas95 4:104dd82c99b8 75 }
shreeshas95 0:f016e9e8d48b 76 while(true){
shreeshas95 0:f016e9e8d48b 77 Thread::signal_wait( COM_MNG_TMTC_SIGNAL_UART_INT );
shreeshas95 0:f016e9e8d48b 78 if( gFLAGS & UART_INT_FLAG ){
shreeshas95 0:f016e9e8d48b 79 gFLAGS = gFLAGS & (~UART_INT_FLAG);
shreeshas95 2:2caf2a9a13aa 80 if( !(gFLAGS & COM_SESSION_FLAG) ){
shreeshas95 2:2caf2a9a13aa 81 // PENDING : DISABLE THREADS
shreeshas95 2:2caf2a9a13aa 82 gFLAGS = gFLAGS | COM_SESSION_FLAG;
shreeshas95 2:2caf2a9a13aa 83 gSESSION_TIMEOUT.attach(&after_session, SESSION_TIME_LIMIT);
shreeshas95 2:2caf2a9a13aa 84 gFLAGS = gFLAGS | COM_RX_FLAG;
shreeshas95 2:2caf2a9a13aa 85 PUT_RAW_BYTE;
shreeshas95 2:2caf2a9a13aa 86 // PENDING : MEASURE RSSI
shreeshas95 4:104dd82c99b8 87 if( gFLAGS & COM_SESSION_FLAG ){
ee12b079 96:4ca92f9775e0 88 //gLEDR = 0;
ee12b079 96:4ca92f9775e0 89 //gLEDG = 0;
shreeshas95 4:104dd82c99b8 90 }
shreeshas95 2:2caf2a9a13aa 91 }
shreeshas95 2:2caf2a9a13aa 92 else if( gFLAGS & COM_RX_FLAG ){
ee12b079 96:4ca92f9775e0 93 //gLEDR = 0;
ee12b079 96:4ca92f9775e0 94 //gLEDG = 1;
shreeshas95 2:2caf2a9a13aa 95 PUT_RAW_BYTE;
shreeshas95 0:f016e9e8d48b 96 }
shreeshas95 0:f016e9e8d48b 97 else{
ee12b079 96:4ca92f9775e0 98 //gLEDR = 1;
ee12b079 96:4ca92f9775e0 99 //gLEDG = 0;
shreeshas95 2:2caf2a9a13aa 100 gFLAGS = gFLAGS | COM_RX_FLAG;
shreeshas95 2:2caf2a9a13aa 101 PUT_RAW_BYTE;
shreeshas95 0:f016e9e8d48b 102 }
shreeshas95 0:f016e9e8d48b 103 }
shreeshas95 4:104dd82c99b8 104 else if( gFLAGS & NEW_TC_RECEIVED ){
ee12b079 126:b7c024b5632d 105 #if DEBUG
ee12b079 98:fd99ddc0e0a1 106 gPC.puts("NEW TC RECEIVED\r\n");
ee12b079 126:b7c024b5632d 107 #endif
ee12b079 98:fd99ddc0e0a1 108 // DEBUF_PRINT("NEW TC RECEIVED\r\n");
ee12b079 125:a3b95a9c16ef 109 Thread::wait(10000); /*To be removed in flight model*/
shreeshas95 0:f016e9e8d48b 110 gFLAGS = gFLAGS & (~NEW_TC_RECEIVED);
shreeshas95 4:104dd82c99b8 111 gFLAGS = gFLAGS | COM_MNG_TMTC_RUNNING_FLAG;
shreeshas95 2:2caf2a9a13aa 112
shreeshas95 0:f016e9e8d48b 113 // DISABLE THE RX1M INTERRUPT
shreeshas95 0:f016e9e8d48b 114 RX1M.attach(NULL);
shreeshas95 0:f016e9e8d48b 115
shreeshas95 4:104dd82c99b8 116 // VERIFY CRC, REPEATED PSC AND UPDATE TOTAL_VALID_TC, INCORRECT SIZE TC, CRC FAIL TC
shreeshas95 2:2caf2a9a13aa 117 while(gRX_COUNT < (RX_BUFFER_LENGTH)){
shreeshas95 2:2caf2a9a13aa 118 gRX_CURRENT_DATA_NODE->values[gRX_COUNT] = 0x00;
shreeshas95 0:f016e9e8d48b 119 ++gRX_COUNT;
shreeshas95 0:f016e9e8d48b 120 }
shreeshas95 0:f016e9e8d48b 121 gRX_COUNT = 0;
shreeshas95 4:104dd82c99b8 122 raw_data_to_tc();
shreeshas95 6:79d422d1ed42 123 gFLAGS = gFLAGS & (~COM_RX_FLAG);
aniruddhv 51:da85d84768e2 124
shreeshas95 2:2caf2a9a13aa 125 if( gTOTAL_VALID_TC > 0 ){
aniruddhv 12:ffdb29353058 126 /*gPC.printf("valid TC rx: %u\r\n", gTOTAL_VALID_TC);*/
shreeshas95 4:104dd82c99b8 127 if( gTOTAL_VALID_TC < COM_MAX_TC_LIMIT ){
shreeshas95 4:104dd82c99b8 128 // CHECK WEATHER TC LIST HAS MISSING TC OR WEATHER LAST FRAME BIT IS HIGH IN THE LAST PSC-TC
aniruddhv 12:ffdb29353058 129 /*gPC.puts("checking for tc list complete\r\n");*/
shreeshas95 4:104dd82c99b8 130 uint8_t tempContinue = 0xFF;
shreeshas95 4:104dd82c99b8 131 continueToExecute(tempContinue);
shreeshas95 4:104dd82c99b8 132 if(tempContinue == 0x00){
aniruddhv 12:ffdb29353058 133 /*gPC.puts("tc list is complete\r\n");*/
shreeshas95 4:104dd82c99b8 134 // CHECK WEATHER GS VERIFICATION CODE MATCHES
shreeshas95 4:104dd82c99b8 135 uint8_t tempGSver = 0x00;
shreeshas95 4:104dd82c99b8 136 GScodeVerification(tempGSver);
shreeshas95 5:ab276a17ca07 137 /*PENDING: INCLUDE GS VERIFICATION CODE*/
aniruddhv 37:c9a739750806 138 if( tempGSver == 0xFF ){
aniruddhv 37:c9a739750806 139 /*gPC.puts("GS code match !!\r\n");*/
shreeshas95 4:104dd82c99b8 140 gFLAGS = gFLAGS | COM_SESSION_VALIDITY;
shreeshas95 4:104dd82c99b8 141 COM_POWER_ON_TX;
shreeshas95 4:104dd82c99b8 142 // PENDING: PA HOT HANDLED IN EXECUTE_XXX FUNCTIONS
shreeshas95 4:104dd82c99b8 143 uint8_t tempPAHot = 0x00;
shreeshas95 4:104dd82c99b8 144 isPAhot(tempPAHot);
shreeshas95 4:104dd82c99b8 145 if( tempPAHot == 0xFF ){
shreeshas95 6:79d422d1ed42 146 gFLAGS = gFLAGS & ~(COM_PA_HOT_FLAG);
shreeshas95 6:79d422d1ed42 147 gCOM_PA_COOLING_TIMEOUT.detach();
ee12b079 126:b7c024b5632d 148 #if DEBUG
ee12b079 98:fd99ddc0e0a1 149 gPC.puts("EXECUTING TELECOMMANDS\r\n");
ee12b079 126:b7c024b5632d 150 #endif
ee12b079 98:fd99ddc0e0a1 151 // DEBUF_PRINT("EXECUTING TELECOMMANDS\r\n");
shreeshas95 4:104dd82c99b8 152 EXECUTE_OBOSC_ONLY;
shreeshas95 4:104dd82c99b8 153 EXECUTE_TC;
aniruddhv 12:ffdb29353058 154 /*gPC.puts("COMPLETED EXECUTION\r\n");*/
shreeshas95 4:104dd82c99b8 155 }
shreeshas95 4:104dd82c99b8 156 else{
shreeshas95 4:104dd82c99b8 157 gFLAGS = gFLAGS | COM_PA_HOT_FLAG;
shreeshas95 6:79d422d1ed42 158 // PENDING: power off transmitter only
shreeshas95 6:79d422d1ed42 159 gCOM_PA_COOLING_TIMEOUT.attach(&after_cooling_pa, COM_PA_COOLING_TIME_LIMIT);
shreeshas95 6:79d422d1ed42 160 gFLAGS = gFLAGS & (~COM_MNG_TMTC_RUNNING_FLAG);
shreeshas95 4:104dd82c99b8 161 RX1M.attach(&rx_read, Serial::RxIrq);
shreeshas95 4:104dd82c99b8 162 }
shreeshas95 4:104dd82c99b8 163 }
shreeshas95 4:104dd82c99b8 164 else{
aniruddhv 12:ffdb29353058 165 /*gPC.puts("GS code mismatch !!\r\n");*/
shreeshas95 6:79d422d1ed42 166 RX1M.attach(&rx_read, Serial::RxIrq);
shreeshas95 4:104dd82c99b8 167 reset_all;
shreeshas95 4:104dd82c99b8 168 gFLAGS = gFLAGS & (~COM_SESSION_VALIDITY);
shreeshas95 4:104dd82c99b8 169 // PENDING : ENABLE THREADS
shreeshas95 4:104dd82c99b8 170 gSESSION_TIMEOUT.detach();
shreeshas95 4:104dd82c99b8 171 gFLAGS = gFLAGS & (~COM_SESSION_FLAG);
shreeshas95 4:104dd82c99b8 172 // WARNING: clear COM_MNG_TMTC ?
shreeshas95 4:104dd82c99b8 173 }
shreeshas95 0:f016e9e8d48b 174 }
shreeshas95 2:2caf2a9a13aa 175 else{
aniruddhv 69:20f09a0c3fd2 176 //gPC.puts("tc list is not complete\r\n");
shreeshas95 5:ab276a17ca07 177 if(tempContinue & 0x01){
aniruddhv 69:20f09a0c3fd2 178 //gPC.puts("last packet bit not found\r\n");
shreeshas95 5:ab276a17ca07 179 }
shreeshas95 5:ab276a17ca07 180 if( tempContinue & 0x02 ){
aniruddhv 69:20f09a0c3fd2 181 //gPC.puts("missing psc found\r\n");
shreeshas95 5:ab276a17ca07 182 }
aniruddhv 69:20f09a0c3fd2 183 //gPC.printf("crc fail tc = %u\r\n", gTOTAL_CRC_FAIL_TC);
aniruddhv 69:20f09a0c3fd2 184 //gPC.printf("incorrect size tc = %u\r\n", gTOTAL_INCORRECT_SIZE_TC);
aniruddhv 69:20f09a0c3fd2 185 //gPC.printf("repeated psc = %u\r\n", gTOTAL_REPEATED_TC);
shreeshas95 5:ab276a17ca07 186 Base_tc *test_tc = gHEAD_NODE_TCL;
shreeshas95 5:ab276a17ca07 187 while( test_tc != NULL ){
shreeshas95 5:ab276a17ca07 188 int length = 0;
shreeshas95 5:ab276a17ca07 189 if( GETshort_or_long_tc(test_tc) == SHORT_TC_CODE ){
shreeshas95 5:ab276a17ca07 190 length = TC_SHORT_SIZE;
shreeshas95 5:ab276a17ca07 191 }
shreeshas95 5:ab276a17ca07 192 else{
shreeshas95 5:ab276a17ca07 193 length = TC_LONG_SIZE;
shreeshas95 5:ab276a17ca07 194 }
rohit3342 16:538de1b20b3a 195 for(int i = 0 ; i < length ; ++i ){
aniruddhv 69:20f09a0c3fd2 196 //gPC.printf("%x ", test_tc->TC_string[i]);
shreeshas95 5:ab276a17ca07 197 }
aniruddhv 69:20f09a0c3fd2 198 //gPC.puts("\r\n");
shreeshas95 5:ab276a17ca07 199 test_tc = test_tc->next_TC;
shreeshas95 5:ab276a17ca07 200 }
aniruddhv 69:20f09a0c3fd2 201 //gPC.puts("\r\n");
shreeshas95 4:104dd82c99b8 202 COM_POWER_ON_TX;
shreeshas95 4:104dd82c99b8 203 // PENDING : POWER OFF TX
shreeshas95 4:104dd82c99b8 204 RX1M.attach(&rx_read, Serial::RxIrq);
shreeshas95 4:104dd82c99b8 205 gFLAGS = gFLAGS & (~COM_MNG_TMTC_RUNNING_FLAG);
shreeshas95 2:2caf2a9a13aa 206 }
shreeshas95 0:f016e9e8d48b 207 }
shreeshas95 0:f016e9e8d48b 208 else{
shreeshas95 4:104dd82c99b8 209 COM_POWER_ON_TX;
shreeshas95 6:79d422d1ed42 210 // POWER OFF TX transmitter only
shreeshas95 4:104dd82c99b8 211 // WARNING: reset_all ? clear com_session ?
shreeshas95 2:2caf2a9a13aa 212 RX1M.attach(&rx_read, Serial::RxIrq);
shreeshas95 4:104dd82c99b8 213 gFLAGS = gFLAGS & (~COM_MNG_TMTC_RUNNING_FLAG);
shreeshas95 0:f016e9e8d48b 214 }
shreeshas95 2:2caf2a9a13aa 215 }
shreeshas95 4:104dd82c99b8 216 else{
aniruddhv 12:ffdb29353058 217 /*gPC.puts("No valid TC received\r\n");*/
shreeshas95 2:2caf2a9a13aa 218 RX1M.attach(&rx_read, Serial::RxIrq);
shreeshas95 4:104dd82c99b8 219 gFLAGS = gFLAGS & (~COM_MNG_TMTC_RUNNING_FLAG);
shreeshas95 6:79d422d1ed42 220 reset_all;
shreeshas95 6:79d422d1ed42 221 // PENDING : ENABLE THREADS
shreeshas95 6:79d422d1ed42 222 gSESSION_TIMEOUT.detach();
shreeshas95 6:79d422d1ed42 223 gFLAGS = gFLAGS & (~COM_SESSION_FLAG);
shreeshas95 2:2caf2a9a13aa 224 }
shreeshas95 2:2caf2a9a13aa 225 }
shreeshas95 2:2caf2a9a13aa 226 else if( gFLAGS & COM_PA_HOT_FLAG ){
aniruddhv 12:ffdb29353058 227 /*gPC.puts("checking for PA hot in main\r\n");*/
shreeshas95 6:79d422d1ed42 228 if( gFLAGS & COM_RX_FLAG ){
shreeshas95 6:79d422d1ed42 229 uint8_t tempPA = 0xFF;
shreeshas95 6:79d422d1ed42 230 isPAhot(tempPA);
shreeshas95 6:79d422d1ed42 231 if( tempPA == 0x00 ){
shreeshas95 6:79d422d1ed42 232 gCOM_PA_COOLING_TIMEOUT.attach(&after_cooling_pa, COM_PA_COOLING_TIME_LIMIT);
shreeshas95 6:79d422d1ed42 233 }
shreeshas95 6:79d422d1ed42 234 else{
shreeshas95 6:79d422d1ed42 235 gFLAGS = gFLAGS & ~(COM_PA_HOT_FLAG);
shreeshas95 6:79d422d1ed42 236 gCOM_PA_COOLING_TIMEOUT.detach();
shreeshas95 6:79d422d1ed42 237 }
shreeshas95 0:f016e9e8d48b 238 }
shreeshas95 0:f016e9e8d48b 239 else{
shreeshas95 6:79d422d1ed42 240 uint8_t tempPA = 0xFF;
shreeshas95 6:79d422d1ed42 241 isPAhot(tempPA);
shreeshas95 6:79d422d1ed42 242 if( tempPA == 0x00 ){
shreeshas95 6:79d422d1ed42 243 gCOM_PA_COOLING_TIMEOUT.attach(&after_cooling_pa, COM_PA_COOLING_TIME_LIMIT);
shreeshas95 6:79d422d1ed42 244 }
shreeshas95 6:79d422d1ed42 245 else{
aniruddhv 12:ffdb29353058 246 /*gPC.puts("PA IS COOLED DOWN\r\n");*/
shreeshas95 6:79d422d1ed42 247 gFLAGS = gFLAGS & (~COM_PA_HOT_FLAG);
shreeshas95 6:79d422d1ed42 248 gFLAGS = gFLAGS | COM_MNG_TMTC_RUNNING_FLAG;
shreeshas95 6:79d422d1ed42 249 RX1M.attach(NULL);
shreeshas95 6:79d422d1ed42 250 gCOM_PA_COOLING_TIMEOUT.detach();
shreeshas95 6:79d422d1ed42 251 COM_POWER_ON_TX;
shreeshas95 6:79d422d1ed42 252 EXECUTE_OBOSC_ONLY;
shreeshas95 6:79d422d1ed42 253 EXECUTE_TC;
shreeshas95 6:79d422d1ed42 254 }
shreeshas95 0:f016e9e8d48b 255 }
shreeshas95 2:2caf2a9a13aa 256 }
shreeshas95 6:79d422d1ed42 257 else if( gFLAGS & COM_SESSION_TIMEOUT_FLAG ){
aniruddhv 12:ffdb29353058 258 /*gPC.puts("session timeout: resetting in main\r\n");*/
shreeshas95 6:79d422d1ed42 259 COM_POWER_OFF_TX;
shreeshas95 6:79d422d1ed42 260 /*PENDING : ENABLE THREADS*/
shreeshas95 6:79d422d1ed42 261 gSESSION_TIMEOUT.detach();
shreeshas95 6:79d422d1ed42 262 gFLAGS = gFLAGS & (~COM_MNG_TMTC_RUNNING_FLAG);
shreeshas95 6:79d422d1ed42 263 gFLAGS = gFLAGS & (~COM_SESSION_FLAG);
shreeshas95 6:79d422d1ed42 264 reset_all;
shreeshas95 6:79d422d1ed42 265 }
shreeshas95 2:2caf2a9a13aa 266 else{
aniruddhv 12:ffdb29353058 267 /*gPC.puts("INVALID SIGNAL RECEIVED IN MAIN\r\n");*/
shreeshas95 2:2caf2a9a13aa 268 // SOME INVALID SIGNAL RECEIVED
shreeshas95 4:104dd82c99b8 269 COM_POWER_OFF_TX;
shreeshas95 2:2caf2a9a13aa 270 reset_all;
shreeshas95 2:2caf2a9a13aa 271 // PENDING : ENABLE THREADS
shreeshas95 2:2caf2a9a13aa 272 gSESSION_TIMEOUT.detach();
shreeshas95 2:2caf2a9a13aa 273 gFLAGS = gFLAGS & (~COM_SESSION_FLAG);
shreeshas95 0:f016e9e8d48b 274 }
shreeshas95 0:f016e9e8d48b 275 }
shreeshas95 3:6c81fc8834e2 276 }
shreeshas95 3:6c81fc8834e2 277
shreeshas95 101:bece931236a2 278 void payload_isr_fun(){
shreeshas95 101:bece931236a2 279 gSCIENCE_THREAD->signal_set(SCIENCE_SIGNAL);
shreeshas95 101:bece931236a2 280 }
ee12b079 93:4d76de54a699 281
ee12b079 96:4ca92f9775e0 282 void SCIENCE_FUN(void const *args){
ee12b079 96:4ca92f9775e0 283
shreeshas95 101:bece931236a2 284 // initialisation of payload spi
shreeshas95 101:bece931236a2 285 gPAY_SPI.frequency(1000000);
shreeshas95 101:bece931236a2 286 gPAY_SPI.format(8,0);
shreeshas95 101:bece931236a2 287 gPAY_SPI.bulkRead_init(gPAYLOAD_BUFFER, PAYLOAD_BUFFER_LENGTH, &payload_isr_fun);
shreeshas95 101:bece931236a2 288 gPAY_SPI.bulkRead_start();
ee12b079 96:4ca92f9775e0 289
ee12b079 97:717c7908c822 290 while(true){
ee12b079 126:b7c024b5632d 291 #if DEBUG
ee12b079 98:fd99ddc0e0a1 292 gPC.puts("entering sci\r\n");
ee12b079 126:b7c024b5632d 293 #endif
ee12b079 97:717c7908c822 294 gSCIENCE_THREAD->signal_wait(SCIENCE_SIGNAL);
ee12b079 126:b7c024b5632d 295 #if DEBUG
ee12b079 98:fd99ddc0e0a1 296 gPC.puts("sig_set\r\n");
ee12b079 126:b7c024b5632d 297 #endif
shreeshas95 101:bece931236a2 298 srp(gPAYLOAD_BUFFER);
ee12b079 126:b7c024b5632d 299 #if DEBUG
ee12b079 98:fd99ddc0e0a1 300 gPC.puts("exit_srp\r\n");
ee12b079 126:b7c024b5632d 301 #endif
shreeshas95 101:bece931236a2 302 gPAY_SPI.bulkRead_start();
ee12b079 97:717c7908c822 303 }
ee12b079 126:b7c024b5632d 304 }
ee12b079 126:b7c024b5632d 305
ee12b079 126:b7c024b5632d 306 //I2C from CDMS to PL
ee12b079 126:b7c024b5632d 307 const int addr1 = (0x20<<1|0);
ee12b079 126:b7c024b5632d 308
ee12b079 126:b7c024b5632d 309 bool f = 1;
ee12b079 126:b7c024b5632d 310
ee12b079 126:b7c024b5632d 311 void isr_pyldtm()
ee12b079 126:b7c024b5632d 312 {
ee12b079 126:b7c024b5632d 313 ptr_t_pyldtm->signal_set(0x4);
ee12b079 126:b7c024b5632d 314 }
ee12b079 126:b7c024b5632d 315
ee12b079 126:b7c024b5632d 316 char rdata[134];
ee12b079 126:b7c024b5632d 317 void pyldtm(void const *args)
ee12b079 126:b7c024b5632d 318 {
ee12b079 126:b7c024b5632d 319 while(1)
ee12b079 126:b7c024b5632d 320 {
ee12b079 126:b7c024b5632d 321 Thread::signal_wait(0x4);
ee12b079 126:b7c024b5632d 322 f= master.read(addr1,rdata,134);
ee12b079 126:b7c024b5632d 323 }
shreeshas95 101:bece931236a2 324 }