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