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