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