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