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