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