Latest FM Code with EEPROM

Dependencies:   FreescaleIAP SimpleDMA eeprom mbed-rtos mbed

Fork of CDMS_QM_03MAR2017_Flash_with_obsrs by Team Fox

Committer:
samp1234
Date:
Sat Feb 24 10:28:56 2018 +0000
Revision:
356:4484bf39526f
Parent:
354:eb6c863756a8
EEPROM FM

Who changed what in which revision?

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