for frequency correction testing
Dependencies: FreescaleIAP SimpleDMA mbed-rtos mbed
Fork of CDMS_CODE by
CDMS_HK.h@187:2c7263530c57, 2016-06-29 (annotated)
- Committer:
- chaithanyarss
- Date:
- Wed Jun 29 13:59:21 2016 +0000
- Revision:
- 187:2c7263530c57
- Parent:
- 105:5ce0337e7c15
- Child:
- 206:fba4aeebf004
SD card finalized code
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
chaithanyarss | 187:2c7263530c57 | 1 | #include "cdms_rtc.h" |
shreeshas95 | 103:b55559925dc1 | 2 | #include "pinconfig.h" |
chaithanyarss | 187:2c7263530c57 | 3 | #include "reset_functions.h" |
chaithanyarss | 187:2c7263530c57 | 4 | #include "DefinitionsAndGlobals.h" |
chaithanyarss | 187:2c7263530c57 | 5 | #include "COM_SND_TM_functions.h" |
shreeshas95 | 103:b55559925dc1 | 6 | |
shreeshas95 | 103:b55559925dc1 | 7 | void FCTN_CDMS_HK_MAIN(); |
shreeshas95 | 103:b55559925dc1 | 8 | void FCTN_CDMS_HK(); |
chaithanyarss | 187:2c7263530c57 | 9 | void VERIFY_COMRX(); |
chaithanyarss | 187:2c7263530c57 | 10 | void VERIFY_RTC(); |
chaithanyarss | 187:2c7263530c57 | 11 | void CDMS_HK_SD(); |
chaithanyarss | 187:2c7263530c57 | 12 | void CDMS_HW_FAULTS(); |
chaithanyarss | 187:2c7263530c57 | 13 | void HANDLE_HW_FAULT_SD(); |
chaithanyarss | 187:2c7263530c57 | 14 | void HANDLE_HW_FAULT_BAE(); |
chaithanyarss | 187:2c7263530c57 | 15 | void HANDLE_HW_FAULT_PL(); |
chaithanyarss | 187:2c7263530c57 | 16 | void COLLECT_CDMS_RAM(); |
shreeshas95 | 103:b55559925dc1 | 17 | |
shreeshas95 | 103:b55559925dc1 | 18 | Serial hk_cdms(USBTX, USBRX); |
shreeshas95 | 103:b55559925dc1 | 19 | |
chaithanyarss | 187:2c7263530c57 | 20 | AnalogIn TempInput(PIN27); // Input from Current Multiplexer |
shreeshas95 | 103:b55559925dc1 | 21 | AnalogIn CDMS_temp_sensor(PIN53); |
chaithanyarss | 187:2c7263530c57 | 22 | AnalogIn COMRX_RSSI_volatge(PIN70); |
chaithanyarss | 187:2c7263530c57 | 23 | |
chaithanyarss | 187:2c7263530c57 | 24 | DigitalIn SD_OC_FAULT (PIN90); |
chaithanyarss | 187:2c7263530c57 | 25 | DigitalOut SD_SW_EN_DS (PIN97); |
chaithanyarss | 187:2c7263530c57 | 26 | DigitalOut BAE_SW_EN_DS (PIN47); |
chaithanyarss | 187:2c7263530c57 | 27 | DigitalOut PL_SW_EN_DS (PIN73); |
chaithanyarss | 187:2c7263530c57 | 28 | |
chaithanyarss | 187:2c7263530c57 | 29 | //GPIO PINS |
chaithanyarss | 187:2c7263530c57 | 30 | DigitalIn V_A_PGOOD (PIN88); |
chaithanyarss | 187:2c7263530c57 | 31 | DigitalIn V_B_PGOOD_1 (PIN6); |
chaithanyarss | 187:2c7263530c57 | 32 | DigitalIn V_B_PGOOD_2 (PIN7); |
chaithanyarss | 187:2c7263530c57 | 33 | DigitalIn V_C_PGOOD (PIN54); |
chaithanyarss | 187:2c7263530c57 | 34 | DigitalIn COMRX_OC_FAULT (PIN68); |
chaithanyarss | 187:2c7263530c57 | 35 | DigitalIn COMTX_OC_FAULT (PIN69); |
chaithanyarss | 187:2c7263530c57 | 36 | DigitalIn BAE_OC_FAULT (PIN92); |
chaithanyarss | 187:2c7263530c57 | 37 | DigitalIn PL_GPIO_1_STATUS (PIN71); |
chaithanyarss | 187:2c7263530c57 | 38 | DigitalIn PL_GPIO_2_STATUS (PIN81); |
chaithanyarss | 187:2c7263530c57 | 39 | DigitalIn PL_GPIO_3_STATUS (PIN80); |
chaithanyarss | 187:2c7263530c57 | 40 | DigitalIn PL_BEE_SW_OC_FAULT (PIN4); |
chaithanyarss | 187:2c7263530c57 | 41 | DigitalIn PL_EPS_LATCH_SW_OC_FAULT (); |
chaithanyarss | 187:2c7263530c57 | 42 | DigitalIn V_C_EN_STATUS (); |
chaithanyarss | 187:2c7263530c57 | 43 | DigitalIn V_D_EN_STATUS (); |
shreeshas95 | 103:b55559925dc1 | 44 | |
shreeshas95 | 103:b55559925dc1 | 45 | DigitalOut SelectLinec3 (PIN79); // MSB of Select Lines |
shreeshas95 | 103:b55559925dc1 | 46 | DigitalOut SelectLinec2 (PIN78); |
shreeshas95 | 103:b55559925dc1 | 47 | DigitalOut SelectLinec1 (PIN77); |
shreeshas95 | 103:b55559925dc1 | 48 | DigitalOut SelectLinec0 (PIN76); // LSB of Select Lines |
shreeshas95 | 103:b55559925dc1 | 49 | |
shreeshas95 | 104:a50ae79ca36e | 50 | void FCTN_CDMS_HK_MAIN(void const *args) |
shreeshas95 | 103:b55559925dc1 | 51 | { |
chaithanyarss | 187:2c7263530c57 | 52 | CDMS_HK_MAIN_STATUS = 0x01; |
chaithanyarss | 187:2c7263530c57 | 53 | CDMS_HK_MAIN_COUNTER++; |
chaithanyarss | 187:2c7263530c57 | 54 | |
chaithanyarss | 187:2c7263530c57 | 55 | FCTN_CDMS_HK(); |
chaithanyarss | 187:2c7263530c57 | 56 | RSSI_volatge = COMRX_RSSI_volatge.read() * 3.3; |
chaithanyarss | 187:2c7263530c57 | 57 | VERIFY_COMRX(); |
chaithanyarss | 187:2c7263530c57 | 58 | VERIFY_RTC(); |
chaithanyarss | 187:2c7263530c57 | 59 | HANDLE_HW_FAULTS(); |
chaithanyarss | 187:2c7263530c57 | 60 | FUNC_CDMS_GPIO_STATUS(); //yet to be done |
chaithanyarss | 187:2c7263530c57 | 61 | COLLECT_CDMS_RAM(); |
chaithanyarss | 187:2c7263530c57 | 62 | |
chaithanyarss | 187:2c7263530c57 | 63 | uint8_t CDMS_quant[19]; |
chaithanyarss | 187:2c7263530c57 | 64 | for(int i=0;i<16;i++) |
chaithanyarss | 187:2c7263530c57 | 65 | { |
chaithanyarss | 187:2c7263530c57 | 66 | CDMS_quant[i]= (uint8_t)quant_data.temp_quant[i]; |
chaithanyarss | 187:2c7263530c57 | 67 | } |
chaithanyarss | 187:2c7263530c57 | 68 | CDMS_quant[16]= (uint8_t)RSSI_volatge; |
chaithanyarss | 187:2c7263530c57 | 69 | CDMS_quant[17]= (uint8_t)quant_data.CDMS_temp_quant; |
chaithanyarss | 187:2c7263530c57 | 70 | |
chaithanyarss | 187:2c7263530c57 | 71 | |
chaithanyarss | 187:2c7263530c57 | 72 | char BAE_HK[74]; |
chaithanyarss | 187:2c7263530c57 | 73 | BAE_HK_I2C = FCTN_I2C_READ(BAE_HK,74); |
chaithanyarss | 187:2c7263530c57 | 74 | if(BAE_HK_I2C == 0) |
chaithanyarss | 187:2c7263530c57 | 75 | hk_cdms.printf("Bae hk data received"); |
chaithanyarss | 187:2c7263530c57 | 76 | else |
chaithanyarss | 187:2c7263530c57 | 77 | { |
chaithanyarss | 187:2c7263530c57 | 78 | hk_cdms.printf("Bae hk data NOT received"); |
chaithanyarss | 187:2c7263530c57 | 79 | for(int i = 0;i<74;i++) |
chaithanyarss | 187:2c7263530c57 | 80 | BAE_HK = 0; |
chaithanyarss | 187:2c7263530c57 | 81 | } |
chaithanyarss | 187:2c7263530c57 | 82 | |
chaithanyarss | 187:2c7263530c57 | 83 | for(int i=0;i<512;i++) |
chaithanyarss | 187:2c7263530c57 | 84 | { |
chaithanyarss | 187:2c7263530c57 | 85 | CDMS_HEALTH_DATA[i]=0x00; |
chaithanyarss | 187:2c7263530c57 | 86 | } |
chaithanyarss | 187:2c7263530c57 | 87 | |
chaithanyarss | 187:2c7263530c57 | 88 | uint64_t time = FCTN_CDMS_RD_RTC(); |
chaithanyarss | 187:2c7263530c57 | 89 | time = time>>7; |
chaithanyarss | 187:2c7263530c57 | 90 | uint32_t HK_time = (uint32_t)time; |
chaithanyarss | 187:2c7263530c57 | 91 | for(int i = 0;i<4;i++) |
chaithanyarss | 187:2c7263530c57 | 92 | CDMS_HEALTH_DATA[i] = HK_time[i]; |
chaithanyarss | 187:2c7263530c57 | 93 | // Here: Have to FIT flash data. |
chaithanyarss | 187:2c7263530c57 | 94 | for(int i = 0;i<19;i++) |
chaithanyarss | 187:2c7263530c57 | 95 | CDMS_HEALTH_DATA[i+24] = CDMS_quant[i]; |
chaithanyarss | 187:2c7263530c57 | 96 | |
chaithanyarss | 187:2c7263530c57 | 97 | |
chaithanyarss | 187:2c7263530c57 | 98 | for(int i=0;i<512;i++) |
chaithanyarss | 187:2c7263530c57 | 99 | { |
chaithanyarss | 187:2c7263530c57 | 100 | printf("%d",CDMS_HEALTH_DATA[i]); |
chaithanyarss | 187:2c7263530c57 | 101 | } |
chaithanyarss | 187:2c7263530c57 | 102 | CDMS_HK_FSC = FCTN_SD_MNGR(0x04); |
chaithanyarss | 187:2c7263530c57 | 103 | BAE_HK_FSC = FCTN_SD_MNGR(0x05); |
chaithanyarss | 187:2c7263530c57 | 104 | hk_cdms.printf("CDMS executed succesfully\r\n"); |
shreeshas95 | 103:b55559925dc1 | 105 | } |
shreeshas95 | 103:b55559925dc1 | 106 | |
shreeshas95 | 103:b55559925dc1 | 107 | int quantiz(float start,float step,float x) |
shreeshas95 | 103:b55559925dc1 | 108 | { |
shreeshas95 | 103:b55559925dc1 | 109 | int y=(x-start)/step; |
shreeshas95 | 103:b55559925dc1 | 110 | if(y<=0)y=0; |
shreeshas95 | 103:b55559925dc1 | 111 | if(y>=255)y=255; |
shreeshas95 | 103:b55559925dc1 | 112 | return y; |
shreeshas95 | 103:b55559925dc1 | 113 | } |
shreeshas95 | 103:b55559925dc1 | 114 | |
chaithanyarss | 187:2c7263530c57 | 115 | void saveMin(char x,char y) |
chaithanyarss | 187:2c7263530c57 | 116 | { |
chaithanyarss | 187:2c7263530c57 | 117 | return (y<x)?y:x; |
shreeshas95 | 103:b55559925dc1 | 118 | } |
chaithanyarss | 187:2c7263530c57 | 119 | |
chaithanyarss | 187:2c7263530c57 | 120 | void saveMax(char x,char y) |
chaithanyarss | 187:2c7263530c57 | 121 | { |
chaithanyarss | 187:2c7263530c57 | 122 | return (y>x)?y:x; |
shreeshas95 | 103:b55559925dc1 | 123 | } |
chaithanyarss | 187:2c7263530c57 | 124 | |
chaithanyarss | 187:2c7263530c57 | 125 | void minMaxHkData() |
chaithanyarss | 187:2c7263530c57 | 126 | { |
shreeshas95 | 103:b55559925dc1 | 127 | if(firstCount==true){ |
shreeshas95 | 103:b55559925dc1 | 128 | for (int i = 0; i < 16; ++i){ |
shreeshas95 | 103:b55559925dc1 | 129 | min_max_data.temp_min[i] = quant_data.temp_quant[i]; |
shreeshas95 | 103:b55559925dc1 | 130 | min_max_data.temp_max[i] = quant_data.temp_quant[i]; |
shreeshas95 | 103:b55559925dc1 | 131 | } |
shreeshas95 | 103:b55559925dc1 | 132 | |
shreeshas95 | 103:b55559925dc1 | 133 | min_max_data.CDMS_temp_min=quant_data.CDMS_temp_quant; |
shreeshas95 | 103:b55559925dc1 | 134 | min_max_data.CDMS_temp_max=quant_data.CDMS_temp_quant; |
shreeshas95 | 103:b55559925dc1 | 135 | } |
shreeshas95 | 103:b55559925dc1 | 136 | else { |
shreeshas95 | 103:b55559925dc1 | 137 | for (int i = 0; i < 16; ++i) |
shreeshas95 | 103:b55559925dc1 | 138 | { |
chaithanyarss | 187:2c7263530c57 | 139 | min_max_data.temp_min[i] = saveMin(min_max_data.temp_min[i],quant_data.temp_quant[i]); |
chaithanyarss | 187:2c7263530c57 | 140 | min_max_data.temp_max[i] = saveMax(min_max_data.temp_max[i],quant_data.temp_quant[i]); |
shreeshas95 | 103:b55559925dc1 | 141 | } |
shreeshas95 | 103:b55559925dc1 | 142 | |
chaithanyarss | 187:2c7263530c57 | 143 | min_max_data.CDMS_temp_min = saveMin(min_max_data.CDMS_temp_min,quant_data.CDMS_temp_quant); |
chaithanyarss | 187:2c7263530c57 | 144 | min_max_data.CDMS_temp_max = saveMax(min_max_data.CDMS_temp_max,quant_data.CDMS_temp_quant); |
shreeshas95 | 103:b55559925dc1 | 145 | } |
shreeshas95 | 103:b55559925dc1 | 146 | firstCount=false; |
shreeshas95 | 103:b55559925dc1 | 147 | } |
shreeshas95 | 103:b55559925dc1 | 148 | |
shreeshas95 | 103:b55559925dc1 | 149 | void FCTN_CDMS_HK() |
shreeshas95 | 103:b55559925dc1 | 150 | { |
shreeshas95 | 103:b55559925dc1 | 151 | |
shreeshas95 | 103:b55559925dc1 | 152 | int Iteration=0; |
shreeshas95 | 103:b55559925dc1 | 153 | |
shreeshas95 | 103:b55559925dc1 | 154 | SelectLinec0=0; |
shreeshas95 | 103:b55559925dc1 | 155 | SelectLinec1=0; |
shreeshas95 | 103:b55559925dc1 | 156 | SelectLinec2=0; |
shreeshas95 | 103:b55559925dc1 | 157 | SelectLinec3=0; |
shreeshas95 | 103:b55559925dc1 | 158 | |
shreeshas95 | 103:b55559925dc1 | 159 | for(Iteration=0; Iteration<16; Iteration++){ |
shreeshas95 | 103:b55559925dc1 | 160 | |
shreeshas95 | 103:b55559925dc1 | 161 | actual_data.temp_actual[Iteration]=TempInput.read(); |
shreeshas95 | 103:b55559925dc1 | 162 | |
shreeshas95 | 103:b55559925dc1 | 163 | SelectLinec0=!(SelectLinec0); |
shreeshas95 | 103:b55559925dc1 | 164 | if(Iteration%2==1) |
shreeshas95 | 103:b55559925dc1 | 165 | SelectLinec1=!(SelectLinec1); |
shreeshas95 | 103:b55559925dc1 | 166 | if(Iteration%4==3) |
shreeshas95 | 103:b55559925dc1 | 167 | SelectLinec2=!(SelectLinec2); |
chaithanyarss | 187:2c7263530c57 | 168 | if(Iteration%8==7) [0] |
shreeshas95 | 103:b55559925dc1 | 169 | SelectLinec3=!(SelectLinec3); |
shreeshas95 | 103:b55559925dc1 | 170 | } |
shreeshas95 | 103:b55559925dc1 | 171 | |
chaithanyarss | 187:2c7263530c57 | 172 | actual_data.CDMS_temp_actual=(-90.7*3.3*CDMS_temp_sensor.read())+190.1543; |
shreeshas95 | 103:b55559925dc1 | 173 | |
shreeshas95 | 103:b55559925dc1 | 174 | for(Iteration=0;Iteration<16;Iteration++){ |
shreeshas95 | 103:b55559925dc1 | 175 | |
shreeshas95 | 103:b55559925dc1 | 176 | if(Iteration<14){ |
shreeshas95 | 103:b55559925dc1 | 177 | |
shreeshas95 | 103:b55559925dc1 | 178 | actual_data.temp_actual[Iteration]=actual_data.temp_actual[Iteration]*3.3; |
shreeshas95 | 103:b55559925dc1 | 179 | int resistance; |
shreeshas95 | 103:b55559925dc1 | 180 | |
shreeshas95 | 103:b55559925dc1 | 181 | resistance=24000*actual_data.temp_actual[Iteration]/(3.3-actual_data.temp_actual[Iteration]); |
shreeshas95 | 103:b55559925dc1 | 182 | if(actual_data.temp_actual[Iteration]>1.47) |
shreeshas95 | 103:b55559925dc1 | 183 | { |
shreeshas95 | 103:b55559925dc1 | 184 | actual_data.temp_actual[Iteration]=3694/log(24.032242*resistance); |
shreeshas95 | 103:b55559925dc1 | 185 | } |
shreeshas95 | 103:b55559925dc1 | 186 | else{ |
shreeshas95 | 103:b55559925dc1 | 187 | |
shreeshas95 | 103:b55559925dc1 | 188 | actual_data.temp_actual[Iteration]=3365.4/log(7.60573*resistance); |
shreeshas95 | 103:b55559925dc1 | 189 | } |
shreeshas95 | 103:b55559925dc1 | 190 | } |
shreeshas95 | 103:b55559925dc1 | 191 | else |
shreeshas95 | 103:b55559925dc1 | 192 | actual_data.temp_actual[Iteration]=(-90.7*3.3*actual_data.temp_actual[Iteration])+190.1543; |
shreeshas95 | 103:b55559925dc1 | 193 | } |
shreeshas95 | 103:b55559925dc1 | 194 | |
shreeshas95 | 103:b55559925dc1 | 195 | for(Iteration=0;Iteration<16;Iteration++){ |
shreeshas95 | 103:b55559925dc1 | 196 | |
shreeshas95 | 103:b55559925dc1 | 197 | if(Iteration<14){ |
shreeshas95 | 103:b55559925dc1 | 198 | |
shreeshas95 | 103:b55559925dc1 | 199 | quant_data.temp_quant[Iteration]=quantiz(tstart_thermistor,tstep_thermistor,actual_data.temp_actual[Iteration]); |
shreeshas95 | 103:b55559925dc1 | 200 | } |
shreeshas95 | 103:b55559925dc1 | 201 | else |
shreeshas95 | 103:b55559925dc1 | 202 | quant_data.temp_quant[Iteration]=quantiz(tstart,tstep,actual_data.temp_actual[Iteration]); |
shreeshas95 | 103:b55559925dc1 | 203 | } |
shreeshas95 | 103:b55559925dc1 | 204 | |
shreeshas95 | 103:b55559925dc1 | 205 | quant_data.CDMS_temp_quant=quantiz(tstart,tstep,actual_data.CDMS_temp_actual); |
shreeshas95 | 103:b55559925dc1 | 206 | |
shreeshas95 | 103:b55559925dc1 | 207 | minMaxHkData(); |
chaithanyarss | 187:2c7263530c57 | 208 | } |
chaithanyarss | 187:2c7263530c57 | 209 | |
chaithanyarss | 187:2c7263530c57 | 210 | void FUNC_CDMS_GPIO_STATUS() //Polls the status of Input GPIO PINS |
chaithanyarss | 187:2c7263530c57 | 211 | { |
chaithanyarss | 187:2c7263530c57 | 212 | //V_A_PGOOD //TRZ EN |
chaithanyarss | 187:2c7263530c57 | 213 | GPIO_STATUS=(V_A_PGOOD)?(GPIO_STATUS)||((uint16_t)(0x1<<15)):(GPIO_STATUS)&(~((uint16_t)(0x1<<15))); |
chaithanyarss | 187:2c7263530c57 | 214 | //V_B_PGOOD_1 //3V3BPGOOD //$ |
chaithanyarss | 187:2c7263530c57 | 215 | GPIO_STATUS=(V_B_PGOOD_1)?(GPIO_STATUS)||((uint16_t)(0x1<<14)):(GPIO_STATUS)&(~((uint16_t)(0x1<<14))); |
chaithanyarss | 187:2c7263530c57 | 216 | //V_B_PGOOD_2 //3V3BEN //$ |
chaithanyarss | 187:2c7263530c57 | 217 | GPIO_STATUS=(V_B_PGOOD_2)?(GPIO_STATUS)||((uint16_t)(0x1<<13)):(GPIO_STATUS)&(~((uint16_t)(0x1<<13))); |
chaithanyarss | 187:2c7263530c57 | 218 | //V_C_PGOOD //3V3CPGOOD //$ |
chaithanyarss | 187:2c7263530c57 | 219 | GPIO_STATUS=(V_C_PGOOD)?(GPIO_STATUS)||((uint16_t)(0x1<<12)):(GPIO_STATUS)&(~((uint16_t)(0x1<<12))); |
chaithanyarss | 187:2c7263530c57 | 220 | //COMRX_OC_FAULT //$ |
chaithanyarss | 187:2c7263530c57 | 221 | GPIO_STATUS=(COMRX_OC_FAULT)?(GPIO_STATUS)||((uint16_t)(0x1<<11)):(GPIO_STATUS)&(~((uint16_t)(0x1<<11))); |
chaithanyarss | 187:2c7263530c57 | 222 | // COMTX_OC_FAULT //$ |
chaithanyarss | 187:2c7263530c57 | 223 | GPIO_STATUS=(COMTX_OC_FAULT)?(GPIO_STATUS)||((uint16_t)(0x1<<10)):(GPIO_STATUS)&(~((uint16_t)(0x1<<10))); |
chaithanyarss | 187:2c7263530c57 | 224 | //BAE_OC_FAULT //$ |
chaithanyarss | 187:2c7263530c57 | 225 | GPIO_STATUS=(BAE_OC_FAULT)?(GPIO_STATUS)||((uint16_t)(0x1<<9)):(GPIO_STATUS)&(~((uint16_t)(0x1<<9))); |
chaithanyarss | 187:2c7263530c57 | 226 | //PL_GPIO_1_STATUS //$ |
chaithanyarss | 187:2c7263530c57 | 227 | GPIO_STATUS=(PL_GPIO_1_STATUS)?(GPIO_STATUS)||((uint16_t)(0x1<<8)):(GPIO_STATUS)&(~((uint16_t)(0x1<<8))); |
chaithanyarss | 187:2c7263530c57 | 228 | //PL_GPIO_2_STATUS //$ |
chaithanyarss | 187:2c7263530c57 | 229 | GPIO_STATUS=(PL_GPIO_2_STATUS)?(GPIO_STATUS)||((uint16_t)(0x1<<7)):(GPIO_STATUS)&(~((uint16_t)(0x1<<7))); |
chaithanyarss | 187:2c7263530c57 | 230 | //PL_GPIO_3_STATUS //$ |
chaithanyarss | 187:2c7263530c57 | 231 | GPIO_STATUS=(PL_GPIO_3_STATUS)?(GPIO_STATUS)||((uint16_t)(0x1<<6)):(GPIO_STATUS)&(~((uint16_t)(0x1<<6))); |
chaithanyarss | 187:2c7263530c57 | 232 | //PL_BEE_SW_OC_FAULT //to be verified |
chaithanyarss | 187:2c7263530c57 | 233 | GPIO_STATUS=(PL_BEE_SW_OC_FAULT)?(GPIO_STATUS)||((uint16_t)(0x1<<5)):(GPIO_STATUS)&(~((uint16_t)(0x1<<5))); |
chaithanyarss | 187:2c7263530c57 | 234 | //PL_EPS_LATCH_SW_OC_FAULT // to be verified |
chaithanyarss | 187:2c7263530c57 | 235 | GPIO_STATUS=(PL_EPS_LATCH_SW_OC_FAULT)?(GPIO_STATUS)||((uint16_t)(0x1<<4)):(GPIO_STATUS)&(~((uint16_t)(0x1<<4))); |
chaithanyarss | 187:2c7263530c57 | 236 | |
chaithanyarss | 187:2c7263530c57 | 237 | } |
chaithanyarss | 187:2c7263530c57 | 238 | |
chaithanyarss | 187:2c7263530c57 | 239 | void VERIFY_COMRX() |
chaithanyarss | 187:2c7263530c57 | 240 | { |
chaithanyarss | 187:2c7263530c57 | 241 | //COMRX_OC_FAULT //$ |
chaithanyarss | 187:2c7263530c57 | 242 | if(PIN68==0 && RSSI_volatge > 0.4) |
chaithanyarss | 187:2c7263530c57 | 243 | COMRX_STATUS = COMRX_ALIVE; |
chaithanyarss | 187:2c7263530c57 | 244 | else |
chaithanyarss | 187:2c7263530c57 | 245 | { |
chaithanyarss | 187:2c7263530c57 | 246 | RESET_COMRX(); |
chaithanyarss | 187:2c7263530c57 | 247 | COMRX_RESET_COUNTER++; |
chaithanyarss | 187:2c7263530c57 | 248 | if(PIN68==0 && RSSI_volatge > 0.4) |
chaithanyarss | 187:2c7263530c57 | 249 | COMRX_STATUS = COMRX_ALIVE; |
chaithanyarss | 187:2c7263530c57 | 250 | else |
chaithanyarss | 187:2c7263530c57 | 251 | COMRX_STATUS = COMRX_DEAD; |
chaithanyarss | 187:2c7263530c57 | 252 | } |
chaithanyarss | 187:2c7263530c57 | 253 | } |
chaithanyarss | 187:2c7263530c57 | 254 | |
chaithanyarss | 187:2c7263530c57 | 255 | void VERIFY_RTC(){ |
chaithanyarss | 187:2c7263530c57 | 256 | |
chaithanyarss | 187:2c7263530c57 | 257 | if(RTC_STATUS = 0x00) |
chaithanyarss | 187:2c7263530c57 | 258 | { |
chaithanyarss | 187:2c7263530c57 | 259 | SPI_mutex.lock(); |
chaithanyarss | 187:2c7263530c57 | 260 | gCS_RTC=1; |
chaithanyarss | 187:2c7263530c57 | 261 | gCS_RTC=0; |
chaithanyarss | 187:2c7263530c57 | 262 | spi.write(0x0F); |
chaithanyarss | 187:2c7263530c57 | 263 | if(spi.write(0x00) & 0x04 == 0x04) |
chaithanyarss | 187:2c7263530c57 | 264 | { |
chaithanyarss | 187:2c7263530c57 | 265 | RTC_STATUS = Not_started; |
chaithanyarss | 187:2c7263530c57 | 266 | RESET_RTC(); |
chaithanyarss | 187:2c7263530c57 | 267 | RTC_FAULTCOUNT++; |
chaithanyarss | 187:2c7263530c57 | 268 | } |
chaithanyarss | 187:2c7263530c57 | 269 | gCS_RTC=1; |
chaithanyarss | 187:2c7263530c57 | 270 | SPI_mutex.unlock(); |
chaithanyarss | 187:2c7263530c57 | 271 | } |
chaithanyarss | 187:2c7263530c57 | 272 | } |
chaithanyarss | 187:2c7263530c57 | 273 | |
chaithanyarss | 187:2c7263530c57 | 274 | void HANDLE_HW_FAULTS() |
chaithanyarss | 187:2c7263530c57 | 275 | { |
chaithanyarss | 187:2c7263530c57 | 276 | HANDLE_HW_FAULT_SD(); |
chaithanyarss | 187:2c7263530c57 | 277 | HANDLE_HW_FAULT_BAE(); |
chaithanyarss | 187:2c7263530c57 | 278 | HANDLE_HW_FAULT_PL() |
chaithanyarss | 187:2c7263530c57 | 279 | } |
chaithanyarss | 187:2c7263530c57 | 280 | |
chaithanyarss | 187:2c7263530c57 | 281 | void HANDLE_HW_FAULT_SD() |
chaithanyarss | 187:2c7263530c57 | 282 | { |
chaithanyarss | 187:2c7263530c57 | 283 | if(SD_STATUS != DEVICE_DISABLED) |
chaithanyarss | 187:2c7263530c57 | 284 | { |
chaithanyarss | 187:2c7263530c57 | 285 | if(SD_STATUS = DEVICE_OC_FAULT) |
chaithanyarss | 187:2c7263530c57 | 286 | SD_SW_EN_DS = 0; //powering on SD |
chaithanyarss | 187:2c7263530c57 | 287 | |
chaithanyarss | 187:2c7263530c57 | 288 | if(SD_OC_FAULT == 0) |
chaithanyarss | 187:2c7263530c57 | 289 | { |
chaithanyarss | 187:2c7263530c57 | 290 | SD_SW_EN_DS = 1; //switching off SD card |
chaithanyarss | 187:2c7263530c57 | 291 | |
chaithanyarss | 187:2c7263530c57 | 292 | SD_FAULTCOUNT++; |
chaithanyarss | 187:2c7263530c57 | 293 | SD_STATUS = (SD_FAULTCOUNT == 3)?DEVICE_DISABLED:DEVICE_OC_FAULT; |
chaithanyarss | 187:2c7263530c57 | 294 | } |
chaithanyarss | 187:2c7263530c57 | 295 | else |
chaithanyarss | 187:2c7263530c57 | 296 | { |
chaithanyarss | 187:2c7263530c57 | 297 | SD_STATUS = DEVICE_POWERED; |
chaithanyarss | 187:2c7263530c57 | 298 | SD_FAULTCOUNT = 0; |
chaithanyarss | 187:2c7263530c57 | 299 | } |
chaithanyarss | 187:2c7263530c57 | 300 | } |
chaithanyarss | 187:2c7263530c57 | 301 | } |
chaithanyarss | 187:2c7263530c57 | 302 | |
chaithanyarss | 187:2c7263530c57 | 303 | void HANDLE_HW_FAULT_BAE() |
chaithanyarss | 187:2c7263530c57 | 304 | { |
chaithanyarss | 187:2c7263530c57 | 305 | if(BAE_STATUS != DEVICE_DISABLED) |
chaithanyarss | 187:2c7263530c57 | 306 | { |
chaithanyarss | 187:2c7263530c57 | 307 | if(BAE_STATUS = DEVICE_OC_FAULT) |
chaithanyarss | 187:2c7263530c57 | 308 | BAE_SW_EN_DS = 1; //Power ON BAE |
chaithanyarss | 187:2c7263530c57 | 309 | |
chaithanyarss | 187:2c7263530c57 | 310 | if(BAE_OC_FAULT == 0) // If OC Fault |
chaithanyarss | 187:2c7263530c57 | 311 | { |
chaithanyarss | 187:2c7263530c57 | 312 | BAE_SW_EN_DS = 0; //Switch OFF BAE |
chaithanyarss | 187:2c7263530c57 | 313 | BAE_FAULTCOUNT++; |
chaithanyarss | 187:2c7263530c57 | 314 | BAE_STATUS = (BAE_FAULTCOUNT == 3)?DEVICE_DISABLED:DEVICE_OC_FAULT; |
chaithanyarss | 187:2c7263530c57 | 315 | } |
chaithanyarss | 187:2c7263530c57 | 316 | else |
chaithanyarss | 187:2c7263530c57 | 317 | { |
chaithanyarss | 187:2c7263530c57 | 318 | BAE_STATUS = DEVICE_POWERED; |
chaithanyarss | 187:2c7263530c57 | 319 | BAE_FAULTCOUNT = 0; |
chaithanyarss | 187:2c7263530c57 | 320 | } |
chaithanyarss | 187:2c7263530c57 | 321 | } |
chaithanyarss | 187:2c7263530c57 | 322 | } |
chaithanyarss | 187:2c7263530c57 | 323 | |
chaithanyarss | 187:2c7263530c57 | 324 | void HANDLE_HW_FAULT_PL() |
chaithanyarss | 187:2c7263530c57 | 325 | { |
chaithanyarss | 187:2c7263530c57 | 326 | if(PL_STATUS != DEVICE_DISABLED) |
chaithanyarss | 187:2c7263530c57 | 327 | { |
chaithanyarss | 187:2c7263530c57 | 328 | if(PL_STATUS = DEVICE_OC_FAULT) |
chaithanyarss | 187:2c7263530c57 | 329 | PL_SW_EN_DS = 1; //Power ON PL |
chaithanyarss | 187:2c7263530c57 | 330 | |
chaithanyarss | 187:2c7263530c57 | 331 | if(PL_BEE_SW_OC_FAULT == 1) // if OC Fault |
chaithanyarss | 187:2c7263530c57 | 332 | { |
chaithanyarss | 187:2c7263530c57 | 333 | PL_SW_EN_DS = 0; // switching OFF PL |
chaithanyarss | 187:2c7263530c57 | 334 | PL_FAULTCOUNT++; |
chaithanyarss | 187:2c7263530c57 | 335 | PL_STATUS = (PL_FAULTCOUNT == 3)?DEVICE_DISABLED:DEVICE_OC_FAULT; |
chaithanyarss | 187:2c7263530c57 | 336 | } |
chaithanyarss | 187:2c7263530c57 | 337 | else |
chaithanyarss | 187:2c7263530c57 | 338 | { |
chaithanyarss | 187:2c7263530c57 | 339 | if(PL_STATUS == DEVICE_OC_FAULT) |
chaithanyarss | 187:2c7263530c57 | 340 | PL_SW_EN_DS = 0; //Switching OFF PL |
chaithanyarss | 187:2c7263530c57 | 341 | PL_STATUS = DEVICE_ENABLED; |
chaithanyarss | 187:2c7263530c57 | 342 | PL_FAULTCOUNT = 0; |
chaithanyarss | 187:2c7263530c57 | 343 | } |
chaithanyarss | 187:2c7263530c57 | 344 | } |
chaithanyarss | 187:2c7263530c57 | 345 | |
chaithanyarss | 187:2c7263530c57 | 346 | void COLLECT_CDMS_RAM() |
chaithanyarss | 187:2c7263530c57 | 347 | { |
chaithanyarss | 187:2c7263530c57 | 348 | /*--------------------Current FSC's---------------------*/\ |
chaithanyarss | 187:2c7263530c57 | 349 | for(int i=0;i<4;i++) |
chaithanyarss | 187:2c7263530c57 | 350 | CDMS_HEALTH_DATA[i+43] = CURRENT_FSC_HK_ARCH_BAE >> (i*8); |
chaithanyarss | 187:2c7263530c57 | 351 | for(int i=0;i<4;i++) |
chaithanyarss | 187:2c7263530c57 | 352 | CDMS_HEALTH_DATA[i+47] = CURRENT_FSC_HK_ARCH_CDMS >> (i*8); |
chaithanyarss | 187:2c7263530c57 | 353 | for(int i=0;i<4;i++) |
chaithanyarss | 187:2c7263530c57 | 354 | CDMS_HEALTH_DATA[i+51] = CURRENT_FSC_SFF_BT >> (i*8); |
chaithanyarss | 187:2c7263530c57 | 355 | for(int i=0;i<4;i++) |
chaithanyarss | 187:2c7263530c57 | 356 | CDMS_HEALTH_DATA[i+55] = CURRENT_FSC_SFF_AT >> (i*8); |
chaithanyarss | 187:2c7263530c57 | 357 | for(int i=0;i<4;i++) |
chaithanyarss | 187:2c7263530c57 | 358 | CDMS_HEALTH_DATA[i+59] = CURRENT_FSC_SCF >> (i*8); |
chaithanyarss | 187:2c7263530c57 | 359 | |
chaithanyarss | 187:2c7263530c57 | 360 | /*---------------------Latest Time----------------------*/ |
chaithanyarss | 187:2c7263530c57 | 361 | for(int i=0;i<4;i++) |
chaithanyarss | 187:2c7263530c57 | 362 | CDMS_HEALTH_DATA[i+63] = TIME_LATEST_SPI_SPEED >> (i*8); |
chaithanyarss | 187:2c7263530c57 | 363 | for(int i=0;i<4;i++) |
chaithanyarss | 187:2c7263530c57 | 364 | CDMS_HEALTH_DATA[i+67] = TIME_LATEST_SD_RD >> (i*8); |
chaithanyarss | 187:2c7263530c57 | 365 | for(int i=0;i<4;i++) |
chaithanyarss | 187:2c7263530c57 | 366 | CDMS_HEALTH_DATA[i+71] = TIME_LATEST_SD_WR >> (i*8); |
chaithanyarss | 187:2c7263530c57 | 367 | for(int i=0;i<4;i++) |
chaithanyarss | 187:2c7263530c57 | 368 | CDMS_HEALTH_DATA[i+75] = TIME_LATEST_I2C_SPEED >> (i*8); |
chaithanyarss | 187:2c7263530c57 | 369 | for(int i=0;i<4;i++) |
chaithanyarss | 187:2c7263530c57 | 370 | CDMS_HEALTH_DATA[i+79] = TIME_LATEST_I2C_BAE >> (i*8); |
chaithanyarss | 187:2c7263530c57 | 371 | for(int i=0;i<4;i++) |
chaithanyarss | 187:2c7263530c57 | 372 | CDMS_HEALTH_DATA[i+83] = TIME_LATEST_RTC >> (i*8); |
chaithanyarss | 187:2c7263530c57 | 373 | for(int i=0;i<2;i++) |
chaithanyarss | 187:2c7263530c57 | 374 | CDMS_HEALTH_DATA[i+87] = COMRX_RESET_COUNTER >> (i*8); |
chaithanyarss | 187:2c7263530c57 | 375 | for(int i=0;i<2;i++) |
chaithanyarss | 187:2c7263530c57 | 376 | CDMS_HEALTH_DATA[i+89] = PL_RCV_SC_DATA_COUNTER >> (i*8); |
chaithanyarss | 187:2c7263530c57 | 377 | for(int i=0;i<2;i++) |
chaithanyarss | 187:2c7263530c57 | 378 | CDMS_HEALTH_DATA[i+91] = PL_MAIN_COUNTER >> (i*8); |
chaithanyarss | 187:2c7263530c57 | 379 | for(int i=0;i<2;i++) |
chaithanyarss | 187:2c7263530c57 | 380 | CDMS_HEALTH_DATA[i+93] = CDMS_HK_MAIN_COUNTER >> (i*8); |
chaithanyarss | 187:2c7263530c57 | 381 | for(int i=0;i<2;i++) |
chaithanyarss | 187:2c7263530c57 | 382 | CDMS_HEALTH_DATA[i+95] = CDMS_I2C_ERR_BAE_COUNTER >> (i*8); |
chaithanyarss | 187:2c7263530c57 | 383 | for(int i=0;i<2;i++) |
chaithanyarss | 187:2c7263530c57 | 384 | CDMS_HEALTH_DATA[i+97] = CDMS_I2C_ERR_SPEED_COUNTER >> (i*8); |
chaithanyarss | 187:2c7263530c57 | 385 | CDMS_HEALTH_DATA[100] = CDMS_HEALTH_DATA[100] | CDMS_STANDBY_PL << 7; |
chaithanyarss | 187:2c7263530c57 | 386 | CDMS_HEALTH_DATA[100] = CDMS_HEALTH_DATA[100] | ((CDMS_INIT_STATUS << 6) & 0x40); |
chaithanyarss | 187:2c7263530c57 | 387 | CDMS_HEALTH_DATA[100] = CDMS_HEALTH_DATA[100] | ((CDMS_HK_MAIN_STATUS << 5) & 0x20); |
chaithanyarss | 187:2c7263530c57 | 388 | CDMS_HEALTH_DATA[100] = CDMS_HEALTH_DATA[100] | ((CDMS_HK_STATUS << 3) & 0x18); |
chaithanyarss | 187:2c7263530c57 | 389 | CDMS_HEALTH_DATA[100] = CDMS_HEALTH_DATA[100] | ((COMRX_STATUS << 2) & 0x04); |
chaithanyarss | 187:2c7263530c57 | 390 | CDMS_HEALTH_DATA[100] = CDMS_HEALTH_DATA[100] | ((CDMS_RTC_BL << 1) & 0x02); |
chaithanyarss | 187:2c7263530c57 | 391 | CDMS_HEALTH_DATA[100] = CDMS_HEALTH_DATA[100] & 0xFE; |
chaithanyarss | 187:2c7263530c57 | 392 | |
chaithanyarss | 187:2c7263530c57 | 393 | CDMS_HEALTH_DATA[101] = CDMS_HEALTH_DATA[101] | PL_RCV_SC_DATA_STATUS << 7; |
chaithanyarss | 187:2c7263530c57 | 394 | CDMS_HEALTH_DATA[101] = CDMS_HEALTH_DATA[101] | ((COM_SESSION << 6) & 0x40); |
chaithanyarss | 187:2c7263530c57 | 395 | CDMS_HEALTH_DATA[101] = CDMS_HEALTH_DATA[101] | ((COM_RX << 5) & 0x20); |
chaithanyarss | 187:2c7263530c57 | 396 | CDMS_HEALTH_DATA[101] = CDMS_HEALTH_DATA[101] | ((RF_SW_STATUS << 4) & 0x10); |
chaithanyarss | 187:2c7263530c57 | 397 | CDMS_HEALTH_DATA[101] = CDMS_HEALTH_DATA[101] | ((COM_TX << 3) & 0x08); |
chaithanyarss | 187:2c7263530c57 | 398 | CDMS_HEALTH_DATA[101] = CDMS_HEALTH_DATA[101] | ((COM_TX_STATUS << 2) & 0x04); |
chaithanyarss | 187:2c7263530c57 | 399 | CDMS_HEALTH_DATA[101] = CDMS_HEALTH_DATA[101] | ((COM_MNG_TMTC << 1) & 0x02); |
chaithanyarss | 187:2c7263530c57 | 400 | CDMS_HEALTH_DATA[101] = CDMS_HEALTH_DATA[101] | (CDMS_STANDBY_HK & 0x01); |
chaithanyarss | 187:2c7263530c57 | 401 | |
chaithanyarss | 187:2c7263530c57 | 402 | CDMS_HEALTH_DATA[102] = CDMS_HEALTH_DATA[102] | PL_INIT_STATUS << 7; |
chaithanyarss | 187:2c7263530c57 | 403 | CDMS_HEALTH_DATA[102] = CDMS_HEALTH_DATA[102] | ((PL_MAIN_STATUS << 6) & 0x40); |
chaithanyarss | 187:2c7263530c57 | 404 | CDMS_HEALTH_DATA[102] = CDMS_HEALTH_DATA[102] | ((PL_LOW_POWER << 5) & 0x20); |
chaithanyarss | 187:2c7263530c57 | 405 | CDMS_HEALTH_DATA[102] = CDMS_HEALTH_DATA[102] | ((PL_STATE << 3) & 0x18); |
chaithanyarss | 187:2c7263530c57 | 406 | CDMS_HEALTH_DATA[102] = CDMS_HEALTH_DATA[102] | (PL_STATUS & 0x07); |
shreeshas95 | 103:b55559925dc1 | 407 | } |