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