Mercurial > public > ostc4
annotate Small_CPU/Src/scheduler.c @ 796:75ace7af8212
Expanded Sensor map structure:
In the previous version the number of possible sensors were set to 5 based on the assumption that ADC slots are shared with digital O2 sensors. As result three of five slots would have been limited to O2 measurement usecase, leaving just two slots left for other sensors (e.g. CO2). In order to have as much flexibility (and less risk for data structure changes) the number of sensors has been set to 7 (3 ADC + 4 UART MUX)
| author | Ideenmodellierer |
|---|---|
| date | Mon, 31 Jul 2023 20:00:06 +0200 |
| parents | bb37d4f3e50e |
| children | 91d5ef16f1fd |
| rev | line source |
|---|---|
| 38 | 1 /** |
| 2 ****************************************************************************** | |
| 3 * @file scheduler.c | |
| 4 * @author heinrichs weikamp gmbh | |
| 5 * @date 27-March-2014 | |
| 6 * @version V0.0.6 | |
| 7 * @since 18-June-2015 | |
| 8 * @brief the main part except for base.c | |
| 9 * | |
| 10 @verbatim | |
| 11 ============================================================================== | |
| 12 ##### How to use ##### | |
| 13 ============================================================================== | |
| 14 @endverbatim | |
| 15 ****************************************************************************** | |
| 16 * @attention | |
| 17 * | |
| 18 * <h2><center>© COPYRIGHT(c) 2015 heinrichs weikamp</center></h2> | |
| 19 * | |
| 20 ****************************************************************************** | |
| 21 */ | |
| 22 | |
| 23 | |
| 24 //#define DEBUGMODE | |
| 25 | |
| 26 /* Includes ------------------------------------------------------------------*/ | |
| 27 #include <string.h> | |
| 28 #include "baseCPU2.h" | |
| 29 #include "stm32f4xx_hal.h" | |
| 30 #include "i2c.h" | |
| 31 #include "scheduler.h" | |
| 32 #include "pressure.h" | |
| 33 #include "compass.h" | |
| 34 #include "batteryGasGauge.h" | |
| 35 #include "batteryCharger.h" | |
| 36 #include "spi.h" | |
| 37 #include "rtc.h" | |
| 38 #include "dma.h" | |
| 39 #include "adc.h" | |
| 40 #include "calc_crush.h" | |
| 41 #include "stm32f4xx_hal_rtc_ex.h" | |
| 42 #include "decom.h" | |
| 43 #include "tm_stm32f4_otp.h" | |
|
554
3328189786e7
Added external ADC interface functionality (MCP3424):
Ideenmodellierer
parents:
488
diff
changeset
|
44 #include "externalInterface.h" |
| 662 | 45 #include "uart.h" |
| 38 | 46 |
|
414
6886aeeca454
Added compile switch for restoring of last known date after power lost:
ideenmodellierer
parents:
409
diff
changeset
|
47 /* uncomment to enable restoting of last known date in case of a power loss (RTC looses timing data) */ |
|
6886aeeca454
Added compile switch for restoring of last known date after power lost:
ideenmodellierer
parents:
409
diff
changeset
|
48 /* #define RESTORE_LAST_KNOWN_DATE */ |
| 38 | 49 |
| 475 | 50 #define INVALID_PREASURE_VALUE (0.0f) |
|
338
b6a59e93cc91
Added function to avoid divemode activation during Landing:
ideenmodellierer
parents:
331
diff
changeset
|
51 #define START_DIVE_MOUNTAIN_MODE_BAR (0.88f) |
|
b6a59e93cc91
Added function to avoid divemode activation during Landing:
ideenmodellierer
parents:
331
diff
changeset
|
52 #define START_DIVE_IMMEDIATLY_BAR (1.16f) |
| 135 | 53 |
| 38 | 54 /* Private types -------------------------------------------------------------*/ |
| 55 const SGas Air = {79,0,0,0,0}; | |
| 56 | |
| 57 /* Exported variables --------------------------------------------------------*/ | |
| 58 SGlobal global; | |
| 59 SDevice DeviceDataFlash; | |
| 60 uint8_t deviceDataFlashValid = 0; | |
| 61 uint8_t deviceDataSubSeconds = 0; | |
| 62 | |
| 63 /* Private variables ---------------------------------------------------------*/ | |
|
346
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
64 static uint16_t ManualExitDiveCounter = 0; /* The computer will exit dive mode in shallow area immediately. Increase depth to restart dive while counter is active */ |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
65 |
| 38 | 66 /* can be lost while in sleep */ |
| 67 uint8_t clearDecoNow = 0; | |
| 68 uint8_t setButtonsNow = 0; | |
| 69 | |
| 70 /* has to be in SRAM2 */ | |
| 71 uint8_t secondsCount = 0; | |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
72 |
| 207 | 73 static uint8_t dospisync = SPI_SYNC_METHOD_NONE; |
| 74 | |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
75 SScheduleCtrl Scheduler; |
| 38 | 76 |
| 77 /* Private function prototypes -----------------------------------------------*/ | |
| 78 | |
| 79 _Bool vpm_crush2(void); | |
| 80 void scheduleUpdateDeviceData(void); | |
| 81 long get_nofly_time_minutes(void); | |
| 82 void copyActualGas(SGas gas); | |
| 83 void copyPressureData(void); | |
| 84 void copyCnsAndOtuData(void); | |
| 85 void copyTimeData(void); | |
| 86 void copyCompassData(void); | |
| 87 void copyCompassDataDuringCalibration(int16_t dx, int16_t dy, int16_t dz); | |
| 88 void copyAmbientLightData(void); | |
| 89 void copyTissueData(void); | |
| 90 void copyVpmCrushingData(void); | |
| 91 void copyDeviceData(void); | |
| 92 void copyPICdata(void); | |
|
554
3328189786e7
Added external ADC interface functionality (MCP3424):
Ideenmodellierer
parents:
488
diff
changeset
|
93 void copyExtADCdata(); |
| 662 | 94 void copyExtCO2data(); |
|
230
3973208c4a20
cleanup: make return void when never used
Jan Mulder <jlmulder@xs4all.nl>
parents:
220
diff
changeset
|
95 static void schedule_update_timer_helper(int8_t thisSeconds); |
| 38 | 96 uint32_t time_elapsed_ms(uint32_t ticksstart,uint32_t ticksnow); |
| 97 | |
| 98 void scheduleSetDate(SDeviceLine *line); | |
| 99 | |
| 100 /* Exported functions --------------------------------------------------------*/ | |
| 101 | |
| 102 void initGlobals(void) | |
| 103 { | |
|
231
f6961efb3794
cleanup: do not re-implement a standard function
Jan Mulder <jlmulder@xs4all.nl>
parents:
230
diff
changeset
|
104 bzero(&global, sizeof(SGlobal)); |
| 38 | 105 |
| 106 global.dataSendToSlavePending = 0; | |
| 107 global.dataSendToSlaveIsValid = 1; | |
| 108 global.dataSendToSlaveIsNotValidCount = 0; | |
| 109 | |
| 110 global.mode = MODE_POWERUP; | |
| 111 global.repetitive_dive = 0; | |
| 112 global.conservatism = 0; | |
| 113 global.whichGas = 0; | |
| 114 global.aktualGas[0] = Air; | |
| 115 global.lifeData.actualGas = global.aktualGas[0]; | |
| 116 | |
| 475 | 117 const uint8_t button_standard_sensitivity = 51; /* 51 equals a percentage of 85% which was the default value before */ |
| 38 | 118 global.ButtonResponsiveness[0] = button_standard_sensitivity; |
| 119 global.ButtonResponsiveness[1] = button_standard_sensitivity; | |
| 120 global.ButtonResponsiveness[2] = button_standard_sensitivity; | |
| 121 global.ButtonResponsiveness[3] = button_standard_sensitivity; | |
| 122 | |
| 123 global.ButtonPICdata[0] = 0xFF; | |
| 124 global.ButtonPICdata[1] = 0xFF; | |
| 125 global.ButtonPICdata[2] = 0xFF; | |
| 126 global.ButtonPICdata[3] = 0xFF; | |
| 127 | |
|
240
625d20070261
Improvement SPI stability/recoverability
Jan Mulder <jlmulder@xs4all.nl>
parents:
231
diff
changeset
|
128 global.I2C_SystemStatus = HAL_ERROR; // 0x00 would be everything working |
| 38 | 129 |
| 668 | 130 global.lifeData.battery_voltage = BATTERY_DEFAULT_VOLTAGE; |
| 131 | |
| 135 | 132 global.lifeData.pressure_ambient_bar = INVALID_PREASURE_VALUE; |
| 133 global.lifeData.pressure_surface_bar = INVALID_PREASURE_VALUE; | |
| 38 | 134 decom_reset_with_1000mbar(&global.lifeData); |
| 135 | |
| 136 global.demo_mode = 0; | |
| 137 | |
| 138 for(int i = 0; i < MAX_SENSORS; i++) | |
| 139 { | |
| 140 global.sensorError[i] = HAL_OK; // HAL_OK = 0; | |
| 141 } | |
| 142 | |
| 143 global.dataSendToMaster.RTE_VERSION_high = firmwareVersionHigh();//RTE_VERSION_HIGH;; | |
| 144 global.dataSendToMaster.RTE_VERSION_low = firmwareVersionLow();//RTE_VERSION_LOW;; | |
| 145 global.dataSendToMaster.chargeStatus = 0; | |
| 146 | |
| 475 | 147 global.dataSendToMaster.power_on_reset = 0; |
| 38 | 148 global.dataSendToMaster.header.checkCode[0] = 0xA1; |
|
264
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
149 global.dataSendToMaster.header.checkCode[1] = SPI_RX_STATE_OFFLINE; |
| 38 | 150 global.dataSendToMaster.header.checkCode[2] = 0xA3; |
| 151 global.dataSendToMaster.header.checkCode[3] = 0xA4; | |
| 152 global.dataSendToMaster.footer.checkCode[3] = 0xE4; | |
| 153 global.dataSendToMaster.footer.checkCode[2] = 0xE3; | |
| 154 global.dataSendToMaster.footer.checkCode[1] = 0xE2; | |
| 155 global.dataSendToMaster.footer.checkCode[0] = 0xE1; | |
| 156 global.dataSendToMaster.sensorErrors = 0; | |
| 157 | |
| 158 global.sync_error_count = 0; | |
| 159 global.check_sync_not_running = 0; | |
| 160 | |
| 161 global.deviceDataSendToMaster.RTE_VERSION_high = firmwareVersionHigh();//RTE_VERSION_HIGH; | |
| 162 global.deviceDataSendToMaster.RTE_VERSION_low = firmwareVersionLow();//RTE_VERSION_LOW; | |
| 163 global.deviceDataSendToMaster.chargeStatus = 0; | |
| 164 | |
| 475 | 165 global.deviceDataSendToMaster.power_on_reset = 0; |
| 38 | 166 global.deviceDataSendToMaster.header.checkCode[0] = 0xDF; |
| 167 global.deviceDataSendToMaster.header.checkCode[1] = 0xDE; | |
| 168 global.deviceDataSendToMaster.header.checkCode[2] = 0xDD; | |
| 169 global.deviceDataSendToMaster.header.checkCode[3] = 0xDC; | |
| 170 global.deviceDataSendToMaster.footer.checkCode[3] = 0xE4; | |
| 171 global.deviceDataSendToMaster.footer.checkCode[2] = 0xE3; | |
| 172 global.deviceDataSendToMaster.footer.checkCode[1] = 0xE2; | |
| 173 global.deviceDataSendToMaster.footer.checkCode[0] = 0xE1; | |
| 174 | |
| 175 global.dataSendToSlave.getDeviceDataNow = 0; | |
| 176 | |
| 177 global.deviceData.batteryChargeCompleteCycles.value_int32 = 0; | |
| 178 global.deviceData.batteryChargeCycles.value_int32 = 0; | |
| 179 global.deviceData.depthMaximum.value_int32 = 0; | |
| 180 global.deviceData.diveCycles.value_int32 = 0; | |
| 181 global.deviceData.hoursOfOperation.value_int32 = 0; | |
| 182 global.deviceData.temperatureMaximum.value_int32 = INT32_MIN; | |
| 183 global.deviceData.temperatureMinimum.value_int32 = INT32_MAX; | |
| 184 global.deviceData.voltageMinimum.value_int32 = INT32_MAX; | |
|
148
ee744c7160ce
Use SPI TX callback to synchronize to main CPU
Ideenmodellierer
parents:
142
diff
changeset
|
185 |
|
265
a91d99265884
Increase SPI com timeout for cold start and wake up
ideenmodellierer
parents:
264
diff
changeset
|
186 Scheduler.communicationTimeout = SPI_COM_TIMEOUT_START; |
| 207 | 187 Scheduler_Request_sync_with_SPI(SPI_SYNC_METHOD_HARD); |
| 38 | 188 } |
| 189 | |
|
264
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
190 void reinitGlobals(void) |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
191 { |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
192 global.dataSendToSlavePending = 0; |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
193 global.dataSendToSlaveIsValid = 0; |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
194 global.dataSendToSlaveIsNotValidCount = 0; |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
195 global.sync_error_count = 0; |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
196 global.check_sync_not_running = 0; |
|
265
a91d99265884
Increase SPI com timeout for cold start and wake up
ideenmodellierer
parents:
264
diff
changeset
|
197 Scheduler.communicationTimeout = SPI_COM_TIMEOUT_START; |
|
264
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
198 } |
| 38 | 199 |
| 200 void scheduleSpecial_Evaluate_DataSendToSlave(void) | |
| 201 { | |
| 104 | 202 //TEMPORARY fix for compass calibration. |
| 203 //TODO: Fix I2C timeout for complete solving problem. | |
| 204 if(global.mode==MODE_CALIB){ | |
| 205 return; | |
| 206 } | |
| 90 | 207 |
| 88 | 208 global.dataSendToSlavePending = 0; |
| 209 if(!global.dataSendToSlaveIsValid) return; | |
| 38 | 210 |
| 211 global.dataSendToMaster.confirmRequest.uw = 0; | |
| 212 | |
| 213 if(TM_OTP_Read(0,0) == 0xFF) | |
| 214 { | |
| 215 if(global.dataSendToSlave.revisionHardware == (global.dataSendToSlave.revisionCRCx0x7A ^ 0x7A)) | |
| 216 TM_OTP_Write(0,0,global.dataSendToSlave.revisionHardware); | |
| 217 } | |
| 218 | |
| 219 if(global.dataSendToSlave.setAccidentFlag) | |
| 220 { | |
| 221 global.dataSendToMaster.confirmRequest.ub.accident = 1; | |
| 222 global.deviceData.diveAccident.value_int32 = global.dataSendToSlave.setAccidentFlag; | |
| 223 scheduleSetDate(&global.deviceData.diveAccident); | |
| 224 global.accidentFlag |= global.dataSendToSlave.setAccidentFlag; | |
| 225 if(global.accidentFlag == ACCIDENT_CNS) // LVL1 | |
| 226 global.accidentRemainingSeconds = 2*60*60; | |
| 227 else | |
| 228 global.accidentRemainingSeconds = 24*60*60; | |
| 229 } | |
| 230 | |
| 231 if(global.dataSendToSlave.setTimeNow) | |
| 232 { | |
| 233 global.dataSendToMaster.confirmRequest.ub.time = 1; | |
| 234 RTC_SetTime(global.dataSendToSlave.data.newTime); | |
| 235 schedule_update_timer_helper(0); | |
| 236 } | |
| 237 | |
| 238 if(global.dataSendToSlave.setDateNow) | |
| 239 { | |
| 240 global.dataSendToMaster.confirmRequest.ub.date = 1; | |
| 241 RTC_SetDate(global.dataSendToSlave.data.newDate); | |
| 242 schedule_update_timer_helper(0); | |
| 243 } | |
| 244 | |
| 245 if(global.dataSendToSlave.calibrateCompassNow) | |
| 246 { | |
| 247 global.dataSendToMaster.confirmRequest.ub.compass = 1; | |
| 248 global.mode = MODE_CALIB; | |
| 249 } | |
| 250 | |
| 251 if(global.dataSendToSlave.clearDecoNow) | |
| 252 { | |
| 253 global.dataSendToMaster.confirmRequest.ub.clearDeco = 1; | |
| 254 clearDecoNow = 1; | |
| 255 } | |
| 256 | |
| 257 if(global.dataSendToSlave.setButtonSensitivityNow) | |
| 258 { | |
| 259 global.dataSendToMaster.confirmRequest.ub.button = 1; | |
| 260 global.ButtonResponsiveness[0] = global.dataSendToSlave.data.buttonResponsiveness[0]; | |
| 261 global.ButtonResponsiveness[1] = global.dataSendToSlave.data.buttonResponsiveness[1]; | |
| 262 global.ButtonResponsiveness[2] = global.dataSendToSlave.data.buttonResponsiveness[2]; | |
| 263 global.ButtonResponsiveness[3] = global.dataSendToSlave.data.buttonResponsiveness[3]; | |
| 264 setButtonsNow = 1; | |
| 265 } | |
| 266 | |
| 267 if(global.dataSendToSlave.setBatteryGaugeNow) | |
| 268 { | |
| 104 | 269 if(global.mode!=MODE_CALIB){ |
| 38 | 270 global.dataSendToMaster.confirmRequest.ub.batterygauge = 1; |
| 271 battery_gas_gauge_set(global.dataSendToSlave.data.newBatteryGaugePercentageFloat); | |
| 104 | 272 } |
| 38 | 273 } |
| 274 | |
|
346
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
275 if(global.dataSendToSlave.setEndDive) |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
276 { |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
277 ManualExitDiveCounter = 30 * 60; /* This will cause the computer to leave dive mode if in shallow area and increase the depth to enter dive mode for the next 30 minutes */ |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
278 } |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
279 |
| 38 | 280 if((global.mode == MODE_SURFACE) && (global.dataSendToSlave.mode == MODE_SHUTDOWN)) |
| 281 { | |
| 282 global.mode = MODE_SHUTDOWN; | |
| 283 } | |
| 284 | |
| 285 if(global.mode == MODE_DIVE) | |
| 286 { | |
| 287 copyActualGas(global.dataSendToSlave.data.actualGas); | |
| 288 } | |
| 289 else | |
| 290 { | |
| 291 copyActualGas(Air); | |
| 292 global.settings.divetimeToCreateLogbook = global.dataSendToSlave.data.divetimeToCreateLogbook; | |
| 293 global.settings.timeoutDiveReachedZeroDepth = global.dataSendToSlave.data.timeoutDiveReachedZeroDepth; | |
| 294 } | |
| 295 | |
| 296 /* for simulation / testing */ | |
| 297 global.ceiling_from_main_CPU_mbar = global.dataSendToSlave.data.ambient_pressure_mbar_ceiling; | |
| 298 | |
|
338
b6a59e93cc91
Added function to avoid divemode activation during Landing:
ideenmodellierer
parents:
331
diff
changeset
|
299 /* Set pressure and temperature offsets */ |
|
b6a59e93cc91
Added function to avoid divemode activation during Landing:
ideenmodellierer
parents:
331
diff
changeset
|
300 pressure_set_offset (global.dataSendToSlave.data.offsetPressureSensor_mbar, global.dataSendToSlave.data.offsetTemperatureSensor_centiDegree); |
|
b6a59e93cc91
Added function to avoid divemode activation during Landing:
ideenmodellierer
parents:
331
diff
changeset
|
301 |
|
b6a59e93cc91
Added function to avoid divemode activation during Landing:
ideenmodellierer
parents:
331
diff
changeset
|
302 |
| 88 | 303 /* for device data updates */ |
| 304 deviceDataFlashValid = 0; | |
| 305 memcpy(&DeviceDataFlash, &global.dataSendToSlave.data.DeviceData, sizeof(SDevice)); | |
| 306 deviceDataFlashValid = 1; | |
| 89 | 307 |
| 662 | 308 |
| 309 /* handle external interface requests */ | |
| 310 | |
| 311 if((global.dataSendToSlave.data.externalInterface_Cmd && EXT_INTERFACE_33V_ON) != externalInterface_isEnabledPower33()) | |
| 312 { | |
| 313 externalInterface_SwitchPower33(global.dataSendToSlave.data.externalInterface_Cmd && EXT_INTERFACE_33V_ON); | |
| 314 } | |
| 315 | |
| 691 | 316 if(((global.dataSendToSlave.data.externalInterface_Cmd & EXT_INTERFACE_ADC_ON) != 0) != externalInterface_isEnabledADC()) |
| 317 { | |
|
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
318 externalInterface_SwitchADC(1-externalInterface_isEnabledADC()); |
| 691 | 319 } |
| 320 | |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
691
diff
changeset
|
321 if(((global.dataSendToSlave.data.externalInterface_Cmd >> 8) & 0x0F) != externalInterface_GetUARTProtocol()) |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
691
diff
changeset
|
322 { |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
691
diff
changeset
|
323 externalInterface_SwitchUART((global.dataSendToSlave.data.externalInterface_Cmd >> 8) & 0x0F); |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
691
diff
changeset
|
324 } |
| 691 | 325 |
|
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
326 externalInface_SetSensorMap(global.dataSendToSlave.data.externalInterface_SensorMap); |
| 691 | 327 if(global.dataSendToSlave.data.externalInterface_Cmd & 0x00FF) /* lowest nibble for commands */ |
| 662 | 328 { |
| 329 externalInterface_ExecuteCmd(global.dataSendToSlave.data.externalInterface_Cmd); | |
| 330 } | |
| 331 | |
| 332 | |
|
264
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
333 #if 0 |
| 104 | 334 //TODO: Temporary placed here. Duration ~210 ms. |
| 335 if (global.I2C_SystemStatus != HAL_OK) { | |
| 336 MX_I2C1_TestAndClear(); | |
| 337 MX_I2C1_Init(); | |
| 338 // init_pressure(); | |
| 339 // compass_init(0, 7); | |
| 340 // accelerator_init(); | |
| 341 } | |
|
264
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
342 #endif /* already called once a second */ |
| 38 | 343 } |
| 344 | |
| 345 | |
| 346 /** | |
| 347 ****************************************************************************** | |
| 348 * @brief schedule_time_compare_helper. | |
| 349 * @author heinrichs weikamp gmbh | |
| 350 * @version V0.0.1 | |
| 351 * @date 20-Oct-2016 | |
| 352 ****************************************************************************** | |
| 353 */ | |
| 354 | |
| 355 uint8_t RtcBugFixChsw(uint8_t inStupidTime) | |
| 356 { | |
| 357 uint8_t multiplesOf16 = 0; | |
| 358 | |
| 359 multiplesOf16 = inStupidTime / 16; | |
| 360 | |
| 361 inStupidTime -= multiplesOf16 * 16; | |
| 362 | |
| 363 return (10 * multiplesOf16) + inStupidTime; | |
| 364 } | |
| 365 | |
| 366 uint32_t schedule_time_compare_helper(RTC_TimeTypeDef timeNow, RTC_DateTypeDef dateNow, RTC_TimeTypeDef timeLast, RTC_DateTypeDef dateLast) | |
| 367 { | |
| 368 uint32_t nowInSeconds; | |
| 369 uint32_t lastInSeconds; | |
| 370 uint32_t resultDiff; | |
| 371 | |
| 372 nowInSeconds = (uint32_t)RtcBugFixChsw(timeNow.Hours) * 3600; | |
| 373 nowInSeconds += (uint32_t)RtcBugFixChsw(timeNow.Minutes) * 60; | |
| 374 nowInSeconds += (uint32_t)RtcBugFixChsw(timeNow.Seconds); | |
| 375 | |
| 376 lastInSeconds = (uint32_t)RtcBugFixChsw(timeLast.Hours) * 3600; | |
| 377 lastInSeconds += (uint32_t)RtcBugFixChsw(timeLast.Minutes) * 60; | |
| 378 lastInSeconds += (uint32_t)RtcBugFixChsw(timeLast.Seconds); | |
| 379 | |
| 380 if(dateNow.Date != dateLast.Date) | |
| 381 { | |
| 382 resultDiff = 86400 + nowInSeconds - lastInSeconds; | |
| 383 } | |
| 384 else | |
| 385 { | |
| 386 resultDiff = nowInSeconds - lastInSeconds; | |
| 387 } | |
| 388 return resultDiff; | |
| 389 } | |
| 390 | |
| 391 | |
| 392 | |
| 393 /** | |
| 394 ****************************************************************************** | |
| 395 * @brief schedule_update_timer_helper. | |
| 396 * @author heinrichs weikamp gmbh | |
| 397 * @version V0.0.1 | |
| 398 * @date 20-Oct-2016 | |
| 399 * @brief use 0 for init | |
| 400 use -1 for RTC controlled | |
| 401 use >= 1 for manual control | |
| 402 ****************************************************************************** | |
| 403 */ | |
| 404 extern RTC_HandleTypeDef RTCHandle; | |
| 405 | |
|
230
3973208c4a20
cleanup: make return void when never used
Jan Mulder <jlmulder@xs4all.nl>
parents:
220
diff
changeset
|
406 static void schedule_update_timer_helper(int8_t thisSeconds) |
| 38 | 407 { |
| 408 static RTC_TimeTypeDef sTimeLast; | |
| 409 static RTC_DateTypeDef sDateLast; | |
| 410 RTC_TimeTypeDef sTimeNow; | |
| 411 RTC_DateTypeDef sDateNow; | |
| 412 uint32_t secondsPast; | |
| 413 | |
| 414 HAL_RTC_GetTime(&RTCHandle, &sTimeNow, RTC_FORMAT_BCD); | |
| 415 HAL_RTC_GetDate(&RTCHandle, &sDateNow, RTC_FORMAT_BCD); | |
| 416 | |
|
230
3973208c4a20
cleanup: make return void when never used
Jan Mulder <jlmulder@xs4all.nl>
parents:
220
diff
changeset
|
417 if(thisSeconds != 0) // otherwise just store sTimeLast, sDateLast |
| 38 | 418 { |
| 419 if(thisSeconds > 0) // use this value instead, good for pre-loading sTimeLast and sDateLast | |
| 420 { | |
| 421 secondsPast = thisSeconds; | |
|
230
3973208c4a20
cleanup: make return void when never used
Jan Mulder <jlmulder@xs4all.nl>
parents:
220
diff
changeset
|
422 } else { |
|
3973208c4a20
cleanup: make return void when never used
Jan Mulder <jlmulder@xs4all.nl>
parents:
220
diff
changeset
|
423 // thisSeconds < 0 and not <= ! |
|
3973208c4a20
cleanup: make return void when never used
Jan Mulder <jlmulder@xs4all.nl>
parents:
220
diff
changeset
|
424 secondsPast = schedule_time_compare_helper(sTimeNow, sDateNow, sTimeLast, sDateLast); |
| 38 | 425 } |
| 426 | |
| 427 if(global.seconds_since_last_dive) | |
| 428 { | |
| 429 if(secondsPast >= 777900) | |
| 430 { | |
| 431 global.seconds_since_last_dive = 0; | |
| 432 } | |
| 433 else | |
| 434 { | |
|
230
3973208c4a20
cleanup: make return void when never used
Jan Mulder <jlmulder@xs4all.nl>
parents:
220
diff
changeset
|
435 uint32_t tempNewValue = ((uint32_t)global.seconds_since_last_dive) + secondsPast; |
| 38 | 436 if(tempNewValue > 777900) // a bit more than nine days [seconds] |
| 437 global.seconds_since_last_dive = 0; | |
| 438 else | |
| 439 global.seconds_since_last_dive = (long)tempNewValue; | |
| 440 } | |
| 441 } | |
| 442 } | |
| 443 | |
| 444 sTimeLast = sTimeNow; | |
| 445 sDateLast = sDateNow; | |
| 446 } | |
| 447 | |
| 448 /** | |
| 449 ****************************************************************************** | |
| 450 * @brief schedule_check_resync. | |
| 451 * @author heinrichs weikamp gmbh | |
| 452 * @version V0.0.2 | |
| 453 * @date 18-June-2015 | |
| 454 ****************************************************************************** | |
| 455 */ | |
| 135 | 456 |
| 38 | 457 void schedule_check_resync(void) |
| 458 { | |
|
155
4fd8bbc7d841
Do hard sync after communication timeout > 1 second
Ideenmodellierer
parents:
148
diff
changeset
|
459 /* counter is incremented in cyclic 100ms loop and reset to 0 if the transmission complete callback is called */ |
|
265
a91d99265884
Increase SPI com timeout for cold start and wake up
ideenmodellierer
parents:
264
diff
changeset
|
460 if((global.check_sync_not_running >= Scheduler.communicationTimeout)) |
| 38 | 461 { |
| 89 | 462 // global.dataSendToSlaveIsNotValidCount = 0; |
| 135 | 463 global.check_sync_not_running = 0; |
| 464 global.sync_error_count++; | |
| 465 | |
| 466 /* Try to start communication again. If exchange is stuck during execution for some reason the TX will be aborted by the | |
| 467 * function error handler | |
| 468 */ | |
| 277 | 469 HAL_SPI_TransmitReceive_DMA(&hspi1,(uint8_t*) &(global.dataSendToMaster),(uint8_t*) &(global.dataSendToSlave), EXCHANGE_BUFFERSIZE); |
|
265
a91d99265884
Increase SPI com timeout for cold start and wake up
ideenmodellierer
parents:
264
diff
changeset
|
470 Scheduler.communicationTimeout = SPI_COM_TIMEOUT_COMMON; /* Reduce error detection time */ |
|
264
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
471 Scheduler_Request_sync_with_SPI(SPI_SYNC_METHOD_HARD); |
|
155
4fd8bbc7d841
Do hard sync after communication timeout > 1 second
Ideenmodellierer
parents:
148
diff
changeset
|
472 } |
| 38 | 473 } |
| 474 | |
| 475 | |
| 476 /** | |
| 477 ****************************************************************************** | |
| 478 * @brief scheduleDiveMode. / Dive Mode: Main Loop | |
|
763
aa6006975e76
increase HAL_Delay to 10ms for cold-start-button reset
heinrichsweikamp
parents:
742
diff
changeset
|
479 * @author heinrichs weikamp gmbh |
| 38 | 480 * @version V0.0.1 |
| 481 * @date 22-April-2014 | |
| 482 ****************************************************************************** | |
| 483 */ | |
| 484 void scheduleDiveMode(void) | |
| 485 { | |
| 486 uint32_t ticksdiff = 0; | |
| 487 uint32_t lasttick = 0; | |
|
554
3328189786e7
Added external ADC interface functionality (MCP3424):
Ideenmodellierer
parents:
488
diff
changeset
|
488 uint8_t extAdcChannel = 0; |
| 38 | 489 uint8_t counterAscentRate = 0; |
| 490 float lastPressure_bar = 0.0f; | |
| 491 global.dataSendToMaster.mode = MODE_DIVE; | |
| 492 global.deviceDataSendToMaster.mode = MODE_DIVE; | |
| 493 uint8_t counter_exit = 0; | |
|
264
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
494 |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
495 Scheduler.counterSPIdata100msec = 0; |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
496 Scheduler.counterCompass100msec = 0; |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
497 Scheduler.counterPressure100msec = 0; |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
498 Scheduler.counterAmbientLight100msec = 0; |
|
220
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
499 Scheduler.tick_execute1second = SCHEDULER_TICK_EXE1SEC; |
| 38 | 500 |
| 501 global.deviceData.diveCycles.value_int32++; | |
| 502 scheduleSetDate(&global.deviceData.diveCycles); | |
| 503 global.lifeData.counterSecondsShallowDepth = 0; | |
| 504 | |
|
346
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
505 /* Get the last stable value in case of an unstable surface history condition */ |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
506 if(!is_surface_pressure_stable()) |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
507 { |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
508 set_last_surface_pressure_stable(); |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
509 } |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
510 global.lifeData.pressure_surface_bar = get_surface_mbar() / 1000.0f; |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
511 ManualExitDiveCounter = 0; /* reset early exit request */ |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
512 |
|
240
625d20070261
Improvement SPI stability/recoverability
Jan Mulder <jlmulder@xs4all.nl>
parents:
231
diff
changeset
|
513 Scheduler.tickstart = HAL_GetTick(); |
| 38 | 514 while(global.mode == MODE_DIVE) |
| 515 { | |
| 516 lasttick = HAL_GetTick(); | |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
517 ticksdiff = time_elapsed_ms(Scheduler.tickstart,lasttick); |
| 38 | 518 |
| 794 | 519 if(externalInterface_GetUARTProtocol() != 0) |
| 691 | 520 { |
| 794 | 521 externalInterface_HandleUART(); |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
691
diff
changeset
|
522 } |
| 691 | 523 |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
524 if(ticksdiff >= Scheduler.counterSPIdata100msec * 100 + 10) |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
525 { |
| 277 | 526 if(SPI_Evaluate_RX_Data()!=0) /* did we receive something ? */ |
| 527 { | |
| 528 Scheduler.counterSPIdata100msec++; | |
| 529 } | |
| 530 schedule_check_resync(); | |
|
554
3328189786e7
Added external ADC interface functionality (MCP3424):
Ideenmodellierer
parents:
488
diff
changeset
|
531 |
| 691 | 532 if(externalInterface_isEnabledADC()) |
|
554
3328189786e7
Added external ADC interface functionality (MCP3424):
Ideenmodellierer
parents:
488
diff
changeset
|
533 { |
| 691 | 534 extAdcChannel = externalInterface_ReadAndSwitch(); |
| 535 if(extAdcChannel != EXTERNAL_ADC_NO_DATA) | |
| 536 { | |
| 537 externalInterface_CalculateADCValue(extAdcChannel); | |
| 538 } | |
|
554
3328189786e7
Added external ADC interface functionality (MCP3424):
Ideenmodellierer
parents:
488
diff
changeset
|
539 } |
| 691 | 540 copyExtADCdata(); |
| 662 | 541 copyExtCO2data(); |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
542 } |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
543 |
| 38 | 544 //Evaluate pressure at 20 ms, 120 ms, 220 ms,.... |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
545 if(ticksdiff >= Scheduler.counterPressure100msec * 100 + 20) |
| 38 | 546 { |
| 547 global.check_sync_not_running++; | |
| 277 | 548 pressure_update_alternating(); |
| 135 | 549 scheduleUpdateDeviceData(); |
|
186
f11f0bf6ef2d
cleanup: remove obsolete code, make static, etc.
Jan Mulder <jlmulder@xs4all.nl>
parents:
181
diff
changeset
|
550 #ifdef DEMOMODE |
| 38 | 551 if(global.demo_mode) |
| 552 { | |
|
186
f11f0bf6ef2d
cleanup: remove obsolete code, make static, etc.
Jan Mulder <jlmulder@xs4all.nl>
parents:
181
diff
changeset
|
553 int turbo_seconds = demo_modify_temperature_and_pressure(global.lifeData.dive_time_seconds, Scheduler.counterPressure100msec, global.ceiling_from_main_CPU_mbar); |
| 38 | 554 if(turbo_seconds) |
| 555 { | |
| 556 global.lifeData.dive_time_seconds += turbo_seconds; | |
| 557 decom_tissues_exposure((int)(turbo_seconds), &global.lifeData); | |
| 558 copyTissueData(); | |
| 559 } | |
| 560 if((global.lifeData.counterSecondsShallowDepth > 1) && (global.lifeData.counterSecondsShallowDepth < (global.settings.timeoutDiveReachedZeroDepth - 10))) | |
| 561 global.lifeData.counterSecondsShallowDepth = (global.settings.timeoutDiveReachedZeroDepth - 10); | |
| 562 } | |
|
186
f11f0bf6ef2d
cleanup: remove obsolete code, make static, etc.
Jan Mulder <jlmulder@xs4all.nl>
parents:
181
diff
changeset
|
563 #endif |
| 38 | 564 |
| 565 //Calc ascentrate every two second (20 * 100 ms) | |
| 566 counterAscentRate++; | |
| 567 if(counterAscentRate == 20) | |
| 568 { | |
| 569 global.lifeData.pressure_ambient_bar = get_pressure_mbar() / 1000.0f; | |
| 570 if(lastPressure_bar >= 0) | |
| 571 { | |
| 572 //2 seconds * 30 == 1 minute, bar * 10 = meter | |
| 573 global.lifeData.ascent_rate_meter_per_min = (lastPressure_bar - global.lifeData.pressure_ambient_bar) * 30 * 10; | |
| 574 } | |
| 575 lastPressure_bar = global.lifeData.pressure_ambient_bar; | |
| 576 counterAscentRate = 0; | |
| 577 } | |
| 135 | 578 copyPressureData(); |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
579 Scheduler.counterPressure100msec++; |
| 38 | 580 } |
| 581 //evaluate compass data at 50 ms, 150 ms, 250 ms,.... | |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
582 if(ticksdiff >= Scheduler.counterCompass100msec * 100 + 50) |
| 135 | 583 { |
| 584 compass_read(); | |
| 585 acceleration_read(); | |
| 586 compass_calc(); | |
| 587 copyCompassData(); | |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
588 Scheduler.counterCompass100msec++; |
| 135 | 589 } |
| 38 | 590 |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
591 if(ticksdiff >= Scheduler.counterAmbientLight100msec * 100 + 70) |
| 38 | 592 { |
| 593 adc_ambient_light_sensor_get_data(); | |
| 594 copyAmbientLightData(); | |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
595 Scheduler.counterAmbientLight100msec++; |
| 38 | 596 } |
| 597 | |
|
220
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
598 //Evaluate tissues, toxic data, vpm, etc. once a second |
|
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
599 if(ticksdiff >= Scheduler.tick_execute1second) |
| 38 | 600 { |
|
220
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
601 Scheduler.tick_execute1second = 0xFFFFFFFF; /* execute once only in the second cycle */ |
| 38 | 602 if(global.dataSendToSlave.diveModeInfo != DIVEMODE_Apnea) |
| 603 { | |
| 604 scheduleUpdateLifeData(0); // includes tissues | |
| 605 global.lifeData.dive_time_seconds++; // there is dive_time_seconds_without_surface_time too | |
| 606 global.lifeData.ppO2 = decom_calc_ppO2(global.lifeData.pressure_ambient_bar, &global.lifeData.actualGas); | |
| 607 decom_oxygen_calculate_cns(&global.lifeData.cns,global.lifeData.ppO2); | |
| 608 decom_oxygen_calculate_otu(&global.lifeData.otu,global.lifeData.ppO2); | |
| 88 | 609 battery_gas_gauge_get_data(); |
| 38 | 610 |
| 611 | |
| 612 /** counter_exit allows safe exit via button for testing | |
| 613 * and demo_mode is exited too if aplicable. | |
| 614 */ | |
| 615 if(global.dataSendToMaster.mode == MODE_ENDDIVE) | |
| 616 { | |
| 617 counter_exit++; | |
| 618 if(counter_exit >= 2) | |
| 619 { | |
| 620 global.mode = MODE_SURFACE; | |
| 621 global.demo_mode = 0; | |
| 622 } | |
| 623 } | |
|
346
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
624 |
| 38 | 625 if(is_ambient_pressure_close_to_surface(&global.lifeData)) |
| 626 { | |
| 627 global.lifeData.counterSecondsShallowDepth++; | |
|
346
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
628 if((global.lifeData.counterSecondsShallowDepth >= global.settings.timeoutDiveReachedZeroDepth) || ((global.lifeData.dive_time_seconds < 60) && (global.demo_mode == 0)) |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
629 || (ManualExitDiveCounter)) |
| 38 | 630 { |
| 631 global.seconds_since_last_dive = 1; // start counter | |
| 632 schedule_update_timer_helper(0); // zum starten :-) | |
| 633 global.dataSendToMaster.mode = MODE_ENDDIVE; | |
| 634 global.deviceDataSendToMaster.mode = MODE_ENDDIVE; | |
| 635 } | |
| 636 } | |
| 637 else | |
| 638 { | |
| 639 global.lifeData.counterSecondsShallowDepth = 0; | |
| 640 global.lifeData.dive_time_seconds_without_surface_time++; | |
| 641 } | |
| 642 vpm_crush2(); | |
| 643 } | |
| 644 else // DIVEMODE_Apnea | |
| 645 { | |
| 646 global.lifeData.dive_time_seconds++; | |
| 647 | |
| 648 // exit dive mode | |
| 649 if(global.dataSendToMaster.mode == MODE_ENDDIVE) | |
| 650 { | |
| 651 counter_exit++; | |
| 652 if(counter_exit >= 2) | |
| 653 { | |
| 654 scheduleUpdateLifeData(-1); // 'restart' tissue calculations without calculating time during apnea mode | |
| 655 global.lifeData.dive_time_seconds = 0; // use backup noflytime and desaturation time | |
| 656 global.mode = MODE_SURFACE; | |
| 657 global.demo_mode = 0; | |
| 658 } | |
| 659 } | |
| 660 | |
| 661 // surface break | |
| 662 if(is_ambient_pressure_close_to_surface(&global.lifeData)) | |
| 663 { | |
| 664 global.lifeData.counterSecondsShallowDepth++; | |
| 665 if(global.lifeData.counterSecondsShallowDepth > 3) // time for main cpu to copy to apnea_last_dive_time_seconds | |
| 666 { | |
| 667 global.lifeData.dive_time_seconds = 0; // this apnea dive ends here | |
| 668 } | |
|
346
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
669 if((global.lifeData.counterSecondsShallowDepth >= global.settings.timeoutDiveReachedZeroDepth) || (ManualExitDiveCounter)) |
| 38 | 670 { |
| 671 global.dataSendToMaster.mode = MODE_ENDDIVE; | |
| 672 global.deviceDataSendToMaster.mode = MODE_ENDDIVE; | |
| 673 } | |
| 674 } | |
| 675 else | |
| 676 { | |
| 677 global.lifeData.counterSecondsShallowDepth = 0; | |
| 678 global.lifeData.dive_time_seconds_without_surface_time++; | |
| 679 } | |
| 680 } // standard dive or DIVEMODE_Apnea | |
| 681 | |
| 88 | 682 copyVpmCrushingData(); |
| 683 copyTimeData(); | |
| 684 copyCnsAndOtuData(); | |
| 685 copyBatteryData(); | |
| 38 | 686 |
| 88 | 687 // new hw 170523 |
| 688 if(global.I2C_SystemStatus != HAL_OK) | |
| 689 { | |
| 690 MX_I2C1_TestAndClear(); | |
|
488
9eeab3fead8f
Added "I2C_DeInit();" in hardware detection routines. It's the recommended way
heinrichsweikamp
parents:
475
diff
changeset
|
691 HAL_Delay(100); |
|
9eeab3fead8f
Added "I2C_DeInit();" in hardware detection routines. It's the recommended way
heinrichsweikamp
parents:
475
diff
changeset
|
692 I2C_DeInit(); |
|
9eeab3fead8f
Added "I2C_DeInit();" in hardware detection routines. It's the recommended way
heinrichsweikamp
parents:
475
diff
changeset
|
693 HAL_Delay(100); |
| 88 | 694 MX_I2C1_Init(); |
|
488
9eeab3fead8f
Added "I2C_DeInit();" in hardware detection routines. It's the recommended way
heinrichsweikamp
parents:
475
diff
changeset
|
695 HAL_Delay(100); |
|
9eeab3fead8f
Added "I2C_DeInit();" in hardware detection routines. It's the recommended way
heinrichsweikamp
parents:
475
diff
changeset
|
696 |
|
331
b4c578caaafb
Added plausibility check for pressure values
ideenmodellierer
parents:
310
diff
changeset
|
697 init_pressure(); |
| 88 | 698 } |
|
220
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
699 } |
|
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
700 if(ticksdiff >= 1000) |
|
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
701 { |
|
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
702 /* reset counter */ |
|
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
703 Scheduler.tickstart = HAL_GetTick(); |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
704 Scheduler.counterSPIdata100msec = 0; |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
705 Scheduler.counterCompass100msec = 0; |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
706 Scheduler.counterPressure100msec = 0; |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
707 Scheduler.counterAmbientLight100msec = 0; |
|
220
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
708 Scheduler.tick_execute1second = SCHEDULER_TICK_EXE1SEC; |
| 38 | 709 } |
| 710 } | |
| 711 } | |
| 712 | |
| 713 | |
| 714 /** | |
| 715 ****************************************************************************** | |
| 716 * @brief scheduleSurfaceMode / surface mode: Main Loop | |
|
763
aa6006975e76
increase HAL_Delay to 10ms for cold-start-button reset
heinrichsweikamp
parents:
742
diff
changeset
|
717 * @author heinrichs weikamp gmbh |
| 38 | 718 * @version V0.0.1 |
| 719 * @date 22-April-2014 | |
| 720 ****************************************************************************** | |
| 721 */ | |
| 722 | |
| 723 | |
| 724 // =============================================================================== | |
| 725 // scheduleTestMode | |
| 726 /// @brief included for sealed hardware with permanent RTE update message | |
| 727 // =============================================================================== | |
| 728 void scheduleTestMode(void) | |
| 729 { | |
| 730 uint32_t ticksdiff = 0; | |
| 731 uint32_t lasttick = 0; | |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
732 Scheduler.tickstart = HAL_GetTick(); |
| 38 | 733 |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
734 Scheduler.counterPressure100msec = 0; |
| 38 | 735 |
| 736 float temperature_carousel = 0.0f; | |
| 737 float temperature_changer = 0.1f; | |
| 738 | |
| 739 while(global.mode == MODE_TEST) | |
| 740 { | |
| 741 lasttick = HAL_GetTick(); | |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
742 ticksdiff = time_elapsed_ms(Scheduler.tickstart,lasttick); |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
743 |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
744 //Evaluate received data at 10 ms, 110 ms, 210 ms,... |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
745 if(ticksdiff >= Scheduler.counterSPIdata100msec * 100 + 10) |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
746 { |
| 277 | 747 if(SPI_Evaluate_RX_Data()!=0) /* did we receive something ? */ |
| 748 { | |
| 749 Scheduler.counterSPIdata100msec++; | |
| 750 } | |
| 751 schedule_check_resync(); | |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
752 } |
| 38 | 753 |
| 754 //Evaluate pressure at 20 ms, 120 ms, 220 ms,... | |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
755 if(ticksdiff >= Scheduler.counterPressure100msec * 100 + 20) |
| 38 | 756 { |
| 757 global.check_sync_not_running++; | |
| 758 | |
| 277 | 759 pressure_update_alternating(); |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
760 scheduleUpdateDeviceData(); |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
761 global.lifeData.ascent_rate_meter_per_min = 0; |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
762 copyPressureData(); |
| 38 | 763 |
| 764 if(temperature_carousel > 20.0f) | |
| 765 { | |
| 766 temperature_carousel = 20.0f; | |
| 767 temperature_changer = -0.1f; | |
| 768 } | |
| 769 else | |
| 770 if(temperature_carousel < 0) | |
| 771 { | |
| 772 temperature_carousel = 0; | |
| 773 temperature_changer = +0.1f; | |
| 774 } | |
| 775 | |
| 776 temperature_carousel += temperature_changer; | |
| 777 | |
| 778 uint8_t boolPressureData = !global.dataSendToMaster.boolPressureData; | |
| 779 | |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
780 global.dataSendToMaster.data[boolPressureData].pressure_mbar = get_pressure_mbar(); |
| 38 | 781 |
| 782 global.dataSendToMaster.data[boolPressureData].temperature = temperature_carousel; | |
| 783 global.dataSendToMaster.data[boolPressureData].pressure_uTick = HAL_GetTick(); | |
| 784 global.dataSendToMaster.boolPressureData = boolPressureData; | |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
785 Scheduler.counterPressure100msec++; |
| 38 | 786 } |
| 787 | |
| 788 if(ticksdiff >= 1000) | |
| 789 { | |
| 790 //Set back tick counter | |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
791 Scheduler.tickstart = HAL_GetTick(); |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
792 Scheduler.counterPressure100msec = 0; |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
793 Scheduler.counterSPIdata100msec = 0; |
| 38 | 794 } |
| 795 }; | |
| 796 } | |
| 797 | |
| 798 | |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
799 |
| 38 | 800 void scheduleSurfaceMode(void) |
| 801 { | |
| 802 uint32_t ticksdiff = 0; | |
| 803 uint32_t lasttick = 0; | |
|
554
3328189786e7
Added external ADC interface functionality (MCP3424):
Ideenmodellierer
parents:
488
diff
changeset
|
804 uint8_t extAdcChannel = 0; |
| 662 | 805 uint8_t batteryToggle = 0; /* ADC is operating in automatic 2 second cycles => consider for battery charge function call */ |
| 806 | |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
807 Scheduler.tickstart = HAL_GetTick(); |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
808 Scheduler.counterSPIdata100msec = 0; |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
809 Scheduler.counterCompass100msec = 0; |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
810 Scheduler.counterPressure100msec = 0; |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
811 Scheduler.counterAmbientLight100msec = 0; |
|
220
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
812 Scheduler.tick_execute1second = SCHEDULER_TICK_EXE1SEC; |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
813 |
| 38 | 814 global.dataSendToMaster.mode = MODE_SURFACE; |
| 815 global.deviceDataSendToMaster.mode = MODE_SURFACE; | |
| 816 | |
| 817 while(global.mode == MODE_SURFACE) | |
| 818 { | |
| 277 | 819 |
| 38 | 820 lasttick = HAL_GetTick(); |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
821 ticksdiff = time_elapsed_ms(Scheduler.tickstart,lasttick); |
| 38 | 822 |
| 823 if(setButtonsNow == 1) | |
| 824 { | |
| 825 if(scheduleSetButtonResponsiveness()) | |
| 826 setButtonsNow = 0; | |
| 827 } | |
| 691 | 828 |
| 794 | 829 if(externalInterface_GetUARTProtocol() != 0) |
| 691 | 830 { |
| 794 | 831 externalInterface_HandleUART(); |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
691
diff
changeset
|
832 } |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
691
diff
changeset
|
833 |
|
220
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
834 /* Evaluate received data at 10 ms, 110 ms, 210 ms,... duration ~<1ms */ |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
835 if(ticksdiff >= Scheduler.counterSPIdata100msec * 100 + 10) |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
836 { |
|
264
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
837 if(SPI_Evaluate_RX_Data()!=0) /* did we receive something ? */ |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
838 { |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
839 Scheduler.counterSPIdata100msec++; |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
840 } |
| 277 | 841 schedule_check_resync(); |
| 691 | 842 if(externalInterface_isEnabledADC()) |
|
554
3328189786e7
Added external ADC interface functionality (MCP3424):
Ideenmodellierer
parents:
488
diff
changeset
|
843 { |
| 691 | 844 extAdcChannel = externalInterface_ReadAndSwitch(); |
| 845 if(extAdcChannel != EXTERNAL_ADC_NO_DATA) | |
| 846 { | |
| 847 externalInterface_CalculateADCValue(extAdcChannel); | |
| 848 | |
| 849 } | |
|
554
3328189786e7
Added external ADC interface functionality (MCP3424):
Ideenmodellierer
parents:
488
diff
changeset
|
850 } |
| 691 | 851 copyExtADCdata(); |
| 662 | 852 copyExtCO2data(); |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
853 } |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
854 |
|
220
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
855 /* Evaluate pressure at 20 ms, 120 ms, 220 ms,... duration ~22ms] */ |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
856 if(ticksdiff >= Scheduler.counterPressure100msec * 100 + 20) |
| 38 | 857 { |
| 858 global.check_sync_not_running++; | |
| 277 | 859 pressure_update_alternating(); |
| 135 | 860 scheduleUpdateDeviceData(); |
| 38 | 861 global.lifeData.ascent_rate_meter_per_min = 0; |
| 135 | 862 copyPressureData(); |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
863 Scheduler.counterPressure100msec++; |
| 135 | 864 |
|
301
a09b1855d656
cleanup, RTE: factor out scheduleCheck_pressure_reached_dive_mode_level
Jan Mulder <jlmulder@xs4all.nl>
parents:
277
diff
changeset
|
865 if (!is_ambient_pressure_close_to_surface(&global.lifeData)) |
| 38 | 866 global.mode = MODE_DIVE; |
| 867 } | |
| 868 | |
|
220
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
869 /* Evaluate compass data at 50 ms, 150 ms, 250 ms,... duration ~5ms */ |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
870 if(ticksdiff >= Scheduler.counterCompass100msec * 100 + 50) |
| 135 | 871 { |
| 872 compass_read(); | |
| 873 acceleration_read(); | |
| 874 compass_calc(); | |
| 875 copyCompassData(); | |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
876 Scheduler.counterCompass100msec++; |
| 135 | 877 } |
| 38 | 878 |
|
220
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
879 /* evaluate compass data at 70 ms, 170 ms, 270 ms,... duration <1ms */ |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
880 if(ticksdiff >= Scheduler.counterAmbientLight100msec * 100 + 70) |
| 38 | 881 { |
| 882 adc_ambient_light_sensor_get_data(); | |
| 883 copyAmbientLightData(); | |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
884 Scheduler.counterAmbientLight100msec++; |
| 38 | 885 } |
|
220
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
886 |
|
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
887 |
|
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
888 |
|
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
889 /* Evaluate tissues, toxic data, etc. once a second... duration ~1ms */ |
|
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
890 if(ticksdiff >= Scheduler.tick_execute1second) |
| 38 | 891 { |
|
220
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
892 Scheduler.tick_execute1second = 0xFFFFFFFF; |
| 38 | 893 if(clearDecoNow) |
| 894 { | |
| 895 decom_reset_with_1000mbar(&global.lifeData); ///< this should almost reset desaturation time | |
| 896 // new 160215 hw | |
| 897 global.repetitive_dive = 0; | |
| 898 global.seconds_since_last_dive = 0; ///< this will reset OTU and CNS as well | |
| 899 global.no_fly_time_minutes = 0; | |
| 900 global.accidentFlag = 0; | |
| 901 global.accidentRemainingSeconds = 0; | |
| 902 vpm_init(&global.vpm, global.conservatism, global.repetitive_dive, global.seconds_since_last_dive); | |
| 903 clearDecoNow = 0; | |
| 904 } | |
| 89 | 905 |
|
349
9d82411d0afa
Decrease ManualExitDiveCounter in surface mode
ideenmodellierer
parents:
346
diff
changeset
|
906 if(ManualExitDiveCounter) |
|
9d82411d0afa
Decrease ManualExitDiveCounter in surface mode
ideenmodellierer
parents:
346
diff
changeset
|
907 { |
|
9d82411d0afa
Decrease ManualExitDiveCounter in surface mode
ideenmodellierer
parents:
346
diff
changeset
|
908 ManualExitDiveCounter--; |
|
9d82411d0afa
Decrease ManualExitDiveCounter in surface mode
ideenmodellierer
parents:
346
diff
changeset
|
909 } |
|
9d82411d0afa
Decrease ManualExitDiveCounter in surface mode
ideenmodellierer
parents:
346
diff
changeset
|
910 |
| 38 | 911 if(global.seconds_since_last_dive) |
| 912 { | |
| 913 schedule_update_timer_helper(-1); | |
| 914 } | |
| 89 | 915 |
| 38 | 916 if(global.accidentRemainingSeconds) |
| 917 { | |
| 918 global.accidentRemainingSeconds--; | |
| 919 if(!global.accidentRemainingSeconds) | |
| 920 global.accidentFlag = 0; | |
| 921 } | |
| 922 global.dataSendToMaster.accidentFlags = global.accidentFlag; | |
| 89 | 923 |
| 38 | 924 update_surface_pressure(1); |
| 925 scheduleUpdateLifeData(0); | |
| 926 decom_oxygen_calculate_otu_degrade(&global.lifeData.otu, global.seconds_since_last_dive); | |
| 927 decom_oxygen_calculate_cns_degrade(&global.lifeData.cns, global.seconds_since_last_dive); | |
| 135 | 928 |
| 929 /* start desaturation calculation after first valid measurement has been done */ | |
| 930 if(global.lifeData.pressure_surface_bar != INVALID_PREASURE_VALUE) | |
| 931 { | |
| 932 global.lifeData.desaturation_time_minutes = decom_calc_desaturation_time(global.lifeData.tissue_nitrogen_bar,global.lifeData.tissue_helium_bar,global.lifeData.pressure_surface_bar); | |
| 933 } | |
| 934 else | |
| 935 { | |
| 936 global.lifeData.desaturation_time_minutes = 0; | |
| 937 } | |
| 662 | 938 |
| 939 if(!batteryToggle) | |
| 940 { | |
| 941 battery_gas_gauge_get_data(); | |
| 942 battery_charger_get_status_and_contral_battery_gas_gauge(2); | |
| 943 batteryToggle = 1; | |
| 944 } | |
| 945 else | |
| 946 { | |
| 947 batteryToggle = 0; | |
| 948 } | |
| 89 | 949 |
| 88 | 950 copyCnsAndOtuData(); |
| 951 copyTimeData(); | |
| 952 copyBatteryData(); | |
| 953 copyDeviceData(); | |
| 38 | 954 |
| 691 | 955 |
|
331
b4c578caaafb
Added plausibility check for pressure values
ideenmodellierer
parents:
310
diff
changeset
|
956 /* check if I2C is not up an running and try to reactivate if necessary. Also do initialization if problem occured during startup */ |
| 88 | 957 if(global.I2C_SystemStatus != HAL_OK) |
| 958 { | |
| 959 MX_I2C1_TestAndClear(); | |
|
488
9eeab3fead8f
Added "I2C_DeInit();" in hardware detection routines. It's the recommended way
heinrichsweikamp
parents:
475
diff
changeset
|
960 HAL_Delay(100); |
|
9eeab3fead8f
Added "I2C_DeInit();" in hardware detection routines. It's the recommended way
heinrichsweikamp
parents:
475
diff
changeset
|
961 I2C_DeInit(); |
|
9eeab3fead8f
Added "I2C_DeInit();" in hardware detection routines. It's the recommended way
heinrichsweikamp
parents:
475
diff
changeset
|
962 HAL_Delay(100); |
| 88 | 963 MX_I2C1_Init(); |
|
488
9eeab3fead8f
Added "I2C_DeInit();" in hardware detection routines. It's the recommended way
heinrichsweikamp
parents:
475
diff
changeset
|
964 HAL_Delay(100); |
|
9eeab3fead8f
Added "I2C_DeInit();" in hardware detection routines. It's the recommended way
heinrichsweikamp
parents:
475
diff
changeset
|
965 |
|
331
b4c578caaafb
Added plausibility check for pressure values
ideenmodellierer
parents:
310
diff
changeset
|
966 if(global.I2C_SystemStatus == HAL_OK) |
| 88 | 967 { |
| 968 init_pressure(); | |
|
331
b4c578caaafb
Added plausibility check for pressure values
ideenmodellierer
parents:
310
diff
changeset
|
969 if(is_init_pressure_done()) /* Init surface data with initial measurement */ |
|
b4c578caaafb
Added plausibility check for pressure values
ideenmodellierer
parents:
310
diff
changeset
|
970 { |
|
338
b6a59e93cc91
Added function to avoid divemode activation during Landing:
ideenmodellierer
parents:
331
diff
changeset
|
971 init_surface_ring(0); |
|
331
b4c578caaafb
Added plausibility check for pressure values
ideenmodellierer
parents:
310
diff
changeset
|
972 } |
|
b4c578caaafb
Added plausibility check for pressure values
ideenmodellierer
parents:
310
diff
changeset
|
973 |
|
b4c578caaafb
Added plausibility check for pressure values
ideenmodellierer
parents:
310
diff
changeset
|
974 if(!battery_gas_gauge_CheckConfigOK()) |
|
b4c578caaafb
Added plausibility check for pressure values
ideenmodellierer
parents:
310
diff
changeset
|
975 { |
|
b4c578caaafb
Added plausibility check for pressure values
ideenmodellierer
parents:
310
diff
changeset
|
976 init_battery_gas_gauge(); |
|
b4c578caaafb
Added plausibility check for pressure values
ideenmodellierer
parents:
310
diff
changeset
|
977 } |
| 88 | 978 } |
| 979 } | |
|
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
980 externalInterface_AutodetectSensor(); |
|
220
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
981 } |
|
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
982 |
|
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
983 if(ticksdiff >= 1000) |
|
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
984 { |
|
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
985 //Set back tick counter |
|
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
986 Scheduler.tickstart = HAL_GetTick(); |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
987 Scheduler.counterSPIdata100msec = 0; |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
988 Scheduler.counterCompass100msec = 0; |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
989 Scheduler.counterPressure100msec = 0; |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
990 Scheduler.counterAmbientLight100msec = 0; |
|
220
e524a824d8f2
Added schedule point for functions executed once in a second
ideenmodellierer
parents:
207
diff
changeset
|
991 Scheduler.tick_execute1second = SCHEDULER_TICK_EXE1SEC; |
| 38 | 992 } |
| 993 } | |
| 994 } | |
| 995 | |
| 207 | 996 inline void Scheduler_Request_sync_with_SPI(uint8_t SyncMethod) |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
997 { |
| 207 | 998 if( SyncMethod < SPI_SYNC_METHOD_INVALID) |
| 999 { | |
| 1000 dospisync = SyncMethod; | |
| 1001 } | |
| 1002 } | |
| 1003 | |
|
264
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1004 void Scheduler_SyncToSPI(uint8_t TXtick) |
| 207 | 1005 { |
| 1006 uint32_t deltatick = 0; | |
|
264
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1007 int8_t TXcompensation; |
| 207 | 1008 |
| 1009 switch(dospisync) | |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
1010 { |
| 207 | 1011 case SPI_SYNC_METHOD_HARD: |
| 1012 //Set back tick counter | |
|
264
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1013 Scheduler.tickstart = HAL_GetTick() - 4; /* consider 4ms offset for transfer */ |
| 207 | 1014 Scheduler.counterSPIdata100msec = 0; |
| 1015 Scheduler.counterCompass100msec = 0; | |
| 1016 Scheduler.counterPressure100msec = 0; | |
| 1017 Scheduler.counterAmbientLight100msec = 0; | |
| 1018 dospisync = SPI_SYNC_METHOD_NONE; | |
| 1019 break; | |
| 1020 case SPI_SYNC_METHOD_SOFT: | |
| 1021 deltatick = time_elapsed_ms(Scheduler.tickstart,HAL_GetTick()); | |
| 1022 deltatick %= 100; /* clip to 100ms window */ | |
| 1023 if(Scheduler.tickstart - deltatick >= 0) /* adjust start time to the next 100ms window */ | |
| 1024 { | |
| 1025 Scheduler.tickstart -= deltatick; | |
| 1026 } | |
| 1027 else | |
| 1028 { | |
| 1029 Scheduler.tickstart = 0xFFFFFFFF- (deltatick - Scheduler.tickstart); | |
| 1030 } | |
| 1031 dospisync = SPI_SYNC_METHOD_NONE; | |
| 1032 break; | |
|
264
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1033 default: /* continous sync activity */ |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1034 if(TXtick < 100) /* do not handle unexpected jump length > 100ms */ |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1035 { |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1036 TXtick += 4; /* add 4ms TX time to offset of 100ms time stamp */ |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1037 deltatick = time_elapsed_ms(Scheduler.tickstart,HAL_GetTick()); |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1038 deltatick %= 100; |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1039 if(deltatick > 50) |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1040 { |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1041 TXcompensation = deltatick - 100; /* neg drift */ |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1042 } |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1043 else |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1044 { |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1045 TXcompensation = deltatick; /* pos drift */ |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1046 } |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1047 TXcompensation = TXtick - TXcompensation; |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1048 Scheduler.tickstart -= TXcompensation; |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1049 } |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1050 else |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1051 { |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1052 Scheduler_Request_sync_with_SPI(SPI_SYNC_METHOD_SOFT); /* A large shift in 100ms cycle occured => clip to 100ms in next sync call */ |
|
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1053 } |
| 207 | 1054 break; |
|
142
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
1055 } |
|
69f4b8067daa
Use one global structure for all schedule counters
Ideenmodellierer
parents:
135
diff
changeset
|
1056 } |
| 38 | 1057 |
| 1058 /** | |
| 1059 ****************************************************************************** | |
| 1060 * @brief scheduleCompassCalibrationMode | |
| 1061 * @author heinrichs weikamp gmbh | |
| 1062 * @version V0.0.1 | |
| 1063 * @since 31-March-2015 | |
| 1064 * @date 31-March-2015 | |
| 1065 ****************************************************************************** | |
| 1066 */ | |
| 1067 void scheduleCompassCalibrationMode(void) | |
| 1068 { | |
| 1069 compass_init(1,7); // fast mode, max gain | |
| 1070 compass_calib(); // duration : 1 minute! | |
| 1071 compass_init(0,7); // back to normal mode | |
| 1072 | |
| 1073 if(global.seconds_since_last_dive) | |
| 1074 { | |
| 1075 schedule_update_timer_helper(-1); | |
| 1076 } | |
| 1077 | |
| 1078 scheduleUpdateLifeData(0); | |
| 1079 global.mode = MODE_SURFACE; | |
| 1080 } | |
| 1081 | |
| 1082 | |
| 1083 /** | |
| 1084 ****************************************************************************** | |
| 1085 * @brief scheduleSleepMode / sleep mode: Main Loop | |
| 1086 * @author heinrichs weikamp gmbh | |
| 1087 * @version V0.0.2 | |
| 1088 * @since 31-March-2015 | |
| 1089 * @date 22-April-2014 | |
| 1090 ****************************************************************************** | |
| 1091 */ | |
| 1092 | |
| 1093 void scheduleSleepMode(void) | |
| 1094 { | |
| 1095 global.dataSendToMaster.mode = 0; | |
| 1096 global.deviceDataSendToMaster.mode = 0; | |
| 668 | 1097 secondsCount = 0; |
| 38 | 1098 |
| 1099 /* prevent button wake up problem while in sleep_prepare | |
| 1100 * sleep prepare does I2C_DeInit() | |
| 1101 */ | |
| 1102 if(global.mode != MODE_SLEEP) | |
| 1103 MX_I2C1_Init(); | |
| 1104 else | |
| 1105 do | |
| 1106 { | |
| 1107 I2C_DeInit(); | |
| 1108 | |
| 1109 #ifdef DEBUGMODE | |
| 1110 HAL_Delay(2000); | |
| 1111 #else | |
| 1112 RTC_StopMode_2seconds(); | |
| 1113 #endif | |
| 1114 | |
| 1115 | |
| 1116 | |
| 1117 if(global.mode == MODE_SLEEP) | |
| 1118 secondsCount += 2; | |
| 1119 | |
| 662 | 1120 externalInterface_InitPower33(); |
| 38 | 1121 MX_I2C1_Init(); |
| 1122 pressure_sensor_get_pressure_raw(); | |
| 1123 | |
| 475 | 1124 /* check if I2C is not up and running and try to reactivate if necessary. Also do initialization if problem occurred during startup */ |
|
331
b4c578caaafb
Added plausibility check for pressure values
ideenmodellierer
parents:
310
diff
changeset
|
1125 if(global.I2C_SystemStatus != HAL_OK) |
|
b4c578caaafb
Added plausibility check for pressure values
ideenmodellierer
parents:
310
diff
changeset
|
1126 { |
|
b4c578caaafb
Added plausibility check for pressure values
ideenmodellierer
parents:
310
diff
changeset
|
1127 MX_I2C1_TestAndClear(); |
|
488
9eeab3fead8f
Added "I2C_DeInit();" in hardware detection routines. It's the recommended way
heinrichsweikamp
parents:
475
diff
changeset
|
1128 HAL_Delay(100); |
|
9eeab3fead8f
Added "I2C_DeInit();" in hardware detection routines. It's the recommended way
heinrichsweikamp
parents:
475
diff
changeset
|
1129 I2C_DeInit(); |
|
9eeab3fead8f
Added "I2C_DeInit();" in hardware detection routines. It's the recommended way
heinrichsweikamp
parents:
475
diff
changeset
|
1130 HAL_Delay(100); |
|
331
b4c578caaafb
Added plausibility check for pressure values
ideenmodellierer
parents:
310
diff
changeset
|
1131 MX_I2C1_Init(); |
|
488
9eeab3fead8f
Added "I2C_DeInit();" in hardware detection routines. It's the recommended way
heinrichsweikamp
parents:
475
diff
changeset
|
1132 HAL_Delay(100); |
|
9eeab3fead8f
Added "I2C_DeInit();" in hardware detection routines. It's the recommended way
heinrichsweikamp
parents:
475
diff
changeset
|
1133 |
| 475 | 1134 if((global.I2C_SystemStatus == HAL_OK) && (!is_init_pressure_done())) |
|
331
b4c578caaafb
Added plausibility check for pressure values
ideenmodellierer
parents:
310
diff
changeset
|
1135 { |
|
b4c578caaafb
Added plausibility check for pressure values
ideenmodellierer
parents:
310
diff
changeset
|
1136 init_pressure(); |
|
b4c578caaafb
Added plausibility check for pressure values
ideenmodellierer
parents:
310
diff
changeset
|
1137 } |
|
b4c578caaafb
Added plausibility check for pressure values
ideenmodellierer
parents:
310
diff
changeset
|
1138 } |
|
b4c578caaafb
Added plausibility check for pressure values
ideenmodellierer
parents:
310
diff
changeset
|
1139 |
| 691 | 1140 if((secondsCount >= 30) || (global.mode != MODE_SLEEP)) /* Service battery charge state in case sleep is left */ |
| 38 | 1141 { |
| 1142 pressure_sensor_get_temperature_raw(); | |
| 1143 battery_gas_gauge_get_data(); | |
| 662 | 1144 ReInit_battery_charger_status_pins(); |
| 691 | 1145 battery_charger_get_status_and_contral_battery_gas_gauge(secondsCount); |
| 38 | 1146 // DeInit_battery_charger_status_pins(); |
| 1147 secondsCount = 0; | |
| 1148 } | |
| 1149 | |
| 1150 pressure_calculation(); | |
| 1151 | |
| 1152 scheduleUpdateDeviceData(); | |
| 1153 update_surface_pressure(2); | |
| 1154 | |
| 1155 if(global.seconds_since_last_dive) | |
| 1156 { | |
| 1157 schedule_update_timer_helper(-1); | |
| 1158 } | |
| 1159 | |
| 1160 if(global.accidentRemainingSeconds) | |
| 1161 { | |
| 1162 if(global.accidentRemainingSeconds > 2) | |
| 1163 global.accidentRemainingSeconds -= 2; | |
| 1164 else | |
| 1165 { | |
| 1166 global.accidentRemainingSeconds = 0; | |
| 1167 global.accidentFlag = 0; | |
| 1168 } | |
| 1169 } | |
| 1170 | |
|
338
b6a59e93cc91
Added function to avoid divemode activation during Landing:
ideenmodellierer
parents:
331
diff
changeset
|
1171 if (((!is_ambient_pressure_close_to_surface(&global.lifeData)) && (global.lifeData.pressure_surface_bar > START_DIVE_MOUNTAIN_MODE_BAR )) |
|
b6a59e93cc91
Added function to avoid divemode activation during Landing:
ideenmodellierer
parents:
331
diff
changeset
|
1172 || (global.lifeData.pressure_ambient_bar > START_DIVE_IMMEDIATLY_BAR)) |
|
b6a59e93cc91
Added function to avoid divemode activation during Landing:
ideenmodellierer
parents:
331
diff
changeset
|
1173 { |
| 38 | 1174 global.mode = MODE_BOOT; |
|
338
b6a59e93cc91
Added function to avoid divemode activation during Landing:
ideenmodellierer
parents:
331
diff
changeset
|
1175 } |
| 38 | 1176 scheduleUpdateLifeData(2000); |
| 1177 } | |
| 1178 while(global.mode == MODE_SLEEP); | |
| 1179 /* new section for system after Standby */ | |
| 1180 scheduleUpdateLifeData(-1); | |
| 1181 clearDecoNow = 0; | |
| 1182 setButtonsNow = 0; | |
|
264
b3685fbada3b
Sync to Main 100ms time stamp & added Reinitialization of globals after startup
ideenmodellierer
parents:
240
diff
changeset
|
1183 reinitGlobals(); |
| 668 | 1184 ReInit_battery_charger_status_pins(); |
| 38 | 1185 } |
| 1186 | |
| 1187 | |
| 1188 | |
| 1189 /* Private functions ---------------------------------------------------------*/ | |
| 1190 | |
| 1191 /** | |
| 1192 ****************************************************************************** | |
| 1193 * @brief scheduleUpdateLifeData / calculates tissues | |
|
763
aa6006975e76
increase HAL_Delay to 10ms for cold-start-button reset
heinrichsweikamp
parents:
742
diff
changeset
|
1194 * @author heinrichs weikamp gmbh |
| 38 | 1195 * @version V0.0.1 |
| 1196 * @date 22-April-2014 | |
| 1197 ****************************************************************************** | |
| 1198 */ | |
| 1199 | |
| 1200 | |
| 1201 void scheduleUpdateLifeData(int32_t asynchron_milliseconds_since_last) | |
| 1202 { | |
| 1203 static _Bool first = 1; | |
| 1204 static uint32_t tickstart = 0; | |
| 1205 static uint32_t ticksrest = 0; | |
| 1206 | |
| 1207 uint32_t ticksdiff = 0; | |
| 1208 uint32_t ticksnow = 0; | |
| 1209 uint32_t time_seconds = 0; | |
| 1210 uint8_t whichGasTmp = 0; | |
| 1211 | |
| 135 | 1212 uint8_t updateTissueData = 0; |
| 1213 | |
| 1214 | |
| 1215 if(global.lifeData.pressure_surface_bar == INVALID_PREASURE_VALUE) | |
| 1216 { | |
| 1217 updateTissueData = 1; | |
| 1218 } | |
| 1219 | |
| 38 | 1220 if(asynchron_milliseconds_since_last < 0) |
| 1221 { | |
| 1222 first = 1; | |
| 1223 tickstart = 0; | |
| 1224 ticksrest = 0; | |
| 1225 return; | |
| 1226 } | |
| 1227 | |
| 1228 if(!asynchron_milliseconds_since_last && first) | |
| 1229 { | |
| 1230 tickstart = HAL_GetTick(); | |
| 1231 first = 0; | |
| 1232 return; | |
| 1233 } | |
| 1234 | |
| 1235 whichGasTmp = global.whichGas; | |
| 1236 global.lifeData.actualGas = global.aktualGas[whichGasTmp]; | |
| 1237 global.lifeData.pressure_ambient_bar = get_pressure_mbar() / 1000.0f; | |
| 1238 global.lifeData.pressure_surface_bar = get_surface_mbar() / 1000.0f; | |
| 1239 | |
| 135 | 1240 if(updateTissueData) |
| 1241 { | |
| 1242 decom_reset_with_ambientmbar(global.lifeData.pressure_surface_bar,&global.lifeData); | |
| 1243 } | |
| 1244 | |
| 38 | 1245 if(!asynchron_milliseconds_since_last) |
| 1246 { | |
| 1247 ticksnow = HAL_GetTick(); | |
| 1248 ticksdiff = time_elapsed_ms(tickstart,ticksnow); | |
| 1249 } | |
| 1250 else | |
| 1251 { | |
| 1252 first = 1; | |
| 1253 ticksdiff = asynchron_milliseconds_since_last; | |
| 1254 } | |
| 1255 | |
| 1256 if(ticksrest > 1000) // whatever happens after standby with STM32L476 | |
| 1257 ticksrest = 0; // maybe move static to SRAM2 | |
| 1258 | |
| 1259 ticksdiff += ticksrest; | |
| 1260 time_seconds = ticksdiff/ 1000; | |
| 1261 ticksrest = ticksdiff - time_seconds * 1000; | |
| 1262 tickstart = ticksnow; | |
| 1263 | |
| 1264 decom_tissues_exposure((int)time_seconds, &global.lifeData); | |
| 1265 if(global.demo_mode) | |
| 1266 decom_tissues_exposure((int)(3*time_seconds), &global.lifeData); | |
| 1267 copyTissueData(); | |
| 1268 } | |
| 1269 | |
| 1270 | |
| 1271 /** | |
| 1272 ****************************************************************************** | |
| 1273 * @brief scheduleUpdateDeviceData | |
| 1274 * @author heinrichs weikamp gmbh | |
| 1275 * @version V0.0.1 | |
| 1276 * @date 16-March-2015 | |
| 1277 * | |
| 1278 * two step process | |
| 1279 * first compare with data from main CPU == externalLogbookFlash | |
| 1280 * second update with new sensor data | |
| 1281 ****************************************************************************** | |
| 1282 */ | |
| 1283 void scheduleSetDate(SDeviceLine *line) | |
| 1284 { | |
| 1285 extern RTC_HandleTypeDef RTCHandle; | |
| 1286 | |
| 1287 line->date_rtc_dr = (uint32_t)(RTCHandle.Instance->DR & RTC_DR_RESERVED_MASK); | |
| 1288 line->time_rtc_tr = (uint32_t)(RTCHandle.Instance->TR & RTC_TR_RESERVED_MASK); | |
| 1289 } | |
| 1290 | |
| 1291 | |
| 1292 void scheduleCopyDeviceData(SDeviceLine *lineWrite, const SDeviceLine *lineRead) | |
| 1293 { | |
| 1294 lineWrite->date_rtc_dr = lineRead->date_rtc_dr; | |
| 1295 lineWrite->time_rtc_tr = lineRead->time_rtc_tr; | |
| 1296 lineWrite->value_int32 = lineRead->value_int32; | |
| 1297 } | |
| 1298 | |
| 1299 | |
|
409
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1300 void scheduletranslateDate(uint32_t datetmpreg, RTC_DateTypeDef *sDate) |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1301 { |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1302 datetmpreg = (uint32_t)(datetmpreg & RTC_DR_RESERVED_MASK); |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1303 |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1304 /* Fill the structure fields with the read parameters */ |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1305 sDate->Year = (uint8_t)((datetmpreg & (RTC_DR_YT | RTC_DR_YU)) >> 16); |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1306 sDate->Month = (uint8_t)((datetmpreg & (RTC_DR_MT | RTC_DR_MU)) >> 8); |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1307 sDate->Date = (uint8_t)(datetmpreg & (RTC_DR_DT | RTC_DR_DU)); |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1308 sDate->WeekDay = (uint8_t)((datetmpreg & (RTC_DR_WDU)) >> 13); |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1309 |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1310 /* Convert the date structure parameters to Binary format */ |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1311 sDate->Year = (uint8_t)RTC_Bcd2ToByte(sDate->Year); |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1312 sDate->Month = (uint8_t)RTC_Bcd2ToByte(sDate->Month); |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1313 sDate->Date = (uint8_t)RTC_Bcd2ToByte(sDate->Date); |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1314 } |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1315 |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1316 void scheduleCheckDate(void) |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1317 { |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1318 uint32_t localdate; |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1319 RTC_DateTypeDef sDate; |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1320 localdate = (uint32_t)(RTCHandle.Instance->DR & RTC_DR_RESERVED_MASK); |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1321 scheduletranslateDate(localdate, &sDate); |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1322 |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1323 /* RTC start in year 2000 in case of a power loss. Use the operation counter time stamp to bring at last date to a more realistic value */ |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1324 if(sDate.Year < 15) |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1325 { |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1326 scheduletranslateDate(DeviceDataFlash.hoursOfOperation.date_rtc_dr, &sDate); |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1327 if(sDate.Year > 16) |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1328 { |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1329 RTC_SetDate(sDate); |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1330 } |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1331 } |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1332 |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1333 } |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1334 |
| 38 | 1335 void scheduleUpdateDeviceData(void) |
| 1336 { | |
| 1337 /* first step, main CPU */ | |
| 1338 | |
| 1339 if(deviceDataFlashValid) | |
| 1340 { | |
| 1341 /* max values */ | |
|
409
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1342 if(global.deviceData.hoursOfOperation.value_int32 < DeviceDataFlash.hoursOfOperation.value_int32) |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1343 { |
|
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1344 scheduleCopyDeviceData(&global.deviceData.hoursOfOperation, &DeviceDataFlash.hoursOfOperation); |
|
414
6886aeeca454
Added compile switch for restoring of last known date after power lost:
ideenmodellierer
parents:
409
diff
changeset
|
1345 #ifdef RESTORE_LAST_KNOWN_DATE |
|
409
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1346 scheduleCheckDate(); |
|
414
6886aeeca454
Added compile switch for restoring of last known date after power lost:
ideenmodellierer
parents:
409
diff
changeset
|
1347 #endif |
|
409
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1348 } |
| 38 | 1349 if(global.deviceData.batteryChargeCompleteCycles.value_int32 < DeviceDataFlash.batteryChargeCompleteCycles.value_int32) |
| 1350 { | |
| 1351 scheduleCopyDeviceData(&global.deviceData.batteryChargeCompleteCycles, &DeviceDataFlash.batteryChargeCompleteCycles); | |
| 1352 } | |
| 1353 if(global.deviceData.batteryChargeCycles.value_int32 < DeviceDataFlash.batteryChargeCycles.value_int32) | |
| 1354 { | |
| 1355 scheduleCopyDeviceData(&global.deviceData.batteryChargeCycles, &DeviceDataFlash.batteryChargeCycles); | |
| 1356 } | |
| 1357 if(global.deviceData.temperatureMaximum.value_int32 < DeviceDataFlash.temperatureMaximum.value_int32) | |
| 1358 { | |
| 1359 scheduleCopyDeviceData(&global.deviceData.temperatureMaximum, &DeviceDataFlash.temperatureMaximum); | |
| 1360 } | |
| 1361 if(global.deviceData.depthMaximum.value_int32 < DeviceDataFlash.depthMaximum.value_int32) | |
| 1362 { | |
| 1363 scheduleCopyDeviceData(&global.deviceData.depthMaximum, &DeviceDataFlash.depthMaximum); | |
| 1364 } | |
| 1365 if(global.deviceData.diveCycles.value_int32 < DeviceDataFlash.diveCycles.value_int32) | |
| 1366 { | |
| 1367 scheduleCopyDeviceData(&global.deviceData.diveCycles, &DeviceDataFlash.diveCycles); | |
| 1368 } | |
| 1369 | |
| 1370 /* min values */ | |
| 1371 if(global.deviceData.temperatureMinimum.value_int32 > DeviceDataFlash.temperatureMinimum.value_int32) | |
| 1372 { | |
| 1373 scheduleCopyDeviceData(&global.deviceData.temperatureMinimum, &DeviceDataFlash.temperatureMinimum); | |
| 1374 } | |
| 1375 if(global.deviceData.voltageMinimum.value_int32 > DeviceDataFlash.voltageMinimum.value_int32) | |
| 1376 { | |
| 1377 scheduleCopyDeviceData(&global.deviceData.voltageMinimum, &DeviceDataFlash.voltageMinimum); | |
| 1378 } | |
| 1379 } | |
| 1380 | |
| 1381 /* second step, sensor data */ | |
| 1382 int32_t temperature_centigrad_int32; | |
| 1383 int32_t pressure_mbar_int32; | |
| 1384 int32_t voltage_mvolt_int32; | |
| 1385 | |
| 1386 temperature_centigrad_int32 = (int32_t)(get_temperature() * 100); | |
| 1387 if(temperature_centigrad_int32 < global.deviceData.temperatureMinimum.value_int32) | |
| 1388 { | |
| 1389 global.deviceData.temperatureMinimum.value_int32 = temperature_centigrad_int32; | |
| 88 | 1390 scheduleSetDate(&global.deviceData.temperatureMinimum); |
| 38 | 1391 } |
| 1392 | |
| 1393 if(temperature_centigrad_int32 > global.deviceData.temperatureMaximum.value_int32) | |
| 1394 { | |
| 1395 global.deviceData.temperatureMaximum.value_int32 = temperature_centigrad_int32; | |
| 88 | 1396 scheduleSetDate(&global.deviceData.temperatureMaximum); |
| 38 | 1397 } |
| 1398 | |
| 1399 pressure_mbar_int32 = (int32_t)get_pressure_mbar(); | |
| 1400 if(pressure_mbar_int32 > global.deviceData.depthMaximum.value_int32) | |
| 1401 { | |
| 1402 global.deviceData.depthMaximum.value_int32 = pressure_mbar_int32; | |
| 88 | 1403 scheduleSetDate(&global.deviceData.depthMaximum); |
| 38 | 1404 } |
| 1405 | |
| 1406 voltage_mvolt_int32 = (int32_t)(get_voltage() * 1000); | |
| 1407 if(voltage_mvolt_int32 < global.deviceData.voltageMinimum.value_int32) | |
| 1408 { | |
| 1409 global.deviceData.voltageMinimum.value_int32 = voltage_mvolt_int32; | |
| 88 | 1410 scheduleSetDate(&global.deviceData.voltageMinimum); |
| 38 | 1411 } |
| 1412 | |
| 1413 /* third step, counter */ | |
| 1414 switch (global.mode) | |
| 1415 { | |
| 1416 case MODE_SURFACE: | |
| 1417 case MODE_DIVE: | |
| 1418 default: | |
| 1419 deviceDataSubSeconds++; | |
| 1420 if(deviceDataSubSeconds > 10) | |
| 1421 { | |
| 1422 deviceDataSubSeconds = 0; | |
| 1423 global.deviceData.hoursOfOperation.value_int32++; | |
|
409
2e2d34c1cc99
Restore last known date: After a power off RTC looses time data and restarts in the year 2000. Code will fix this date to the year 2016. This change will set the date to the last known date of the operation hour counter
ideenmodellierer
parents:
356
diff
changeset
|
1424 scheduleSetDate(&global.deviceData.hoursOfOperation); |
| 38 | 1425 } |
| 1426 break; | |
| 1427 | |
| 662 | 1428 case MODE_SLEEP: |
| 38 | 1429 case MODE_SHUTDOWN: |
| 1430 break; | |
| 1431 } | |
| 1432 } | |
| 1433 | |
| 1434 | |
| 1435 void scheduleUpdateDeviceDataChargerFull(void) | |
| 1436 { | |
| 1437 global.deviceData.batteryChargeCompleteCycles.value_int32++; | |
| 88 | 1438 scheduleSetDate(&global.deviceData.batteryChargeCompleteCycles); |
| 38 | 1439 } |
| 1440 | |
| 1441 | |
| 1442 void scheduleUpdateDeviceDataChargerCharging(void) | |
| 1443 { | |
| 1444 global.deviceData.batteryChargeCycles.value_int32++; | |
| 88 | 1445 scheduleSetDate(&global.deviceData.batteryChargeCycles); |
| 38 | 1446 } |
| 1447 | |
| 1448 | |
| 1449 /** | |
| 1450 ****************************************************************************** | |
| 1451 * @brief vpm_crush / calls vpm calc_crushing_pressure every four seconds during descend | |
|
763
aa6006975e76
increase HAL_Delay to 10ms for cold-start-button reset
heinrichsweikamp
parents:
742
diff
changeset
|
1452 * @author heinrichs weikamp gmbh |
| 38 | 1453 * @version V0.0.1 |
| 1454 * @date 22-April-2014 | |
| 1455 ****************************************************************************** | |
| 1456 */ | |
| 1457 _Bool vpm_crush2(void) | |
| 1458 { | |
| 1459 int i = 0; | |
| 1460 static float starting_ambient_pressure = 0; | |
| 1461 static float ending_ambient_pressure = 0; | |
| 1462 static float time_calc_begin = -1; | |
| 1463 static float initial_helium_pressure[16]; | |
| 1464 static float initial_nitrogen_pressure[16]; | |
| 1465 ending_ambient_pressure = global.lifeData.pressure_ambient_bar * 10; | |
| 1466 | |
| 1467 if((global.lifeData.dive_time_seconds <= 4) || (starting_ambient_pressure >= ending_ambient_pressure)) | |
| 1468 { | |
| 1469 time_calc_begin = global.lifeData.dive_time_seconds; | |
| 1470 starting_ambient_pressure = global.lifeData.pressure_ambient_bar * 10; | |
| 1471 for( i = 0; i < 16; i++) | |
| 1472 { | |
| 1473 initial_helium_pressure[i] = global.lifeData.tissue_helium_bar[i] * 10; | |
| 1474 initial_nitrogen_pressure[i] = global.lifeData.tissue_nitrogen_bar[i] * 10; | |
| 1475 } | |
| 1476 return 0; | |
| 1477 } | |
| 1478 if(global.lifeData.dive_time_seconds - time_calc_begin >= 4) | |
| 1479 { | |
| 1480 if(ending_ambient_pressure > starting_ambient_pressure + 0.5f) | |
| 1481 { | |
| 1482 float rate = (ending_ambient_pressure - starting_ambient_pressure) * 60 / 4; | |
| 1483 calc_crushing_pressure(&global.lifeData, &global.vpm, initial_helium_pressure, initial_nitrogen_pressure, starting_ambient_pressure, rate); | |
| 1484 | |
| 1485 time_calc_begin = global.lifeData.dive_time_seconds; | |
| 1486 starting_ambient_pressure = global.lifeData.pressure_ambient_bar * 10; | |
| 1487 for( i = 0; i < 16; i++) | |
| 1488 { | |
| 1489 initial_helium_pressure[i] = global.lifeData.tissue_helium_bar[i] * 10; | |
| 1490 initial_nitrogen_pressure[i] = global.lifeData.tissue_nitrogen_bar[i] * 10; | |
| 1491 } | |
| 1492 | |
| 1493 return 1; | |
| 1494 } | |
| 1495 | |
| 1496 } | |
| 1497 return 0; | |
| 1498 } | |
| 1499 | |
| 1500 | |
| 1501 long get_nofly_time_minutes(void) | |
| 1502 { | |
| 1503 | |
| 1504 if(global.no_fly_time_minutes <= 0) | |
| 1505 return 0; | |
| 1506 | |
| 1507 long minutes_since_last_dive = global.seconds_since_last_dive/60; | |
| 1508 | |
| 1509 if((global.seconds_since_last_dive > 0) && (global.no_fly_time_minutes > minutes_since_last_dive)) | |
| 1510 { | |
| 1511 return (global.no_fly_time_minutes - minutes_since_last_dive); | |
| 1512 } | |
| 1513 else | |
| 1514 { | |
| 1515 global.no_fly_time_minutes = 0; | |
| 1516 return 0; | |
| 1517 } | |
| 1518 } | |
| 1519 | |
| 1520 | |
| 1521 //Supports threadsave copying!!! | |
| 1522 void copyActualGas(SGas gas) | |
| 1523 { | |
| 1524 uint8_t whichGas = !global.whichGas; | |
| 1525 global.aktualGas[whichGas] = gas; | |
| 1526 global.whichGas = whichGas; | |
| 1527 } | |
| 1528 | |
| 1529 | |
| 1530 //Supports threadsave copying!!! | |
| 1531 void copyPressureData(void) | |
| 1532 { | |
|
240
625d20070261
Improvement SPI stability/recoverability
Jan Mulder <jlmulder@xs4all.nl>
parents:
231
diff
changeset
|
1533 global.dataSendToMaster.sensorErrors = global.I2C_SystemStatus; |
| 38 | 1534 uint8_t boolPressureData = !global.dataSendToMaster.boolPressureData; |
| 1535 global.dataSendToMaster.data[boolPressureData].temperature = get_temperature(); | |
| 1536 global.dataSendToMaster.data[boolPressureData].pressure_mbar = get_pressure_mbar(); | |
| 1537 global.dataSendToMaster.data[boolPressureData].surface_mbar = get_surface_mbar(); | |
| 1538 global.dataSendToMaster.data[boolPressureData].ascent_rate_meter_per_min = global.lifeData.ascent_rate_meter_per_min; | |
| 1539 global.dataSendToMaster.data[boolPressureData].pressure_uTick = HAL_GetTick(); | |
| 1540 global.dataSendToMaster.boolPressureData = boolPressureData; | |
|
346
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
1541 global.dataSendToMaster.data[boolPressureData].SPARE1 = is_surface_pressure_stable(); |
| 38 | 1542 } |
| 1543 | |
| 1544 | |
| 1545 //Supports threadsave copying!!! | |
| 1546 void copyCnsAndOtuData(void) | |
| 1547 { | |
| 1548 //uint8_t dataSendToMaster. | |
| 1549 uint8_t boolToxicData = !global.dataSendToMaster.boolToxicData; | |
| 1550 global.dataSendToMaster.data[boolToxicData].cns = global.lifeData.cns; | |
| 1551 global.dataSendToMaster.data[boolToxicData].otu = global.lifeData.otu; | |
| 1552 global.dataSendToMaster.data[boolToxicData].desaturation_time_minutes = global.lifeData.desaturation_time_minutes; | |
| 1553 global.dataSendToMaster.data[boolToxicData].no_fly_time_minutes = get_nofly_time_minutes(); | |
| 1554 global.dataSendToMaster.boolToxicData = boolToxicData; | |
| 1555 } | |
| 1556 | |
| 1557 | |
| 1558 //Supports threadsave copying!!! | |
| 1559 void copyTimeData(void) | |
| 1560 { | |
| 1561 extern RTC_HandleTypeDef RTCHandle; | |
| 1562 | |
| 1563 uint8_t boolTimeData = !global.dataSendToMaster.boolTimeData; | |
| 1564 global.dataSendToMaster.data[boolTimeData].localtime_rtc_tr = (uint32_t)(RTCHandle.Instance->TR & RTC_TR_RESERVED_MASK); | |
| 1565 global.dataSendToMaster.data[boolTimeData].localtime_rtc_dr = (uint32_t)(RTCHandle.Instance->DR & RTC_DR_RESERVED_MASK); | |
| 1566 global.dataSendToMaster.data[boolTimeData].divetime_seconds = (uint32_t)global.lifeData.dive_time_seconds; | |
| 1567 global.dataSendToMaster.data[boolTimeData].dive_time_seconds_without_surface_time = (uint32_t)global.lifeData.dive_time_seconds_without_surface_time; | |
| 1568 global.dataSendToMaster.data[boolTimeData].surfacetime_seconds = (uint32_t)global.seconds_since_last_dive; | |
| 1569 global.dataSendToMaster.data[boolTimeData].counterSecondsShallowDepth = (uint32_t)global.lifeData.counterSecondsShallowDepth; | |
| 1570 global.dataSendToMaster.boolTimeData = boolTimeData; | |
| 1571 } | |
| 1572 | |
| 1573 | |
| 1574 //Supports threadsave copying!!! | |
| 1575 void copyCompassData(void) | |
| 1576 { | |
| 1577 extern float compass_heading; | |
| 1578 extern float compass_roll; | |
| 1579 extern float compass_pitch; | |
| 1580 //uint8_t dataSendToMaster. | |
| 1581 uint8_t boolCompassData = !global.dataSendToMaster.boolCompassData; | |
| 1582 global.dataSendToMaster.data[boolCompassData].compass_heading = compass_heading; | |
| 1583 global.dataSendToMaster.data[boolCompassData].compass_roll = compass_roll; | |
| 1584 global.dataSendToMaster.data[boolCompassData].compass_pitch = compass_pitch; | |
| 1585 global.dataSendToMaster.data[boolCompassData].compass_DX_f = 0; | |
| 1586 global.dataSendToMaster.data[boolCompassData].compass_DY_f = 0; | |
| 1587 global.dataSendToMaster.data[boolCompassData].compass_DZ_f = 0; | |
| 1588 global.dataSendToMaster.data[boolCompassData].compass_uTick = HAL_GetTick(); | |
| 1589 global.dataSendToMaster.boolCompassData = boolCompassData; | |
| 1590 } | |
| 1591 | |
| 1592 | |
| 1593 void copyCompassDataDuringCalibration(int16_t dx, int16_t dy, int16_t dz) | |
| 1594 { | |
| 1595 extern float compass_heading; | |
| 1596 extern float compass_roll; | |
| 1597 extern float compass_pitch; | |
| 1598 //uint8_t dataSendToMaster. | |
| 1599 uint8_t boolCompassData = !global.dataSendToMaster.boolCompassData; | |
| 1600 global.dataSendToMaster.data[boolCompassData].compass_heading = compass_heading; | |
| 1601 global.dataSendToMaster.data[boolCompassData].compass_roll = compass_roll; | |
| 1602 global.dataSendToMaster.data[boolCompassData].compass_pitch = compass_pitch; | |
| 1603 global.dataSendToMaster.data[boolCompassData].compass_DX_f = dx; | |
| 1604 global.dataSendToMaster.data[boolCompassData].compass_DY_f = dy; | |
| 1605 global.dataSendToMaster.data[boolCompassData].compass_DZ_f = dz; | |
| 1606 global.dataSendToMaster.boolCompassData = boolCompassData; | |
| 1607 } | |
| 1608 | |
| 1609 | |
| 1610 //Supports threadsave copying!!! | |
| 1611 void copyBatteryData(void) | |
| 1612 { | |
| 1613 uint8_t boolBatteryData = !global.dataSendToMaster.boolBatteryData; | |
| 668 | 1614 global.lifeData.battery_charge = get_charge(); |
| 38 | 1615 global.dataSendToMaster.data[boolBatteryData].battery_voltage = get_voltage(); |
| 668 | 1616 |
| 1617 if(battery_gas_gauge_isChargeValueValid()) | |
| 1618 { | |
| 1619 global.dataSendToMaster.data[boolBatteryData].battery_charge= global.lifeData.battery_charge; | |
| 1620 } | |
| 1621 else | |
| 1622 { | |
| 1623 global.dataSendToMaster.data[boolBatteryData].battery_charge = global.lifeData.battery_charge * -1.0; /* negate value to show that this is just an assumption */ | |
| 1624 } | |
| 38 | 1625 global.dataSendToMaster.boolBatteryData = boolBatteryData; |
| 1626 } | |
| 1627 | |
| 1628 | |
| 1629 //Supports threadsave copying!!! | |
| 1630 void copyAmbientLightData(void) | |
| 1631 { | |
| 1632 uint8_t boolAmbientLightData = !global.dataSendToMaster.boolAmbientLightData; | |
| 1633 global.dataSendToMaster.data[boolAmbientLightData].ambient_light_level = get_ambient_light_level(); | |
| 1634 global.dataSendToMaster.boolAmbientLightData = boolAmbientLightData; | |
| 1635 } | |
| 1636 | |
| 1637 | |
| 1638 //Supports threadsave copying!!! | |
| 1639 void copyTissueData(void) | |
| 1640 { | |
| 1641 //uint8_t dataSendToMaster. | |
| 1642 uint8_t boolTisssueData = !global.dataSendToMaster.boolTisssueData; | |
| 1643 for(int i = 0; i < 16; i++) | |
| 1644 { | |
| 1645 global.dataSendToMaster.data[boolTisssueData].tissue_nitrogen_bar[i] = global.lifeData.tissue_nitrogen_bar[i]; | |
| 1646 global.dataSendToMaster.data[boolTisssueData].tissue_helium_bar[i] = global.lifeData.tissue_helium_bar[i]; | |
| 1647 } | |
| 1648 global.dataSendToMaster.boolTisssueData = boolTisssueData; | |
| 1649 } | |
| 1650 | |
| 1651 | |
| 1652 //Supports threadsave copying!!! | |
| 1653 void copyVpmCrushingData(void) | |
| 1654 { | |
| 1655 //uint8_t dataSendToMaster. | |
| 1656 uint8_t boolCrushingData = !global.dataSendToMaster.boolCrushingData; | |
| 1657 for(int i = 0; i < 16; i++) | |
| 1658 { | |
| 1659 global.dataSendToMaster.data[boolCrushingData].max_crushing_pressure_n2[i] = global.vpm.max_crushing_pressure_n2[i]; | |
| 1660 global.dataSendToMaster.data[boolCrushingData].max_crushing_pressure_he[i] = global.vpm.max_crushing_pressure_he[i]; | |
| 1661 global.dataSendToMaster.data[boolCrushingData].adjusted_critical_radius_he[i] = global.vpm.adjusted_critical_radius_he[i]; | |
| 1662 global.dataSendToMaster.data[boolCrushingData].adjusted_critical_radius_n2[i] = global.vpm.adjusted_critical_radius_n2[i]; | |
| 1663 } | |
| 1664 global.dataSendToMaster.boolCrushingData = boolCrushingData; | |
| 1665 } | |
| 1666 | |
| 1667 | |
| 1668 void copyDeviceData(void) | |
| 1669 { | |
| 1670 uint8_t boolDeviceData = !global.deviceDataSendToMaster.boolDeviceData; | |
| 1671 memcpy(&global.deviceDataSendToMaster.DeviceData[boolDeviceData], &global.deviceData,sizeof(SDevice)); | |
| 1672 global.deviceDataSendToMaster.boolDeviceData = boolDeviceData; | |
| 1673 | |
| 1674 global.deviceDataSendToMaster.boolVpmRepetitiveDataValid = 0; | |
| 1675 memcpy(&global.deviceDataSendToMaster.VpmRepetitiveData.adjusted_critical_radius_he, &global.vpm.adjusted_critical_radius_he, sizeof(16*4)); | |
| 1676 memcpy(&global.deviceDataSendToMaster.VpmRepetitiveData.adjusted_critical_radius_n2, &global.vpm.adjusted_critical_radius_n2, sizeof(16*4)); | |
| 1677 memcpy(&global.deviceDataSendToMaster.VpmRepetitiveData.adjusted_crushing_pressure_he, &global.vpm.adjusted_crushing_pressure_he, sizeof(16*4)); | |
| 1678 memcpy(&global.deviceDataSendToMaster.VpmRepetitiveData.adjusted_crushing_pressure_n2, &global.vpm.adjusted_crushing_pressure_n2, sizeof(16*4)); | |
| 1679 memcpy(&global.deviceDataSendToMaster.VpmRepetitiveData.initial_allowable_gradient_he, &global.vpm.initial_allowable_gradient_he, sizeof(16*4)); | |
| 1680 memcpy(&global.deviceDataSendToMaster.VpmRepetitiveData.initial_allowable_gradient_n2, &global.vpm.initial_allowable_gradient_n2, sizeof(16*4)); | |
| 1681 memcpy(&global.deviceDataSendToMaster.VpmRepetitiveData.max_actual_gradient, &global.vpm.max_actual_gradient, sizeof(16*4)); | |
| 1682 global.deviceDataSendToMaster.VpmRepetitiveData.repetitive_variables_not_valid = global.vpm.repetitive_variables_not_valid; | |
| 1683 global.deviceDataSendToMaster.boolVpmRepetitiveDataValid = 1; | |
| 1684 } | |
| 1685 | |
| 1686 /* copyPICdata(); is used in spi.c */ | |
| 1687 void copyPICdata(void) | |
| 1688 { | |
| 1689 uint8_t boolPICdata = !global.dataSendToMaster.boolPICdata; | |
| 1690 for(int i = 0; i < 3; i++) | |
| 1691 { | |
| 1692 global.dataSendToMaster.data[boolPICdata].button_setting[i] = global.ButtonPICdata[i]; | |
| 1693 } | |
| 1694 global.dataSendToMaster.boolPICdata = boolPICdata; | |
| 1695 } | |
| 1696 | |
|
554
3328189786e7
Added external ADC interface functionality (MCP3424):
Ideenmodellierer
parents:
488
diff
changeset
|
1697 void copyExtADCdata() |
|
3328189786e7
Added external ADC interface functionality (MCP3424):
Ideenmodellierer
parents:
488
diff
changeset
|
1698 { |
|
3328189786e7
Added external ADC interface functionality (MCP3424):
Ideenmodellierer
parents:
488
diff
changeset
|
1699 float value; |
|
3328189786e7
Added external ADC interface functionality (MCP3424):
Ideenmodellierer
parents:
488
diff
changeset
|
1700 |
|
3328189786e7
Added external ADC interface functionality (MCP3424):
Ideenmodellierer
parents:
488
diff
changeset
|
1701 uint8_t channel = 0; |
|
3328189786e7
Added external ADC interface functionality (MCP3424):
Ideenmodellierer
parents:
488
diff
changeset
|
1702 |
| 691 | 1703 uint8_t boolADCBuffer = ~(global.dataSendToMaster.boolADCO2Data & DATA_BUFFER_ADC); |
| 1704 | |
| 1705 boolADCBuffer &= DATA_BUFFER_ADC; | |
| 1706 global.dataSendToMaster.boolADCO2Data &= ~DATA_BUFFER_ADC; | |
| 1707 | |
|
554
3328189786e7
Added external ADC interface functionality (MCP3424):
Ideenmodellierer
parents:
488
diff
changeset
|
1708 for(channel = 0; channel < MAX_ADC_CHANNEL; channel++) |
|
3328189786e7
Added external ADC interface functionality (MCP3424):
Ideenmodellierer
parents:
488
diff
changeset
|
1709 { |
|
3328189786e7
Added external ADC interface functionality (MCP3424):
Ideenmodellierer
parents:
488
diff
changeset
|
1710 value = getExternalInterfaceChannel(channel); |
| 691 | 1711 global.dataSendToMaster.data[boolADCBuffer && DATA_BUFFER_ADC].extADC_voltage[channel] = value; |
|
554
3328189786e7
Added external ADC interface functionality (MCP3424):
Ideenmodellierer
parents:
488
diff
changeset
|
1712 } |
| 786 | 1713 global.dataSendToMaster.data[boolADCBuffer && DATA_BUFFER_ADC].externalInterface_SensorID = externalInterface_GetSensorData(0xFF, (uint8_t*)&global.dataSendToMaster.data[boolADCBuffer && DATA_BUFFER_ADC].sensor_data); |
| 731 | 1714 memcpy(global.dataSendToMaster.data[boolADCBuffer && DATA_BUFFER_ADC].sensor_map,externalInterface_GetSensorMapPointer(1),EXT_INTERFACE_SENSOR_CNT); |
| 691 | 1715 global.dataSendToMaster.boolADCO2Data |= boolADCBuffer; |
|
554
3328189786e7
Added external ADC interface functionality (MCP3424):
Ideenmodellierer
parents:
488
diff
changeset
|
1716 } |
|
3328189786e7
Added external ADC interface functionality (MCP3424):
Ideenmodellierer
parents:
488
diff
changeset
|
1717 |
| 662 | 1718 void copyExtCO2data() |
| 1719 { | |
| 1720 uint16_t value; | |
| 691 | 1721 uint8_t boolCO2Buffer = ~(global.dataSendToMaster.boolADCO2Data & DATA_BUFFER_CO2); |
| 1722 | |
| 1723 global.dataSendToMaster.boolADCO2Data &= ~DATA_BUFFER_CO2; | |
| 1724 boolCO2Buffer &= DATA_BUFFER_CO2; | |
| 662 | 1725 |
| 1726 if(externalInterface_GetCO2State()) | |
| 1727 { | |
| 1728 value = externalInterface_GetCO2Value(); | |
| 691 | 1729 global.dataSendToMaster.data[(boolCO2Buffer && DATA_BUFFER_CO2)].CO2_ppm = value; |
| 662 | 1730 value = externalInterface_GetCO2SignalStrength(); |
| 691 | 1731 global.dataSendToMaster.data[(boolCO2Buffer && DATA_BUFFER_CO2)].CO2_signalStrength = value; |
| 1732 global.dataSendToMaster.data[(boolCO2Buffer && DATA_BUFFER_CO2)].externalInterface_CmdAnswer = externalInterface_GetCO2State(); | |
| 662 | 1733 externalInterface_SetCO2State(EXT_INTERFACE_33V_ON); /* clear command responses */ |
| 1734 } | |
| 1735 else | |
| 1736 { | |
| 691 | 1737 global.dataSendToMaster.data[(boolCO2Buffer && DATA_BUFFER_CO2)].CO2_ppm = 0; |
| 1738 global.dataSendToMaster.data[(boolCO2Buffer && DATA_BUFFER_CO2)].CO2_signalStrength = 0; | |
| 1739 global.dataSendToMaster.data[(boolCO2Buffer && DATA_BUFFER_CO2)].externalInterface_CmdAnswer = 0; | |
| 662 | 1740 } |
| 691 | 1741 global.dataSendToMaster.boolADCO2Data |= boolCO2Buffer; |
| 662 | 1742 } |
| 38 | 1743 |
| 1744 typedef enum | |
| 1745 { | |
| 1746 SPI3_OK = 0x00, | |
| 1747 SPI3_DEINIT = 0x01, | |
| 1748 } SPI3_StatusTypeDef; | |
| 1749 /* if spi3 is running and the SPI3_ButtonAdjust call returns OK, all is fine | |
| 1750 if the SPI3_ButtonAdjust call returns error, the spi3 is DeInit | |
| 1751 and will be init the next call of scheduleSetButtonResponsiveness() | |
| 1752 and data will be send again on the third call | |
| 1753 therefore on return 0 of scheduleSetButtonResponsiveness() the caller flag should kept active | |
| 1754 */ | |
| 1755 uint8_t scheduleSetButtonResponsiveness(void) | |
| 1756 { | |
| 1757 static uint8_t SPI3status = SPI3_OK; | |
| 1758 | |
| 1759 if((SPI3status == SPI3_OK) && (SPI3_ButtonAdjust(global.ButtonResponsiveness, global.ButtonPICdata))) | |
| 1760 { | |
| 1761 copyPICdata(); | |
| 1762 return 1; | |
| 1763 } | |
| 1764 else | |
| 1765 { | |
| 1766 for(int i=0;i<3;i++) | |
| 1767 { | |
| 1768 global.ButtonPICdata[i] = 0xFF; | |
| 1769 } | |
| 1770 copyPICdata(); | |
| 1771 | |
| 1772 if(SPI3status == SPI3_OK) | |
| 1773 { | |
| 1774 MX_SPI3_DeInit(); | |
| 1775 SPI3status = SPI3_DEINIT; | |
| 1776 } | |
| 1777 else | |
| 1778 { | |
| 1779 MX_SPI3_Init(); | |
| 1780 SPI3status = SPI3_OK; | |
| 1781 } | |
| 1782 return 0; | |
| 1783 } | |
| 1784 } | |
| 1785 | |
| 1786 | |
|
186
f11f0bf6ef2d
cleanup: remove obsolete code, make static, etc.
Jan Mulder <jlmulder@xs4all.nl>
parents:
181
diff
changeset
|
1787 //save time difference |
| 38 | 1788 uint32_t time_elapsed_ms(uint32_t ticksstart,uint32_t ticksnow) |
| 1789 { | |
| 1790 if(ticksstart <= ticksnow) | |
| 1791 { | |
| 1792 return ticksnow - ticksstart; | |
| 1793 } | |
| 1794 else | |
| 1795 { | |
| 1796 return 0xFFFFFFFF - ticksstart + ticksnow; | |
| 1797 } | |
| 1798 } | |
| 1799 | |
| 1800 /* same as in data_central.c */ | |
|
310
95928ef3986f
Make dive mode detection more advanced
Jan Mulder <jlmulder@xs4all.nl>
parents:
301
diff
changeset
|
1801 _Bool is_ambient_pressure_close_to_surface(SLifeData *lifeData) |
| 38 | 1802 { |
|
346
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
1803 _Bool retval = true; |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
1804 |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
1805 if(lifeData->pressure_ambient_bar != INVALID_PREASURE_VALUE) /* as long as no valid data is available expect we are close to surface */ |
|
331
b4c578caaafb
Added plausibility check for pressure values
ideenmodellierer
parents:
310
diff
changeset
|
1806 { |
|
346
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
1807 /* this will e.g. apply in case of a significant pressure change during last 30 minutes => use increased offset for surface detection */ |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
1808 if (lifeData->pressure_ambient_bar > START_DIVE_IMMEDIATLY_BAR) |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
1809 { |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
1810 retval = false; |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
1811 } |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
1812 else if(is_surface_pressure_stable()) /* this is the expected start condition */ |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
1813 { |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
1814 if((lifeData->pressure_ambient_bar >= (lifeData->pressure_surface_bar + 0.1f)) |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
1815 && (ManualExitDiveCounter == 0)) /* only if diver did not request to exit dive mode */ |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
1816 { |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
1817 retval = false; |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
1818 } |
|
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
1819 } |
|
331
b4c578caaafb
Added plausibility check for pressure values
ideenmodellierer
parents:
310
diff
changeset
|
1820 } |
|
346
73325a78c907
Added function to support manuel exit of dive mode
ideenmodellierer
parents:
338
diff
changeset
|
1821 return retval; |
| 38 | 1822 } |
| 1823 | |
| 1824 | |
| 1825 /************************ (C) COPYRIGHT heinrichs weikamp *****END OF FILE****/ | |
| 1826 |