samp Srinivasan / Mbed 2 deprecated CDMS_CODE_FM_28JAN2017

FM

Dependencies:   SimpleDMA eeprom mbed-rtos mbed FreescaleIAP

Fork of CDMS_CODE by shubham c

ThreadsAndFunctions.h@353:e1803e801e20, 2017-02-21 (annotated)

Committer:
samp1234
Date:
Tue Feb 21 06:30:56 2017 +0000
Revision:
353:e1803e801e20
Parent:
352:022c513aee03
Child:
354:0da912441c7b
with all final changes

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ee12b079 173:f81ded27423d 1 //Science Thread
ee12b079 173:f81ded27423d 2 //SPI ISR
ee12b079 321:42bdefc37270 3
ee12b079 321:42bdefc37270 4 #include "COM_MNG_TMTC.h"
ee12b079 321:42bdefc37270 5 #include "adf.h"
ee12b079 338:d63eb331a67d 6 #include "dmaSPIslave.h"
ee12b079 338:d63eb331a67d 7
ee12b079 338:d63eb331a67d 8 dmaSPISlave *gPAY_SPI;
ee12b079 338:d63eb331a67d 9
ee12b079 173:f81ded27423d 10 void payload_isr_fun(){
ee12b079 173:f81ded27423d 11 gSCIENCE_THREAD->signal_set(SCIENCE_SIGNAL);
samp1234 346:204497974293 12
ee12b079 173:f81ded27423d 13 }
ee12b079 173:f81ded27423d 14
ee12b079 191:0636c8391407 15 void payload_isr_fun_dma(void const *args ){
ee12b079 191:0636c8391407 16 gSCIENCE_THREAD->signal_set(SCIENCE_SIGNAL);
ee12b079 191:0636c8391407 17 }
ee12b079 192:f0d5fde60221 18
ee12b079 173:f81ded27423d 19 void SCIENCE_FUN(void const *args){
spacelab 308:7c3872365d58 20 // gPAY_SPI->frequency(1000000); //1000000
spacelab 308:7c3872365d58 21 gPAY_SPI->format(8,0);
chaithanyarss 290:3159ff1081a2 22 gPC.printf("\n\rTest...........................");
ee12b079 245:da9d1bd999da 23 gPAY_SPI->bulkRead_init(gPAYLOAD_BUFFER, PAYLOAD_BUFFER_LENGTH, &payload_isr_fun);
chaithanyarss 303:b49b486a7107 24 gPAY_SPI->bulkRead_start();
spacelab 309:6ed5535ac465 25
ee12b079 295:699801854b71 26 //AY_SPI->bulkRead_pause();
ee12b079 295:699801854b71 27 //AY_SPI->bulkRead_resume(&payload_isr_fun);
ee12b079 173:f81ded27423d 28 while(true){
ee12b079 342:77b0d59897f7 29 gPC.printf("waiting for Sci sig\n\r");
ee12b079 173:f81ded27423d 30 gSCIENCE_THREAD->signal_wait(SCIENCE_SIGNAL);
samp1234 346:204497974293 31
ee12b079 342:77b0d59897f7 32 gPC.printf("checking mutex in Sci\n\r");
ee12b079 342:77b0d59897f7 33 gMutex.lock();
samp1234 346:204497974293 34
ee12b079 342:77b0d59897f7 35 gPC.printf("locked mutex,entered in Sci thread\n\r");
samp1234 346:204497974293 36
samp1234 346:204497974293 37 DMA_LED1 = 1;
chaithanyarss 290:3159ff1081a2 38 PL_RCV_SC_DATA_STATUS = 1;
spacelab 308:7c3872365d58 39 //gPC.puts("sig_set\r\n");
ee12b079 288:aa93d6652381 40 //for(int i =0; i<PAYLOAD_BUFFER_LENGTH; i++)
ee12b079 295:699801854b71 41 //if (gPAYLOAD_BUFFER[i] != 0x01) gPC.printf("%d = 0x%02X\n\r",i,gPAYLOAD_BUFFER[i]);
chaithanyarss 290:3159ff1081a2 42 //gPAY_SPI->bulkRead_start();
spacelab 309:6ed5535ac465 43 // srp(gPAYLOAD_BUFFER);//skip one apcket when cdms resets
spacelab 308:7c3872365d58 44 //gPC.puts("exit_srp\r\n");
spacelab 308:7c3872365d58 45 //wait(2);/*timeout to be decided*/
ee12b079 252:9c631b2f5da8 46 if(dma)
chaithanyarss 290:3159ff1081a2 47 {
samp1234 346:204497974293 48 // TIME_LATEST_I2C_SPEED = FCTN_CDMS_RD_RTC() >> 7;
chaithanyarss 303:b49b486a7107 49 PL_RCV_SC_DATA_COUNTER++;
chaithanyarss 290:3159ff1081a2 50 gPAY_SPI->bulkRead_start();
samp1234 346:204497974293 51 // DMA_LED1 = !DMA_LED1; // added by samp
ee12b079 292:61aa2169ea1c 52 //gPAY_SPI->bulkRead_pause();
ee12b079 292:61aa2169ea1c 53 //gPAY_SPI->bulkRead_resume(&payload_isr_fun);
chaithanyarss 290:3159ff1081a2 54 }
spacelab 309:6ed5535ac465 55 // DMA_LED1 = !DMA_LED1; // added by samp
samp1234 353:e1803e801e20 56 //__disable_irq();
spacelab 309:6ed5535ac465 57 srp(gPAYLOAD_BUFFER);//skip one apcket when cdms resets
samp1234 311:af5ab655ba00 58
samp1234 346:204497974293 59 uint8_t sd_stat1 = 0;
samp1234 346:204497974293 60 if(BAE_HK_SD_DATA_READY==1)
samp1234 346:204497974293 61 {
samp1234 346:204497974293 62 for(int i=0; i<288; i++)
samp1234 346:204497974293 63 BAE_HEALTH_FINAL[i] = interleave_BAE_HK[i];
samp1234 346:204497974293 64 sd_stat1 = SD_WRITE(BAE_HEALTH_FINAL,FSC_CURRENT[5]+1,5);
samp1234 346:204497974293 65 if(sd_stat1) {
samp1234 346:204497974293 66 gPC.puts("BAE_HK sd write fail");
samp1234 346:204497974293 67 //break;
samp1234 346:204497974293 68 }
samp1234 346:204497974293 69
samp1234 346:204497974293 70 }
samp1234 346:204497974293 71 BAE_HK_SD_DATA_READY = 0;
samp1234 346:204497974293 72 if(CDMS_HK_SD_DATA_READY==1)
samp1234 346:204497974293 73 {
samp1234 346:204497974293 74 for(int i=0; i<288; i++)
samp1234 346:204497974293 75 CDMS_HEALTH_FINAL[i] = interleave_CDMS_HK[i];
samp1234 346:204497974293 76 //gPC.printf("\n\r reached here");
samp1234 346:204497974293 77 sd_stat1 = SD_WRITE(CDMS_HEALTH_FINAL,FSC_CURRENT[4]+1,4);
samp1234 346:204497974293 78
samp1234 346:204497974293 79 if(sd_stat1) {
samp1234 346:204497974293 80 gPC.puts("sd write failure $*&^@!~!");
samp1234 346:204497974293 81 }
samp1234 346:204497974293 82 }
samp1234 346:204497974293 83 CDMS_HK_SD_DATA_READY= 0;
chaithanyarss 290:3159ff1081a2 84 /*else
chaithanyarss 290:3159ff1081a2 85 gPC.printf("\n\rDMA error");*/
ee12b079 342:77b0d59897f7 86 gPC.printf("\r\nreleasing mutex for Sci\n\r");
samp1234 346:204497974293 87 DMA_LED1 =0;
samp1234 353:e1803e801e20 88 //__enable_irq();
spacelab 309:6ed5535ac465 89 gMutex.unlock();
ee12b079 173:f81ded27423d 90 }
ee12b079 173:f81ded27423d 91 }
ee12b079 173:f81ded27423d 92
ee12b079 245:da9d1bd999da 93 //HK Thread(Contains HK_main() and PL_main())
ee12b079 245:da9d1bd999da 94 //RTOS timer calllback func
ee12b079 245:da9d1bd999da 95 void hk_isr(void const *args){
samp1234 346:204497974293 96 //gPC.printf("\r\n HK isr \n\r");
ee12b079 246:565458eefd94 97 gHK_THREAD->signal_set(HK_SIGNAL);
samp1234 346:204497974293 98 // gPC.printf("\r\n HK 1 \n\r");
ee12b079 245:da9d1bd999da 99 }
ee12b079 245:da9d1bd999da 100
ee12b079 245:da9d1bd999da 101
ee12b079 173:f81ded27423d 102 //COM THREAD
shreeshas95 0:f016e9e8d48b 103 // UART ISR
shreeshas95 0:f016e9e8d48b 104 void rx_read(){
shreeshas95 2:2caf2a9a13aa 105 gRX_CURRENT_DATA_NODE->values[gRX_COUNT] = RX1M.getc();
ee12b079 338:d63eb331a67d 106 //Checking RSSI
ee12b079 338:d63eb331a67d 107 if(!COM_RSSI_SET)
ee12b079 338:d63eb331a67d 108 RSSI_VOLTAGE = COMRX_RSSI_VOLTAGE.read() * 3.3;//to be checked
ee12b079 338:d63eb331a67d 109 COM_RSSI_SET = 1;
shreeshas95 2:2caf2a9a13aa 110 gFLAGS = gFLAGS | UART_INT_FLAG;
shreeshas95 0:f016e9e8d48b 111 gCOM_MNG_TMTC_THREAD->signal_set(COM_MNG_TMTC_SIGNAL_UART_INT);
shreeshas95 0:f016e9e8d48b 112 }
shreeshas95 0:f016e9e8d48b 113
aniruddhv 262:752c8689944a 114 // COM_RX_DISABLE ISR
aniruddhv 262:752c8689944a 115 void after_com_disable(){
aniruddhv 262:752c8689944a 116 gCOM_RX_DISABLE.detach();
aniruddhv 262:752c8689944a 117 RX1M.attach(&rx_read, Serial::RxIrq);
aniruddhv 262:752c8689944a 118 }
aniruddhv 262:752c8689944a 119
shreeshas95 0:f016e9e8d48b 120 // RX_TIMEOUT ISR
shreeshas95 0:f016e9e8d48b 121 void after_receive(){
shreeshas95 0:f016e9e8d48b 122 gRX_TIMEOUT.detach();
shreeshas95 2:2caf2a9a13aa 123 gFLAGS = gFLAGS | NEW_TC_RECEIVED;
shreeshas95 0:f016e9e8d48b 124 gCOM_MNG_TMTC_THREAD->signal_set(COM_MNG_TMTC_SIGNAL_UART_INT);
shreeshas95 0:f016e9e8d48b 125 }
shreeshas95 0:f016e9e8d48b 126
shreeshas95 0:f016e9e8d48b 127 // SESSION_TIMOUT ISR
shreeshas95 0:f016e9e8d48b 128 void after_session(){
shreeshas95 0:f016e9e8d48b 129 gSESSION_TIMEOUT.detach();
shreeshas95 6:79d422d1ed42 130 gFLAGS = gFLAGS | COM_SESSION_TIMEOUT_FLAG;
ee12b079 338:d63eb331a67d 131 //if( gMASTER_STATE != TCL_STATE_EXECUTING ){
shreeshas95 6:79d422d1ed42 132 gCOM_MNG_TMTC_THREAD->signal_set(COM_MNG_TMTC_SIGNAL_UART_INT);
ee12b079 338:d63eb331a67d 133 //}
shreeshas95 0:f016e9e8d48b 134 }
shreeshas95 0:f016e9e8d48b 135
shreeshas95 0:f016e9e8d48b 136 #define reset_all {\
shreeshas95 0:f016e9e8d48b 137 Base_tc *tcp = gHEAD_NODE_TCL;\
aniruddhv 12:ffdb29353058 138 /*gPC.puts("inside reset\r\n");*/\
shreeshas95 5:ab276a17ca07 139 gFLAGS = 0x0000;\
shreeshas95 0:f016e9e8d48b 140 while(tcp != NULL){\
shreeshas95 0:f016e9e8d48b 141 Base_tc *temp = tcp->next_TC;\
shreeshas95 0:f016e9e8d48b 142 delete tcp;\
shreeshas95 0:f016e9e8d48b 143 tcp = temp;\
shreeshas95 0:f016e9e8d48b 144 }\
shreeshas95 5:ab276a17ca07 145 gHEAD_NODE_TCL = NULL;\
shreeshas95 5:ab276a17ca07 146 gLAST_NODE_TCL = NULL;\
aniruddhv 262:752c8689944a 147 gMASTER_STATE = TCL_STATE_COMPLETED;\
shreeshas95 0:f016e9e8d48b 148 gTOTAL_INCORRECT_SIZE_TC = 0;\
shreeshas95 0:f016e9e8d48b 149 gTOTAL_CRC_FAIL_TC = 0;\
shreeshas95 2:2caf2a9a13aa 150 gTOTAL_REPEATED_TC = 0;\
shreeshas95 5:ab276a17ca07 151 gTOTAL_VALID_TC = 0;\
shreeshas95 5:ab276a17ca07 152 for(int i = 0 ; i < TM_LONG_SIZE ; ++i){\
aniruddhv 262:752c8689944a 153 /*gLAST_TM[i] = 0x00;*/\
shreeshas95 5:ab276a17ca07 154 }\
aniruddhv 262:752c8689944a 155 /*gLAST_TM_SHORT_OR_LONG = SHORT_TM_CODE;*/\
shreeshas95 0:f016e9e8d48b 156 COM_RX_DATA_NODE *dataptr = gRX_HEAD_DATA_NODE;\
shreeshas95 0:f016e9e8d48b 157 while( dataptr != NULL ){\
shreeshas95 0:f016e9e8d48b 158 COM_RX_DATA_NODE *temp = dataptr->next_node;\
shreeshas95 0:f016e9e8d48b 159 delete dataptr;\
shreeshas95 0:f016e9e8d48b 160 dataptr = temp;\
shreeshas95 0:f016e9e8d48b 161 }\
shreeshas95 0:f016e9e8d48b 162 gRX_HEAD_DATA_NODE = new COM_RX_DATA_NODE;\
shreeshas95 0:f016e9e8d48b 163 gRX_HEAD_DATA_NODE->next_node = NULL;\
shreeshas95 0:f016e9e8d48b 164 gRX_CURRENT_DATA_NODE = gRX_HEAD_DATA_NODE;\
shreeshas95 0:f016e9e8d48b 165 gRX_COUNT = 0;\
aniruddhv 262:752c8689944a 166 gTOTAL_RAW_BYTES = 0;\
shreeshas95 2:2caf2a9a13aa 167 /*PENDING : ALL GLOBAL VAARIABLES AND FLAGS*/\
aniruddhv 12:ffdb29353058 168 /*gPC.puts("finished reset all\r\n");*/\
shreeshas95 2:2caf2a9a13aa 169 }
shreeshas95 2:2caf2a9a13aa 170
shreeshas95 2:2caf2a9a13aa 171 #define PUT_RAW_BYTE {\
shreeshas95 2:2caf2a9a13aa 172 if( gRX_COUNT < (RX_BUFFER_LENGTH-1) ){\
shreeshas95 2:2caf2a9a13aa 173 ++gRX_COUNT;\
shreeshas95 2:2caf2a9a13aa 174 }\
shreeshas95 2:2caf2a9a13aa 175 else{\
shreeshas95 2:2caf2a9a13aa 176 gRX_COUNT = 0;\
shreeshas95 2:2caf2a9a13aa 177 gRX_CURRENT_DATA_NODE->next_node = new COM_RX_DATA_NODE;\
shreeshas95 2:2caf2a9a13aa 178 gRX_CURRENT_DATA_NODE = gRX_CURRENT_DATA_NODE->next_node;\
shreeshas95 2:2caf2a9a13aa 179 gRX_CURRENT_DATA_NODE->next_node = NULL;\
shreeshas95 2:2caf2a9a13aa 180 }\
aniruddhv 262:752c8689944a 181 ++gTOTAL_RAW_BYTES;\
shreeshas95 2:2caf2a9a13aa 182 gRX_TIMEOUT.attach(&after_receive, RX_TIMEOUT_LIMIT);\
shreeshas95 0:f016e9e8d48b 183 }
shreeshas95 0:f016e9e8d48b 184
shreeshas95 0:f016e9e8d48b 185 void COM_MNG_TMTC_FUN(void const *args){
shreeshas95 4:104dd82c99b8 186 if( !(gFLAGS & COM_SESSION_FLAG) ){
ee12b079 96:4ca92f9775e0 187 //gLEDR = 1;
ee12b079 96:4ca92f9775e0 188 //gLEDG = 1;
shreeshas95 4:104dd82c99b8 189 }
shreeshas95 0:f016e9e8d48b 190 while(true){
shreeshas95 0:f016e9e8d48b 191 Thread::signal_wait( COM_MNG_TMTC_SIGNAL_UART_INT );
shreeshas95 0:f016e9e8d48b 192 if( gFLAGS & UART_INT_FLAG ){
shreeshas95 0:f016e9e8d48b 193 gFLAGS = gFLAGS & (~UART_INT_FLAG);
shreeshas95 2:2caf2a9a13aa 194 if( !(gFLAGS & COM_SESSION_FLAG) ){
aniruddhv 263:3b872778b8c7 195 // DISABLE THREADS
ee12b079 254:22d97475ca79 196 HK_counter->stop();
ee12b079 245:da9d1bd999da 197 gPAY_SPI->bulkRead_pause();
samp1234 353:e1803e801e20 198 PL_GPIO_3_STATUS=1;
shreeshas95 2:2caf2a9a13aa 199 gFLAGS = gFLAGS | COM_SESSION_FLAG;
ee12b079 338:d63eb331a67d 200 gSESSION_TIMEOUT.attach(&after_session, COM_SESSION_TIMEOUT);
shreeshas95 2:2caf2a9a13aa 201 gFLAGS = gFLAGS | COM_RX_FLAG;
aniruddhv 262:752c8689944a 202 gTOTAL_RAW_BYTES = 0;
shreeshas95 2:2caf2a9a13aa 203 PUT_RAW_BYTE;
shreeshas95 2:2caf2a9a13aa 204 // PENDING : MEASURE RSSI
shreeshas95 4:104dd82c99b8 205 if( gFLAGS & COM_SESSION_FLAG ){
ee12b079 96:4ca92f9775e0 206 //gLEDR = 0;
ee12b079 96:4ca92f9775e0 207 //gLEDG = 0;
shreeshas95 4:104dd82c99b8 208 }
shreeshas95 2:2caf2a9a13aa 209 }
shreeshas95 2:2caf2a9a13aa 210 else if( gFLAGS & COM_RX_FLAG ){
ee12b079 96:4ca92f9775e0 211 //gLEDR = 0;
ee12b079 96:4ca92f9775e0 212 //gLEDG = 1;
shreeshas95 2:2caf2a9a13aa 213 PUT_RAW_BYTE;
shreeshas95 0:f016e9e8d48b 214 }
shreeshas95 0:f016e9e8d48b 215 else{
ee12b079 96:4ca92f9775e0 216 //gLEDR = 1;
ee12b079 96:4ca92f9775e0 217 //gLEDG = 0;
shreeshas95 2:2caf2a9a13aa 218 gFLAGS = gFLAGS | COM_RX_FLAG;
shreeshas95 2:2caf2a9a13aa 219 PUT_RAW_BYTE;
shreeshas95 0:f016e9e8d48b 220 }
aniruddhv 262:752c8689944a 221 if(gTOTAL_RAW_BYTES > BYTE_OVERFLOW_CONSTANT){
aniruddhv 262:752c8689944a 222 RX1M.attach(NULL);
aniruddhv 262:752c8689944a 223 gCOM_RX_DISABLE.attach(&after_com_disable, COM_RX_DISABLE_TIMEOUT);
aniruddhv 262:752c8689944a 224 after_receive();
aniruddhv 262:752c8689944a 225 }
shreeshas95 0:f016e9e8d48b 226 }
shreeshas95 4:104dd82c99b8 227 else if( gFLAGS & NEW_TC_RECEIVED ){
ee12b079 342:77b0d59897f7 228 gPC.puts("\n\n\n\r\rNEW TC RECEIVED\r\n");
ee12b079 295:699801854b71 229 /*Thread::wait(2000);*/
shreeshas95 0:f016e9e8d48b 230 gFLAGS = gFLAGS & (~NEW_TC_RECEIVED);
shreeshas95 4:104dd82c99b8 231 gFLAGS = gFLAGS | COM_MNG_TMTC_RUNNING_FLAG;
shreeshas95 2:2caf2a9a13aa 232
shreeshas95 0:f016e9e8d48b 233 // DISABLE THE RX1M INTERRUPT
shreeshas95 0:f016e9e8d48b 234 RX1M.attach(NULL);
shreeshas95 0:f016e9e8d48b 235
shreeshas95 4:104dd82c99b8 236 // VERIFY CRC, REPEATED PSC AND UPDATE TOTAL_VALID_TC, INCORRECT SIZE TC, CRC FAIL TC
shreeshas95 2:2caf2a9a13aa 237 while(gRX_COUNT < (RX_BUFFER_LENGTH)){
shreeshas95 2:2caf2a9a13aa 238 gRX_CURRENT_DATA_NODE->values[gRX_COUNT] = 0x00;
shreeshas95 0:f016e9e8d48b 239 ++gRX_COUNT;
shreeshas95 0:f016e9e8d48b 240 }
shreeshas95 0:f016e9e8d48b 241 gRX_COUNT = 0;
shreeshas95 4:104dd82c99b8 242 raw_data_to_tc();
shreeshas95 6:79d422d1ed42 243 gFLAGS = gFLAGS & (~COM_RX_FLAG);
aniruddhv 51:da85d84768e2 244
chaithanyarss 251:c766afa330a3 245 //Mutex
ee12b079 292:61aa2169ea1c 246 gMutex.lock();
chaithanyarss 251:c766afa330a3 247
shreeshas95 2:2caf2a9a13aa 248 if( gTOTAL_VALID_TC > 0 ){
aniruddhv 263:3b872778b8c7 249 gPC.printf("valid TC rx: %u\r\n", gTOTAL_VALID_TC);
ee12b079 338:d63eb331a67d 250 //gTOTAL_VALID_TC = 1;
shreeshas95 4:104dd82c99b8 251 if( gTOTAL_VALID_TC < COM_MAX_TC_LIMIT ){
shreeshas95 4:104dd82c99b8 252 // CHECK WEATHER TC LIST HAS MISSING TC OR WEATHER LAST FRAME BIT IS HIGH IN THE LAST PSC-TC
ee12b079 295:699801854b71 253 //gPC.puts("checking for tc list complete\r\n");
shreeshas95 4:104dd82c99b8 254 uint8_t tempContinue = 0xFF;
shreeshas95 4:104dd82c99b8 255 continueToExecute(tempContinue);
shreeshas95 4:104dd82c99b8 256 if(tempContinue == 0x00){
aniruddhv 263:3b872778b8c7 257 gPC.puts("tc list is complete\r\n");
shreeshas95 4:104dd82c99b8 258 // CHECK WEATHER GS VERIFICATION CODE MATCHES
shreeshas95 4:104dd82c99b8 259 uint8_t tempGSver = 0x00;
shreeshas95 4:104dd82c99b8 260 GScodeVerification(tempGSver);
shreeshas95 5:ab276a17ca07 261 /*PENDING: INCLUDE GS VERIFICATION CODE*/
aniruddhv 37:c9a739750806 262 if( tempGSver == 0xFF ){
ee12b079 295:699801854b71 263 //gPC.puts("GS code match !!\r\n");
shreeshas95 4:104dd82c99b8 264 gFLAGS = gFLAGS | COM_SESSION_VALIDITY;
aniruddhv 263:3b872778b8c7 265 //sys_reset_cdms_timer->start(cdms_reset_timeout);
aniruddhv 263:3b872778b8c7 266 COM_POWER_ON_TX();
ee12b079 295:699801854b71 267 //gPC.puts("P_com_hk !!\r\n");
aniruddhv 262:752c8689944a 268 P_COM_HK;
ee12b079 295:699801854b71 269 //gPC.puts("P_com_hk !!\r\n");
aniruddhv 262:752c8689944a 270 if( (gFLAGS & COM_PA_HOT_FLAG) || ( gFLAGS & COM_PA_OC_FLAG ) ){
aniruddhv 264:f7d8f9f361e3 271 gPC.puts("Pahot or paoc !!\r\n");
samp1234 352:022c513aee03 272 COM_DATA_fromuC_ENAIN = 0;
samp1234 352:022c513aee03 273 COM_DATA_fromISO_ENAOUT=0;
aniruddhv 262:752c8689944a 274 COM_TX_CNTRL = 0;
aniruddhv 262:752c8689944a 275 gCOM_PA_COOLING_TIMEOUT.attach(&after_cooling_pa, COM_PA_COOLING_TIME_LIMIT);
aniruddhv 262:752c8689944a 276 gFLAGS = gFLAGS & (~COM_MNG_TMTC_RUNNING_FLAG);
aniruddhv 262:752c8689944a 277 RX1M.attach(&rx_read, Serial::RxIrq);
aniruddhv 262:752c8689944a 278 }
aniruddhv 262:752c8689944a 279 else{
shreeshas95 6:79d422d1ed42 280 gCOM_PA_COOLING_TIMEOUT.detach();
ee12b079 98:fd99ddc0e0a1 281 gPC.puts("EXECUTING TELECOMMANDS\r\n");
shreeshas95 4:104dd82c99b8 282 EXECUTE_OBOSC_ONLY;
shreeshas95 4:104dd82c99b8 283 EXECUTE_TC;
ee12b079 164:be3b4b760d0c 284 gPC.puts("COMPLETED EXECUTION\r\n");
ee12b079 338:d63eb331a67d 285 gPC.printf("master_state : %d\n",gMASTER_STATE);
shreeshas95 4:104dd82c99b8 286 }
shreeshas95 4:104dd82c99b8 287 }
shreeshas95 4:104dd82c99b8 288 else{
aniruddhv 263:3b872778b8c7 289 gPC.puts("GS code mismatch !!\r\n");
shreeshas95 6:79d422d1ed42 290 RX1M.attach(&rx_read, Serial::RxIrq);
shreeshas95 4:104dd82c99b8 291 reset_all;
shreeshas95 4:104dd82c99b8 292 gFLAGS = gFLAGS & (~COM_SESSION_VALIDITY);
aniruddhv 263:3b872778b8c7 293 // ENABLE THREADS
samp1234 352:022c513aee03 294
ee12b079 253:fd6696d91e74 295 HK_counter->start(10000);
samp1234 352:022c513aee03 296
samp1234 352:022c513aee03 297
ee12b079 338:d63eb331a67d 298 resume_pl_dma = 1;
ee12b079 338:d63eb331a67d 299 //gPAY_SPI->bulkRead_resume(&payload_isr_fun);
shreeshas95 4:104dd82c99b8 300 gSESSION_TIMEOUT.detach();
shreeshas95 4:104dd82c99b8 301 gFLAGS = gFLAGS & (~COM_SESSION_FLAG);
shreeshas95 4:104dd82c99b8 302 // WARNING: clear COM_MNG_TMTC ?
aniruddhv 262:752c8689944a 303 gFLAGS = gFLAGS & (~COM_MNG_TMTC_RUNNING_FLAG);
shreeshas95 4:104dd82c99b8 304 }
shreeshas95 0:f016e9e8d48b 305 }
shreeshas95 2:2caf2a9a13aa 306 else{
ee12b079 164:be3b4b760d0c 307 gPC.puts("tc list is not complete\r\n");
shreeshas95 5:ab276a17ca07 308 if(tempContinue & 0x01){
aniruddhv 263:3b872778b8c7 309 gPC.puts("last packet bit not found\r\n");
shreeshas95 5:ab276a17ca07 310 }
shreeshas95 5:ab276a17ca07 311 if( tempContinue & 0x02 ){
aniruddhv 263:3b872778b8c7 312 gPC.puts("missing psc found\r\n");
shreeshas95 5:ab276a17ca07 313 }
aniruddhv 69:20f09a0c3fd2 314 //gPC.printf("crc fail tc = %u\r\n", gTOTAL_CRC_FAIL_TC);
aniruddhv 69:20f09a0c3fd2 315 //gPC.printf("incorrect size tc = %u\r\n", gTOTAL_INCORRECT_SIZE_TC);
aniruddhv 69:20f09a0c3fd2 316 //gPC.printf("repeated psc = %u\r\n", gTOTAL_REPEATED_TC);
shreeshas95 5:ab276a17ca07 317 Base_tc *test_tc = gHEAD_NODE_TCL;
shreeshas95 5:ab276a17ca07 318 while( test_tc != NULL ){
shreeshas95 5:ab276a17ca07 319 int length = 0;
shreeshas95 5:ab276a17ca07 320 if( GETshort_or_long_tc(test_tc) == SHORT_TC_CODE ){
shreeshas95 5:ab276a17ca07 321 length = TC_SHORT_SIZE;
shreeshas95 5:ab276a17ca07 322 }
shreeshas95 5:ab276a17ca07 323 else{
shreeshas95 5:ab276a17ca07 324 length = TC_LONG_SIZE;
shreeshas95 5:ab276a17ca07 325 }
rohit3342 16:538de1b20b3a 326 for(int i = 0 ; i < length ; ++i ){
aniruddhv 69:20f09a0c3fd2 327 //gPC.printf("%x ", test_tc->TC_string[i]);
shreeshas95 5:ab276a17ca07 328 }
aniruddhv 69:20f09a0c3fd2 329 //gPC.puts("\r\n");
shreeshas95 5:ab276a17ca07 330 test_tc = test_tc->next_TC;
shreeshas95 5:ab276a17ca07 331 }
aniruddhv 69:20f09a0c3fd2 332 //gPC.puts("\r\n");
aniruddhv 263:3b872778b8c7 333 COM_POWER_ON_TX();
shreeshas95 4:104dd82c99b8 334 // PENDING : POWER OFF TX
samp1234 352:022c513aee03 335 COM_DATA_fromuC_ENAIN = 0;
samp1234 352:022c513aee03 336 COM_DATA_fromISO_ENAOUT=0;
aniruddhv 262:752c8689944a 337 COM_TX_CNTRL = 0;
shreeshas95 4:104dd82c99b8 338 RX1M.attach(&rx_read, Serial::RxIrq);
shreeshas95 4:104dd82c99b8 339 gFLAGS = gFLAGS & (~COM_MNG_TMTC_RUNNING_FLAG);
shreeshas95 2:2caf2a9a13aa 340 }
shreeshas95 0:f016e9e8d48b 341 }
shreeshas95 0:f016e9e8d48b 342 else{
aniruddhv 263:3b872778b8c7 343 COM_POWER_ON_TX();
shreeshas95 6:79d422d1ed42 344 // POWER OFF TX transmitter only
shreeshas95 4:104dd82c99b8 345 // WARNING: reset_all ? clear com_session ?
samp1234 352:022c513aee03 346 COM_DATA_fromuC_ENAIN = 0;
samp1234 352:022c513aee03 347 COM_DATA_fromISO_ENAOUT=0;
aniruddhv 262:752c8689944a 348 COM_TX_CNTRL = 0;
aniruddhv 262:752c8689944a 349 reset_all;
aniruddhv 262:752c8689944a 350 gFLAGS = gFLAGS & (~COM_SESSION_FLAG);
shreeshas95 2:2caf2a9a13aa 351 RX1M.attach(&rx_read, Serial::RxIrq);
shreeshas95 4:104dd82c99b8 352 gFLAGS = gFLAGS & (~COM_MNG_TMTC_RUNNING_FLAG);
shreeshas95 0:f016e9e8d48b 353 }
shreeshas95 2:2caf2a9a13aa 354 }
shreeshas95 4:104dd82c99b8 355 else{
ee12b079 164:be3b4b760d0c 356 gPC.puts("No valid TC received\r\n");
shreeshas95 2:2caf2a9a13aa 357 RX1M.attach(&rx_read, Serial::RxIrq);
shreeshas95 4:104dd82c99b8 358 gFLAGS = gFLAGS & (~COM_MNG_TMTC_RUNNING_FLAG);
shreeshas95 6:79d422d1ed42 359 reset_all;
aniruddhv 263:3b872778b8c7 360 // ENABLE THREADS
ee12b079 246:565458eefd94 361 HK_counter->start(10000);
ee12b079 338:d63eb331a67d 362 resume_pl_dma = 1;
shreeshas95 6:79d422d1ed42 363 gSESSION_TIMEOUT.detach();
shreeshas95 6:79d422d1ed42 364 gFLAGS = gFLAGS & (~COM_SESSION_FLAG);
shreeshas95 2:2caf2a9a13aa 365 }
shreeshas95 2:2caf2a9a13aa 366 }
shreeshas95 2:2caf2a9a13aa 367 else if( gFLAGS & COM_PA_HOT_FLAG ){
aniruddhv 263:3b872778b8c7 368 gPC.puts("checking for PA hot in main\r\n");
aniruddhv 262:752c8689944a 369 P_COM_HK;
aniruddhv 262:752c8689944a 370 if((gFLAGS & COM_PA_HOT_FLAG) || (gFLAGS & COM_PA_OC_FLAG)){
samp1234 352:022c513aee03 371 COM_DATA_fromuC_ENAIN = 0;
samp1234 352:022c513aee03 372 COM_DATA_fromISO_ENAOUT=0;
aniruddhv 262:752c8689944a 373 COM_TX_CNTRL = 0;
aniruddhv 262:752c8689944a 374 gCOM_PA_COOLING_TIMEOUT.attach(&after_cooling_pa, COM_PA_COOLING_TIME_LIMIT);
shreeshas95 0:f016e9e8d48b 375 }
shreeshas95 0:f016e9e8d48b 376 else{
aniruddhv 262:752c8689944a 377 gCOM_PA_COOLING_TIMEOUT.detach();
aniruddhv 262:752c8689944a 378 if( !(gFLAGS & COM_RX_FLAG) ){
aniruddhv 263:3b872778b8c7 379 gPC.puts("PA IS COOLED DOWN\r\n");
shreeshas95 6:79d422d1ed42 380 gFLAGS = gFLAGS | COM_MNG_TMTC_RUNNING_FLAG;
shreeshas95 6:79d422d1ed42 381 RX1M.attach(NULL);
aniruddhv 263:3b872778b8c7 382 COM_POWER_ON_TX();
shreeshas95 6:79d422d1ed42 383 EXECUTE_OBOSC_ONLY;
shreeshas95 6:79d422d1ed42 384 EXECUTE_TC;
shreeshas95 6:79d422d1ed42 385 }
shreeshas95 0:f016e9e8d48b 386 }
shreeshas95 2:2caf2a9a13aa 387 }
shreeshas95 6:79d422d1ed42 388 else if( gFLAGS & COM_SESSION_TIMEOUT_FLAG ){
aniruddhv 263:3b872778b8c7 389 gPC.puts("session timeout: resetting in main\r\n");
shreeshas95 6:79d422d1ed42 390 COM_POWER_OFF_TX;
aniruddhv 263:3b872778b8c7 391 /*ENABLE THREADS*/
ee12b079 246:565458eefd94 392 HK_counter->start(10000);
ee12b079 338:d63eb331a67d 393 resume_pl_dma = 1;
shreeshas95 6:79d422d1ed42 394 gSESSION_TIMEOUT.detach();
shreeshas95 6:79d422d1ed42 395 gFLAGS = gFLAGS & (~COM_MNG_TMTC_RUNNING_FLAG);
shreeshas95 6:79d422d1ed42 396 gFLAGS = gFLAGS & (~COM_SESSION_FLAG);
shreeshas95 6:79d422d1ed42 397 reset_all;
shreeshas95 6:79d422d1ed42 398 }
shreeshas95 2:2caf2a9a13aa 399 else{
aniruddhv 263:3b872778b8c7 400 gPC.puts("INVALID SIGNAL RECEIVED IN MAIN\r\n");
shreeshas95 2:2caf2a9a13aa 401 // SOME INVALID SIGNAL RECEIVED
shreeshas95 4:104dd82c99b8 402 COM_POWER_OFF_TX;
shreeshas95 2:2caf2a9a13aa 403 reset_all;
aniruddhv 263:3b872778b8c7 404 // ENABLE THREADS
ee12b079 246:565458eefd94 405 HK_counter->start(10000);
ee12b079 338:d63eb331a67d 406 resume_pl_dma = 1;
shreeshas95 2:2caf2a9a13aa 407 gSESSION_TIMEOUT.detach();
shreeshas95 2:2caf2a9a13aa 408 gFLAGS = gFLAGS & (~COM_SESSION_FLAG);
shreeshas95 0:f016e9e8d48b 409 }
ee12b079 338:d63eb331a67d 410 if(resume_pl_dma)
ee12b079 338:d63eb331a67d 411 {
ee12b079 338:d63eb331a67d 412
ee12b079 338:d63eb331a67d 413
ee12b079 338:d63eb331a67d 414 resume_pl_dma = 0;
ee12b079 338:d63eb331a67d 415 }
ee12b079 338:d63eb331a67d 416 //gPC.puts("dma started");
ee12b079 293:442564c72202 417 gPAY_SPI->bulkRead_resume(&payload_isr_fun);
ee12b079 254:22d97475ca79 418 gMutex.unlock();
ee12b079 338:d63eb331a67d 419
shreeshas95 0:f016e9e8d48b 420 }
shreeshas95 101:bece931236a2 421 }