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