working version

Dependencies:   mbed mbed-rtos SimpleDMA FreescaleIAP eeprom

Fork of CDMS_CODE_FM_28JAN2017 by samp Srinivasan

Committer:
samp1234
Date:
Sun Apr 03 15:35:53 2022 +0000
Revision:
357:f3d48d62e00e
Parent:
356:197c93dc2012
First commit test

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
samp1234 354:eb6c863756a8 8
samp1234 354:eb6c863756a8 9
ee12b079 338:d63eb331a67d 10 dmaSPISlave *gPAY_SPI;
ee12b079 338:d63eb331a67d 11
ee12b079 173:f81ded27423d 12 void payload_isr_fun(){
ee12b079 173:f81ded27423d 13 gSCIENCE_THREAD->signal_set(SCIENCE_SIGNAL);
samp1234 346:204497974293 14
ee12b079 173:f81ded27423d 15 }
ee12b079 173:f81ded27423d 16
ee12b079 191:0636c8391407 17 void payload_isr_fun_dma(void const *args ){
ee12b079 191:0636c8391407 18 gSCIENCE_THREAD->signal_set(SCIENCE_SIGNAL);
ee12b079 191:0636c8391407 19 }
ee12b079 192:f0d5fde60221 20
ee12b079 173:f81ded27423d 21 void SCIENCE_FUN(void const *args){
spacelab 308:7c3872365d58 22 // gPAY_SPI->frequency(1000000); //1000000
spacelab 308:7c3872365d58 23 gPAY_SPI->format(8,0);
chaithanyarss 290:3159ff1081a2 24 gPC.printf("\n\rTest...........................");
samp1234 357:f3d48d62e00e 25 gPAY_SPI->bulkRead_init(gPAYLOAD_BUFFER, PAYLOAD_BUFFER_LENGTH, &payload_isr_fun); //commented 2day
samp1234 357:f3d48d62e00e 26 gPAY_SPI->bulkRead_start(); //commented 2day
spacelab 309:6ed5535ac465 27
ee12b079 295:699801854b71 28 //AY_SPI->bulkRead_pause();
ee12b079 295:699801854b71 29 //AY_SPI->bulkRead_resume(&payload_isr_fun);
ee12b079 173:f81ded27423d 30 while(true){
ee12b079 342:77b0d59897f7 31 gPC.printf("waiting for Sci sig\n\r");
ee12b079 173:f81ded27423d 32 gSCIENCE_THREAD->signal_wait(SCIENCE_SIGNAL);
samp1234 357:f3d48d62e00e 33 gPC.printf("got signal\n\r");
samp1234 357:f3d48d62e00e 34 if(EN_RCV_SC == 0x00)
samp1234 357:f3d48d62e00e 35 continue;
ee12b079 342:77b0d59897f7 36 gPC.printf("checking mutex in Sci\n\r");
ee12b079 342:77b0d59897f7 37 gMutex.lock();
samp1234 357:f3d48d62e00e 38 gPC.printf("locked mutex,entered in Sci thread\n\r");
samp1234 346:204497974293 39
samp1234 357:f3d48d62e00e 40 WRITE_TO_EEPROM(1,DEVICE_POWERED);
samp1234 346:204497974293 41 DMA_LED1 = 1;
chaithanyarss 290:3159ff1081a2 42 PL_RCV_SC_DATA_STATUS = 1;
samp1234 357:f3d48d62e00e 43
spacelab 308:7c3872365d58 44 //gPC.puts("sig_set\r\n");
ee12b079 288:aa93d6652381 45 //for(int i =0; i<PAYLOAD_BUFFER_LENGTH; i++)
ee12b079 295:699801854b71 46 //if (gPAYLOAD_BUFFER[i] != 0x01) gPC.printf("%d = 0x%02X\n\r",i,gPAYLOAD_BUFFER[i]);
chaithanyarss 290:3159ff1081a2 47 //gPAY_SPI->bulkRead_start();
samp1234 357:f3d48d62e00e 48 //srp(gPAYLOAD_BUFFER);//skip one apcket when cdms resets
spacelab 308:7c3872365d58 49 //gPC.puts("exit_srp\r\n");
spacelab 308:7c3872365d58 50 //wait(2);/*timeout to be decided*/
samp1234 356:197c93dc2012 51 if(dma) //something wrong here
chaithanyarss 290:3159ff1081a2 52 {
samp1234 346:204497974293 53 // TIME_LATEST_I2C_SPEED = FCTN_CDMS_RD_RTC() >> 7;
chaithanyarss 303:b49b486a7107 54 PL_RCV_SC_DATA_COUNTER++;
samp1234 357:f3d48d62e00e 55 gPC.printf("dma activatedi\n\r");
samp1234 357:f3d48d62e00e 56 gPAY_SPI->bulkRead_start();//something wrong here //commented 2day
samp1234 346:204497974293 57 // DMA_LED1 = !DMA_LED1; // added by samp
ee12b079 292:61aa2169ea1c 58 //gPAY_SPI->bulkRead_pause();
ee12b079 292:61aa2169ea1c 59 //gPAY_SPI->bulkRead_resume(&payload_isr_fun);
chaithanyarss 290:3159ff1081a2 60 }
spacelab 309:6ed5535ac465 61 // DMA_LED1 = !DMA_LED1; // added by samp
samp1234 353:e1803e801e20 62 //__disable_irq();
spacelab 309:6ed5535ac465 63 srp(gPAYLOAD_BUFFER);//skip one apcket when cdms resets
samp1234 357:f3d48d62e00e 64
samp1234 357:f3d48d62e00e 65 uint8_t sd_stat1 = 0;
samp1234 346:204497974293 66 if(BAE_HK_SD_DATA_READY==1)
samp1234 346:204497974293 67 {
samp1234 346:204497974293 68 for(int i=0; i<288; i++)
samp1234 346:204497974293 69 BAE_HEALTH_FINAL[i] = interleave_BAE_HK[i];
samp1234 346:204497974293 70 sd_stat1 = SD_WRITE(BAE_HEALTH_FINAL,FSC_CURRENT[5]+1,5);
samp1234 346:204497974293 71 if(sd_stat1) {
samp1234 346:204497974293 72 gPC.puts("BAE_HK sd write fail");
samp1234 346:204497974293 73 //break;
samp1234 346:204497974293 74 }
samp1234 346:204497974293 75
samp1234 346:204497974293 76 }
samp1234 346:204497974293 77 BAE_HK_SD_DATA_READY = 0;
samp1234 346:204497974293 78 if(CDMS_HK_SD_DATA_READY==1)
samp1234 346:204497974293 79 {
samp1234 346:204497974293 80 for(int i=0; i<288; i++)
samp1234 346:204497974293 81 CDMS_HEALTH_FINAL[i] = interleave_CDMS_HK[i];
samp1234 346:204497974293 82 //gPC.printf("\n\r reached here");
samp1234 346:204497974293 83 sd_stat1 = SD_WRITE(CDMS_HEALTH_FINAL,FSC_CURRENT[4]+1,4);
samp1234 346:204497974293 84
samp1234 346:204497974293 85 if(sd_stat1) {
samp1234 346:204497974293 86 gPC.puts("sd write failure $*&^@!~!");
samp1234 346:204497974293 87 }
samp1234 346:204497974293 88 }
samp1234 346:204497974293 89 CDMS_HK_SD_DATA_READY= 0;
chaithanyarss 290:3159ff1081a2 90 /*else
chaithanyarss 290:3159ff1081a2 91 gPC.printf("\n\rDMA error");*/
ee12b079 342:77b0d59897f7 92 gPC.printf("\r\nreleasing mutex for Sci\n\r");
samp1234 346:204497974293 93 DMA_LED1 =0;
samp1234 353:e1803e801e20 94 //__enable_irq();
spacelab 309:6ed5535ac465 95 gMutex.unlock();
ee12b079 173:f81ded27423d 96 }
ee12b079 173:f81ded27423d 97 }
ee12b079 173:f81ded27423d 98
ee12b079 245:da9d1bd999da 99 //HK Thread(Contains HK_main() and PL_main())
ee12b079 245:da9d1bd999da 100 //RTOS timer calllback func
ee12b079 245:da9d1bd999da 101 void hk_isr(void const *args){
samp1234 346:204497974293 102 //gPC.printf("\r\n HK isr \n\r");
ee12b079 246:565458eefd94 103 gHK_THREAD->signal_set(HK_SIGNAL);
samp1234 346:204497974293 104 // gPC.printf("\r\n HK 1 \n\r");
ee12b079 245:da9d1bd999da 105 }
ee12b079 245:da9d1bd999da 106
ee12b079 245:da9d1bd999da 107
ee12b079 173:f81ded27423d 108 //COM THREAD
shreeshas95 0:f016e9e8d48b 109 // UART ISR
shreeshas95 0:f016e9e8d48b 110 void rx_read(){
shreeshas95 2:2caf2a9a13aa 111 gRX_CURRENT_DATA_NODE->values[gRX_COUNT] = RX1M.getc();
ee12b079 338:d63eb331a67d 112 //Checking RSSI
ee12b079 338:d63eb331a67d 113 if(!COM_RSSI_SET)
ee12b079 338:d63eb331a67d 114 RSSI_VOLTAGE = COMRX_RSSI_VOLTAGE.read() * 3.3;//to be checked
samp1234 354:eb6c863756a8 115 RSSI_MAX = RSSI_VOLTAGE;
ee12b079 338:d63eb331a67d 116 COM_RSSI_SET = 1;
shreeshas95 2:2caf2a9a13aa 117 gFLAGS = gFLAGS | UART_INT_FLAG;
samp1234 356:197c93dc2012 118
shreeshas95 0:f016e9e8d48b 119 gCOM_MNG_TMTC_THREAD->signal_set(COM_MNG_TMTC_SIGNAL_UART_INT);
shreeshas95 0:f016e9e8d48b 120 }
shreeshas95 0:f016e9e8d48b 121
aniruddhv 262:752c8689944a 122 // COM_RX_DISABLE ISR
aniruddhv 262:752c8689944a 123 void after_com_disable(){
aniruddhv 262:752c8689944a 124 gCOM_RX_DISABLE.detach();
aniruddhv 262:752c8689944a 125 RX1M.attach(&rx_read, Serial::RxIrq);
aniruddhv 262:752c8689944a 126 }
aniruddhv 262:752c8689944a 127
shreeshas95 0:f016e9e8d48b 128 // RX_TIMEOUT ISR
shreeshas95 0:f016e9e8d48b 129 void after_receive(){
shreeshas95 0:f016e9e8d48b 130 gRX_TIMEOUT.detach();
shreeshas95 2:2caf2a9a13aa 131 gFLAGS = gFLAGS | NEW_TC_RECEIVED;
shreeshas95 0:f016e9e8d48b 132 gCOM_MNG_TMTC_THREAD->signal_set(COM_MNG_TMTC_SIGNAL_UART_INT);
shreeshas95 0:f016e9e8d48b 133 }
shreeshas95 0:f016e9e8d48b 134
shreeshas95 0:f016e9e8d48b 135 // SESSION_TIMOUT ISR
shreeshas95 0:f016e9e8d48b 136 void after_session(){
shreeshas95 0:f016e9e8d48b 137 gSESSION_TIMEOUT.detach();
shreeshas95 6:79d422d1ed42 138 gFLAGS = gFLAGS | COM_SESSION_TIMEOUT_FLAG;
ee12b079 338:d63eb331a67d 139 //if( gMASTER_STATE != TCL_STATE_EXECUTING ){
shreeshas95 6:79d422d1ed42 140 gCOM_MNG_TMTC_THREAD->signal_set(COM_MNG_TMTC_SIGNAL_UART_INT);
ee12b079 338:d63eb331a67d 141 //}
shreeshas95 0:f016e9e8d48b 142 }
shreeshas95 0:f016e9e8d48b 143
shreeshas95 0:f016e9e8d48b 144 #define reset_all {\
shreeshas95 0:f016e9e8d48b 145 Base_tc *tcp = gHEAD_NODE_TCL;\
aniruddhv 12:ffdb29353058 146 /*gPC.puts("inside reset\r\n");*/\
shreeshas95 5:ab276a17ca07 147 gFLAGS = 0x0000;\
shreeshas95 0:f016e9e8d48b 148 while(tcp != NULL){\
shreeshas95 0:f016e9e8d48b 149 Base_tc *temp = tcp->next_TC;\
shreeshas95 0:f016e9e8d48b 150 delete tcp;\
shreeshas95 0:f016e9e8d48b 151 tcp = temp;\
shreeshas95 0:f016e9e8d48b 152 }\
shreeshas95 5:ab276a17ca07 153 gHEAD_NODE_TCL = NULL;\
shreeshas95 5:ab276a17ca07 154 gLAST_NODE_TCL = NULL;\
aniruddhv 262:752c8689944a 155 gMASTER_STATE = TCL_STATE_COMPLETED;\
shreeshas95 0:f016e9e8d48b 156 gTOTAL_INCORRECT_SIZE_TC = 0;\
shreeshas95 0:f016e9e8d48b 157 gTOTAL_CRC_FAIL_TC = 0;\
shreeshas95 2:2caf2a9a13aa 158 gTOTAL_REPEATED_TC = 0;\
shreeshas95 5:ab276a17ca07 159 gTOTAL_VALID_TC = 0;\
shreeshas95 5:ab276a17ca07 160 for(int i = 0 ; i < TM_LONG_SIZE ; ++i){\
aniruddhv 262:752c8689944a 161 /*gLAST_TM[i] = 0x00;*/\
shreeshas95 5:ab276a17ca07 162 }\
aniruddhv 262:752c8689944a 163 /*gLAST_TM_SHORT_OR_LONG = SHORT_TM_CODE;*/\
shreeshas95 0:f016e9e8d48b 164 COM_RX_DATA_NODE *dataptr = gRX_HEAD_DATA_NODE;\
shreeshas95 0:f016e9e8d48b 165 while( dataptr != NULL ){\
shreeshas95 0:f016e9e8d48b 166 COM_RX_DATA_NODE *temp = dataptr->next_node;\
shreeshas95 0:f016e9e8d48b 167 delete dataptr;\
shreeshas95 0:f016e9e8d48b 168 dataptr = temp;\
shreeshas95 0:f016e9e8d48b 169 }\
shreeshas95 0:f016e9e8d48b 170 gRX_HEAD_DATA_NODE = new COM_RX_DATA_NODE;\
shreeshas95 0:f016e9e8d48b 171 gRX_HEAD_DATA_NODE->next_node = NULL;\
shreeshas95 0:f016e9e8d48b 172 gRX_CURRENT_DATA_NODE = gRX_HEAD_DATA_NODE;\
shreeshas95 0:f016e9e8d48b 173 gRX_COUNT = 0;\
aniruddhv 262:752c8689944a 174 gTOTAL_RAW_BYTES = 0;\
shreeshas95 2:2caf2a9a13aa 175 /*PENDING : ALL GLOBAL VAARIABLES AND FLAGS*/\
aniruddhv 12:ffdb29353058 176 /*gPC.puts("finished reset all\r\n");*/\
shreeshas95 2:2caf2a9a13aa 177 }
shreeshas95 2:2caf2a9a13aa 178
shreeshas95 2:2caf2a9a13aa 179 #define PUT_RAW_BYTE {\
shreeshas95 2:2caf2a9a13aa 180 if( gRX_COUNT < (RX_BUFFER_LENGTH-1) ){\
shreeshas95 2:2caf2a9a13aa 181 ++gRX_COUNT;\
shreeshas95 2:2caf2a9a13aa 182 }\
shreeshas95 2:2caf2a9a13aa 183 else{\
shreeshas95 2:2caf2a9a13aa 184 gRX_COUNT = 0;\
shreeshas95 2:2caf2a9a13aa 185 gRX_CURRENT_DATA_NODE->next_node = new COM_RX_DATA_NODE;\
shreeshas95 2:2caf2a9a13aa 186 gRX_CURRENT_DATA_NODE = gRX_CURRENT_DATA_NODE->next_node;\
shreeshas95 2:2caf2a9a13aa 187 gRX_CURRENT_DATA_NODE->next_node = NULL;\
shreeshas95 2:2caf2a9a13aa 188 }\
aniruddhv 262:752c8689944a 189 ++gTOTAL_RAW_BYTES;\
shreeshas95 2:2caf2a9a13aa 190 gRX_TIMEOUT.attach(&after_receive, RX_TIMEOUT_LIMIT);\
shreeshas95 0:f016e9e8d48b 191 }
shreeshas95 0:f016e9e8d48b 192
shreeshas95 0:f016e9e8d48b 193 void COM_MNG_TMTC_FUN(void const *args){
shreeshas95 4:104dd82c99b8 194 if( !(gFLAGS & COM_SESSION_FLAG) ){
ee12b079 96:4ca92f9775e0 195 //gLEDR = 1;
ee12b079 96:4ca92f9775e0 196 //gLEDG = 1;
shreeshas95 4:104dd82c99b8 197 }
shreeshas95 0:f016e9e8d48b 198 while(true){
shreeshas95 0:f016e9e8d48b 199 Thread::signal_wait( COM_MNG_TMTC_SIGNAL_UART_INT );
samp1234 356:197c93dc2012 200 // RSSI_MAX = 0;
shreeshas95 0:f016e9e8d48b 201 if( gFLAGS & UART_INT_FLAG ){
shreeshas95 0:f016e9e8d48b 202 gFLAGS = gFLAGS & (~UART_INT_FLAG);
samp1234 356:197c93dc2012 203 //gPC.puts("in uart");
shreeshas95 2:2caf2a9a13aa 204 if( !(gFLAGS & COM_SESSION_FLAG) ){
aniruddhv 263:3b872778b8c7 205 // DISABLE THREADS
samp1234 356:197c93dc2012 206 // gPC.puts("1\r\n");
ee12b079 254:22d97475ca79 207 HK_counter->stop();
samp1234 356:197c93dc2012 208 resume_pl_dma = 0;
samp1234 356:197c93dc2012 209 PL_GPIO_2_STATUS = 1;//STOP SCIENCE TRANSFER & CONTROL pin NOT STATUS
ee12b079 245:da9d1bd999da 210 gPAY_SPI->bulkRead_pause();
samp1234 356:197c93dc2012 211 PL_GPIO_3_STATUS=1;//problem with this
shreeshas95 2:2caf2a9a13aa 212 gFLAGS = gFLAGS | COM_SESSION_FLAG;
samp1234 357:f3d48d62e00e 213 gSESSION_TIMEOUT.attach(&after_session, 14*COM_SESSION_TIMEOUT);
shreeshas95 2:2caf2a9a13aa 214 gFLAGS = gFLAGS | COM_RX_FLAG;
aniruddhv 262:752c8689944a 215 gTOTAL_RAW_BYTES = 0;
shreeshas95 2:2caf2a9a13aa 216 PUT_RAW_BYTE;
shreeshas95 2:2caf2a9a13aa 217 // PENDING : MEASURE RSSI
shreeshas95 4:104dd82c99b8 218 if( gFLAGS & COM_SESSION_FLAG ){
ee12b079 96:4ca92f9775e0 219 //gLEDR = 0;
ee12b079 96:4ca92f9775e0 220 //gLEDG = 0;
shreeshas95 4:104dd82c99b8 221 }
shreeshas95 2:2caf2a9a13aa 222 }
shreeshas95 2:2caf2a9a13aa 223 else if( gFLAGS & COM_RX_FLAG ){
ee12b079 96:4ca92f9775e0 224 //gLEDR = 0;
ee12b079 96:4ca92f9775e0 225 //gLEDG = 1;
samp1234 356:197c93dc2012 226 //gPC.puts("2\r\n");
samp1234 356:197c93dc2012 227
shreeshas95 2:2caf2a9a13aa 228 PUT_RAW_BYTE;
shreeshas95 0:f016e9e8d48b 229 }
shreeshas95 0:f016e9e8d48b 230 else{
ee12b079 96:4ca92f9775e0 231 //gLEDR = 1;
ee12b079 96:4ca92f9775e0 232 //gLEDG = 0;
samp1234 356:197c93dc2012 233 // gPC.puts("3\r\n");
samp1234 356:197c93dc2012 234
shreeshas95 2:2caf2a9a13aa 235 gFLAGS = gFLAGS | COM_RX_FLAG;
shreeshas95 2:2caf2a9a13aa 236 PUT_RAW_BYTE;
shreeshas95 0:f016e9e8d48b 237 }
aniruddhv 262:752c8689944a 238 if(gTOTAL_RAW_BYTES > BYTE_OVERFLOW_CONSTANT){
samp1234 356:197c93dc2012 239 //gPC.puts("4\r\n");
samp1234 356:197c93dc2012 240
aniruddhv 262:752c8689944a 241 RX1M.attach(NULL);
aniruddhv 262:752c8689944a 242 gCOM_RX_DISABLE.attach(&after_com_disable, COM_RX_DISABLE_TIMEOUT);
aniruddhv 262:752c8689944a 243 after_receive();
aniruddhv 262:752c8689944a 244 }
shreeshas95 0:f016e9e8d48b 245 }
shreeshas95 4:104dd82c99b8 246 else if( gFLAGS & NEW_TC_RECEIVED ){
samp1234 356:197c93dc2012 247 gFLAGS = gFLAGS & (~NEW_TC_RECEIVED);
samp1234 356:197c93dc2012 248 // DISABLE THE RX1M INTERRUPT
samp1234 356:197c93dc2012 249 RX1M.attach(NULL);
samp1234 356:197c93dc2012 250 gPC.printf("RSSI = %f",RSSI_MAX);
ee12b079 295:699801854b71 251 /*Thread::wait(2000);*/
samp1234 357:f3d48d62e00e 252 gFLAGS = gFLAGS & (~COM_RX_FLAG);//CHanged but not tested
shreeshas95 4:104dd82c99b8 253 gFLAGS = gFLAGS | COM_MNG_TMTC_RUNNING_FLAG;
shreeshas95 2:2caf2a9a13aa 254
shreeshas95 0:f016e9e8d48b 255
samp1234 356:197c93dc2012 256 //gPC.printf("\n flags = %u \n", gFLAGS);
samp1234 356:197c93dc2012 257 gPC.puts("\n\n\n\r\rNEW TC RECEIVED\r\n");
samp1234 356:197c93dc2012 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;
shreeshas95 4:104dd82c99b8 265 raw_data_to_tc();
samp1234 357:f3d48d62e00e 266 //gFLAGS = gFLAGS & (~COM_RX_FLAG);
aniruddhv 51:da85d84768e2 267
chaithanyarss 251:c766afa330a3 268 //Mutex
ee12b079 292:61aa2169ea1c 269 gMutex.lock();
chaithanyarss 251:c766afa330a3 270
samp1234 356:197c93dc2012 271 if( gTOTAL_VALID_TC > 1 ){
aniruddhv 263:3b872778b8c7 272 gPC.printf("valid TC rx: %u\r\n", gTOTAL_VALID_TC);
samp1234 357:f3d48d62e00e 273 TC_count += 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();
samp1234 356:197c93dc2012 291 // gPC.puts("P_com_hk !!\r\n");
aniruddhv 262:752c8689944a 292 P_COM_HK;
samp1234 356:197c93dc2012 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;
samp1234 356:197c93dc2012 362 COM_POWER_OFF_TX;
samp1234 356:197c93dc2012 363 //reset_all;
shreeshas95 4:104dd82c99b8 364 RX1M.attach(&rx_read, Serial::RxIrq);
shreeshas95 4:104dd82c99b8 365 gFLAGS = gFLAGS & (~COM_MNG_TMTC_RUNNING_FLAG);
samp1234 356:197c93dc2012 366 //resume_pl_dma = 1;
samp1234 356:197c93dc2012 367 //HK_counter->start(10000);
samp1234 356:197c93dc2012 368
shreeshas95 2:2caf2a9a13aa 369 }
shreeshas95 0:f016e9e8d48b 370 }
shreeshas95 0:f016e9e8d48b 371 else{
aniruddhv 263:3b872778b8c7 372 COM_POWER_ON_TX();
shreeshas95 6:79d422d1ed42 373 // POWER OFF TX transmitter only
shreeshas95 4:104dd82c99b8 374 // WARNING: reset_all ? clear com_session ?
samp1234 352:022c513aee03 375 COM_DATA_fromuC_ENAIN = 0;
samp1234 352:022c513aee03 376 COM_DATA_fromISO_ENAOUT=0;
aniruddhv 262:752c8689944a 377 COM_TX_CNTRL = 0;
aniruddhv 262:752c8689944a 378 reset_all;
aniruddhv 262:752c8689944a 379 gFLAGS = gFLAGS & (~COM_SESSION_FLAG);
shreeshas95 2:2caf2a9a13aa 380 RX1M.attach(&rx_read, Serial::RxIrq);
shreeshas95 4:104dd82c99b8 381 gFLAGS = gFLAGS & (~COM_MNG_TMTC_RUNNING_FLAG);
shreeshas95 0:f016e9e8d48b 382 }
shreeshas95 2:2caf2a9a13aa 383 }
shreeshas95 4:104dd82c99b8 384 else{
ee12b079 164:be3b4b760d0c 385 gPC.puts("No valid TC received\r\n");
shreeshas95 2:2caf2a9a13aa 386 RX1M.attach(&rx_read, Serial::RxIrq);
shreeshas95 4:104dd82c99b8 387 gFLAGS = gFLAGS & (~COM_MNG_TMTC_RUNNING_FLAG);
shreeshas95 6:79d422d1ed42 388 reset_all;
aniruddhv 263:3b872778b8c7 389 // ENABLE THREADS
ee12b079 246:565458eefd94 390 HK_counter->start(10000);
ee12b079 338:d63eb331a67d 391 resume_pl_dma = 1;
shreeshas95 6:79d422d1ed42 392 gSESSION_TIMEOUT.detach();
shreeshas95 6:79d422d1ed42 393 gFLAGS = gFLAGS & (~COM_SESSION_FLAG);
shreeshas95 2:2caf2a9a13aa 394 }
shreeshas95 2:2caf2a9a13aa 395 }
shreeshas95 2:2caf2a9a13aa 396 else if( gFLAGS & COM_PA_HOT_FLAG ){
aniruddhv 263:3b872778b8c7 397 gPC.puts("checking for PA hot in main\r\n");
aniruddhv 262:752c8689944a 398 P_COM_HK;
aniruddhv 262:752c8689944a 399 if((gFLAGS & COM_PA_HOT_FLAG) || (gFLAGS & COM_PA_OC_FLAG)){
samp1234 352:022c513aee03 400 COM_DATA_fromuC_ENAIN = 0;
samp1234 352:022c513aee03 401 COM_DATA_fromISO_ENAOUT=0;
aniruddhv 262:752c8689944a 402 COM_TX_CNTRL = 0;
aniruddhv 262:752c8689944a 403 gCOM_PA_COOLING_TIMEOUT.attach(&after_cooling_pa, COM_PA_COOLING_TIME_LIMIT);
shreeshas95 0:f016e9e8d48b 404 }
shreeshas95 0:f016e9e8d48b 405 else{
aniruddhv 262:752c8689944a 406 gCOM_PA_COOLING_TIMEOUT.detach();
aniruddhv 262:752c8689944a 407 if( !(gFLAGS & COM_RX_FLAG) ){
aniruddhv 263:3b872778b8c7 408 gPC.puts("PA IS COOLED DOWN\r\n");
shreeshas95 6:79d422d1ed42 409 gFLAGS = gFLAGS | COM_MNG_TMTC_RUNNING_FLAG;
shreeshas95 6:79d422d1ed42 410 RX1M.attach(NULL);
aniruddhv 263:3b872778b8c7 411 COM_POWER_ON_TX();
shreeshas95 6:79d422d1ed42 412 EXECUTE_OBOSC_ONLY;
shreeshas95 6:79d422d1ed42 413 EXECUTE_TC;
shreeshas95 6:79d422d1ed42 414 }
shreeshas95 0:f016e9e8d48b 415 }
shreeshas95 2:2caf2a9a13aa 416 }
shreeshas95 6:79d422d1ed42 417 else if( gFLAGS & COM_SESSION_TIMEOUT_FLAG ){
aniruddhv 263:3b872778b8c7 418 gPC.puts("session timeout: resetting in main\r\n");
shreeshas95 6:79d422d1ed42 419 COM_POWER_OFF_TX;
aniruddhv 263:3b872778b8c7 420 /*ENABLE THREADS*/
ee12b079 246:565458eefd94 421 HK_counter->start(10000);
ee12b079 338:d63eb331a67d 422 resume_pl_dma = 1;
shreeshas95 6:79d422d1ed42 423 gSESSION_TIMEOUT.detach();
shreeshas95 6:79d422d1ed42 424 gFLAGS = gFLAGS & (~COM_MNG_TMTC_RUNNING_FLAG);
shreeshas95 6:79d422d1ed42 425 gFLAGS = gFLAGS & (~COM_SESSION_FLAG);
shreeshas95 6:79d422d1ed42 426 reset_all;
shreeshas95 6:79d422d1ed42 427 }
shreeshas95 2:2caf2a9a13aa 428 else{
aniruddhv 263:3b872778b8c7 429 gPC.puts("INVALID SIGNAL RECEIVED IN MAIN\r\n");
shreeshas95 2:2caf2a9a13aa 430 // SOME INVALID SIGNAL RECEIVED
shreeshas95 4:104dd82c99b8 431 COM_POWER_OFF_TX;
shreeshas95 2:2caf2a9a13aa 432 reset_all;
aniruddhv 263:3b872778b8c7 433 // ENABLE THREADS
ee12b079 246:565458eefd94 434 HK_counter->start(10000);
ee12b079 338:d63eb331a67d 435 resume_pl_dma = 1;
shreeshas95 2:2caf2a9a13aa 436 gSESSION_TIMEOUT.detach();
shreeshas95 2:2caf2a9a13aa 437 gFLAGS = gFLAGS & (~COM_SESSION_FLAG);
shreeshas95 0:f016e9e8d48b 438 }
ee12b079 338:d63eb331a67d 439 if(resume_pl_dma)
ee12b079 338:d63eb331a67d 440 {
ee12b079 338:d63eb331a67d 441
samp1234 356:197c93dc2012 442 PL_GPIO_2_STATUS=0;
samp1234 356:197c93dc2012 443 // resume_pl_dma = 0;
ee12b079 338:d63eb331a67d 444 }
ee12b079 293:442564c72202 445 gPAY_SPI->bulkRead_resume(&payload_isr_fun);
ee12b079 254:22d97475ca79 446 gMutex.unlock();
ee12b079 338:d63eb331a67d 447
shreeshas95 0:f016e9e8d48b 448 }
samp1234 357:f3d48d62e00e 449 }
samp1234 357:f3d48d62e00e 450 /*
samp1234 357:f3d48d62e00e 451 void st_up_isr(void const *args){
samp1234 357:f3d48d62e00e 452 gST_UP->signal_set(ST_UP_SIGNAL);\
samp1234 357:f3d48d62e00e 453 }
samp1234 357:f3d48d62e00e 454 */