Mercurial > public > ostc4
annotate Small_CPU/Src/scheduler.c @ 86:cc41b5eaf1a7 kittz
fix time&date after wakeup
| author | Dmitry Romanov <kitt@bk.ru> |
|---|---|
| date | Wed, 21 Nov 2018 13:12:44 +0300 |
| parents | 923c4566a2a1 |
| children | e746bf846638 |
| 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 "wireless.h" | |
| 44 #include "tm_stm32f4_otp.h" | |
| 45 | |
| 46 | |
| 47 /* Private types -------------------------------------------------------------*/ | |
| 48 const SGas Air = {79,0,0,0,0}; | |
| 49 | |
| 50 uint8_t testarrayindex = 0; | |
| 51 uint32_t testarray[256]; | |
| 52 uint32_t testarrayMain[256]; | |
| 53 | |
| 54 /* Exported variables --------------------------------------------------------*/ | |
| 55 SGlobal global; | |
| 56 SDevice DeviceDataFlash; | |
| 57 uint8_t deviceDataFlashValid = 0; | |
| 58 uint8_t deviceDataSubSeconds = 0; | |
| 59 | |
| 60 /* Private variables ---------------------------------------------------------*/ | |
| 61 /* can be lost while in sleep */ | |
| 62 uint8_t clearDecoNow = 0; | |
| 63 uint8_t setButtonsNow = 0; | |
| 64 | |
| 65 /* has to be in SRAM2 */ | |
| 66 uint8_t secondsCount = 0; | |
| 67 | |
| 68 /* Private function prototypes -----------------------------------------------*/ | |
| 69 | |
| 70 _Bool vpm_crush2(void); | |
| 71 void scheduleUpdateDeviceData(void); | |
| 72 void initStructWithZeero(uint8_t* data, uint16_t length); | |
| 73 long get_nofly_time_minutes(void); | |
| 74 void copyActualGas(SGas gas); | |
| 75 void copyPressureData(void); | |
| 76 void copyCnsAndOtuData(void); | |
| 77 void copyTimeData(void); | |
| 78 void copyCompassData(void); | |
| 79 void copyCompassDataDuringCalibration(int16_t dx, int16_t dy, int16_t dz); | |
| 80 //void copyBatteryData(void); now in header | |
| 81 void copyAmbientLightData(void); | |
| 82 void copyTissueData(void); | |
| 83 void copyVpmCrushingData(void); | |
| 84 void copyDeviceData(void); | |
| 85 void changeAgeWirelessData(void); | |
| 86 void copyWirelessData(void); | |
| 87 void copyPICdata(void); | |
| 88 uint16_t schedule_update_timer_helper(int8_t thisSeconds); | |
| 89 | |
| 90 | |
| 91 uint32_t time_elapsed_ms(uint32_t ticksstart,uint32_t ticksnow); | |
| 92 | |
| 93 _Bool scheduleCheck_pressure_reached_dive_mode_level(void); | |
| 94 void scheduleSetDate(SDeviceLine *line); | |
| 95 | |
| 96 /* Exported functions --------------------------------------------------------*/ | |
| 97 | |
| 98 void initGlobals(void) | |
| 99 { | |
| 100 initStructWithZeero((uint8_t*) &global, sizeof(SGlobal)); | |
| 101 | |
| 102 global.dataSendToSlavePending = 0; | |
| 103 global.dataSendToSlaveIsValid = 1; | |
| 104 global.dataSendToSlaveIsNotValidCount = 0; | |
| 105 | |
| 106 global.mode = MODE_POWERUP; | |
| 107 global.repetitive_dive = 0; | |
| 108 global.conservatism = 0; | |
| 109 global.whichGas = 0; | |
| 110 global.aktualGas[0] = Air; | |
| 111 global.lifeData.actualGas = global.aktualGas[0]; | |
| 112 | |
| 113 const uint8_t button_standard_sensitivity = ((2400-( 90 *24))/10)+15; | |
| 114 global.ButtonResponsiveness[0] = button_standard_sensitivity; | |
| 115 global.ButtonResponsiveness[1] = button_standard_sensitivity; | |
| 116 global.ButtonResponsiveness[2] = button_standard_sensitivity; | |
| 117 global.ButtonResponsiveness[3] = button_standard_sensitivity; | |
| 118 | |
| 119 global.ButtonPICdata[0] = 0xFF; | |
| 120 global.ButtonPICdata[1] = 0xFF; | |
| 121 global.ButtonPICdata[2] = 0xFF; | |
| 122 global.ButtonPICdata[3] = 0xFF; | |
| 123 | |
| 124 global.I2C_SystemStatus = 0xFF; // 0x00 would be everything working | |
| 125 | |
| 126 global.lifeData.pressure_ambient_bar = 1.0f; | |
| 127 global.lifeData.pressure_surface_bar = 1.0f; | |
| 128 decom_reset_with_1000mbar(&global.lifeData); | |
| 129 | |
| 130 global.demo_mode = 0; | |
| 131 | |
| 132 for(int i = 0; i < MAX_SENSORS; i++) | |
| 133 { | |
| 134 global.sensorError[i] = HAL_OK; // HAL_OK = 0; | |
| 135 } | |
| 136 | |
| 137 global.dataSendToMaster.RTE_VERSION_high = firmwareVersionHigh();//RTE_VERSION_HIGH;; | |
| 138 global.dataSendToMaster.RTE_VERSION_low = firmwareVersionLow();//RTE_VERSION_LOW;; | |
| 139 global.dataSendToMaster.chargeStatus = 0; | |
| 140 | |
| 141 global.dataSendToMaster.power_on_reset = 1; | |
| 142 global.dataSendToMaster.header.checkCode[0] = 0xA1; | |
| 143 global.dataSendToMaster.header.checkCode[1] = 0xA2; | |
| 144 global.dataSendToMaster.header.checkCode[2] = 0xA3; | |
| 145 global.dataSendToMaster.header.checkCode[3] = 0xA4; | |
| 146 global.dataSendToMaster.footer.checkCode[3] = 0xE4; | |
| 147 global.dataSendToMaster.footer.checkCode[2] = 0xE3; | |
| 148 global.dataSendToMaster.footer.checkCode[1] = 0xE2; | |
| 149 global.dataSendToMaster.footer.checkCode[0] = 0xE1; | |
| 150 global.dataSendToMaster.sensorErrors = 0; | |
| 151 | |
| 152 global.sync_error_count = 0; | |
| 153 global.check_sync_not_running = 0; | |
| 154 | |
| 155 global.deviceDataSendToMaster.RTE_VERSION_high = firmwareVersionHigh();//RTE_VERSION_HIGH; | |
| 156 global.deviceDataSendToMaster.RTE_VERSION_low = firmwareVersionLow();//RTE_VERSION_LOW; | |
| 157 global.deviceDataSendToMaster.chargeStatus = 0; | |
| 158 | |
| 159 global.deviceDataSendToMaster.power_on_reset = 1; | |
| 160 global.deviceDataSendToMaster.header.checkCode[0] = 0xDF; | |
| 161 global.deviceDataSendToMaster.header.checkCode[1] = 0xDE; | |
| 162 global.deviceDataSendToMaster.header.checkCode[2] = 0xDD; | |
| 163 global.deviceDataSendToMaster.header.checkCode[3] = 0xDC; | |
| 164 global.deviceDataSendToMaster.footer.checkCode[3] = 0xE4; | |
| 165 global.deviceDataSendToMaster.footer.checkCode[2] = 0xE3; | |
| 166 global.deviceDataSendToMaster.footer.checkCode[1] = 0xE2; | |
| 167 global.deviceDataSendToMaster.footer.checkCode[0] = 0xE1; | |
| 168 | |
| 169 global.dataSendToSlave.getDeviceDataNow = 0; | |
| 170 | |
| 171 global.deviceData.batteryChargeCompleteCycles.value_int32 = 0; | |
| 172 global.deviceData.batteryChargeCycles.value_int32 = 0; | |
| 173 global.deviceData.depthMaximum.value_int32 = 0; | |
| 174 global.deviceData.diveCycles.value_int32 = 0; | |
| 175 global.deviceData.hoursOfOperation.value_int32 = 0; | |
| 176 global.deviceData.temperatureMaximum.value_int32 = INT32_MIN; | |
| 177 global.deviceData.temperatureMinimum.value_int32 = INT32_MAX; | |
| 178 global.deviceData.voltageMinimum.value_int32 = INT32_MAX; | |
| 179 } | |
| 180 | |
| 181 | |
| 182 void scheduleSpecial_Evaluate_DataSendToSlave(void) | |
| 183 { | |
|
84
e6abbef57475
Remove unusable code!!! prepare data for SPI in ONLY 1 IRQ!!!!
Dmitry Romanov <kitt@bk.ru>
parents:
82
diff
changeset
|
184 |
|
e6abbef57475
Remove unusable code!!! prepare data for SPI in ONLY 1 IRQ!!!!
Dmitry Romanov <kitt@bk.ru>
parents:
82
diff
changeset
|
185 |
| 38 | 186 global.dataSendToSlavePending = 0; |
|
84
e6abbef57475
Remove unusable code!!! prepare data for SPI in ONLY 1 IRQ!!!!
Dmitry Romanov <kitt@bk.ru>
parents:
82
diff
changeset
|
187 // if(!global.dataSendToSlaveIsValid) return; //TODO: WHAT THE FUCK?????!!!!! |
| 38 | 188 |
| 189 global.dataSendToMaster.confirmRequest.uw = 0; | |
| 190 | |
| 191 if(TM_OTP_Read(0,0) == 0xFF) | |
| 192 { | |
| 193 if(global.dataSendToSlave.revisionHardware == (global.dataSendToSlave.revisionCRCx0x7A ^ 0x7A)) | |
| 194 TM_OTP_Write(0,0,global.dataSendToSlave.revisionHardware); | |
| 195 } | |
| 196 | |
| 197 if(global.dataSendToSlave.setAccidentFlag) | |
| 198 { | |
| 199 global.dataSendToMaster.confirmRequest.ub.accident = 1; | |
| 200 global.deviceData.diveAccident.value_int32 = global.dataSendToSlave.setAccidentFlag; | |
| 201 scheduleSetDate(&global.deviceData.diveAccident); | |
| 202 global.accidentFlag |= global.dataSendToSlave.setAccidentFlag; | |
| 203 if(global.accidentFlag == ACCIDENT_CNS) // LVL1 | |
| 204 global.accidentRemainingSeconds = 2*60*60; | |
| 205 else | |
| 206 global.accidentRemainingSeconds = 24*60*60; | |
| 207 } | |
| 208 | |
| 209 if(global.dataSendToSlave.setTimeNow) | |
| 210 { | |
| 211 global.dataSendToMaster.confirmRequest.ub.time = 1; | |
| 212 RTC_SetTime(global.dataSendToSlave.data.newTime); | |
| 213 schedule_update_timer_helper(0); | |
| 214 } | |
| 215 | |
| 216 if(global.dataSendToSlave.setDateNow) | |
| 217 { | |
| 218 global.dataSendToMaster.confirmRequest.ub.date = 1; | |
| 219 RTC_SetDate(global.dataSendToSlave.data.newDate); | |
| 220 schedule_update_timer_helper(0); | |
| 221 } | |
| 222 | |
| 223 if(global.dataSendToSlave.calibrateCompassNow) | |
| 224 { | |
| 225 global.dataSendToMaster.confirmRequest.ub.compass = 1; | |
| 226 global.mode = MODE_CALIB; | |
| 227 } | |
| 228 | |
| 229 if(global.dataSendToSlave.clearDecoNow) | |
| 230 { | |
| 231 global.dataSendToMaster.confirmRequest.ub.clearDeco = 1; | |
| 232 clearDecoNow = 1; | |
| 233 } | |
| 234 | |
| 235 if(global.dataSendToSlave.setButtonSensitivityNow) | |
| 236 { | |
| 237 global.dataSendToMaster.confirmRequest.ub.button = 1; | |
| 238 global.ButtonResponsiveness[0] = global.dataSendToSlave.data.buttonResponsiveness[0]; | |
| 239 global.ButtonResponsiveness[1] = global.dataSendToSlave.data.buttonResponsiveness[1]; | |
| 240 global.ButtonResponsiveness[2] = global.dataSendToSlave.data.buttonResponsiveness[2]; | |
| 241 global.ButtonResponsiveness[3] = global.dataSendToSlave.data.buttonResponsiveness[3]; | |
| 242 setButtonsNow = 1; | |
| 243 } | |
| 244 | |
| 245 if(global.dataSendToSlave.setBatteryGaugeNow) | |
| 246 { | |
| 247 global.dataSendToMaster.confirmRequest.ub.batterygauge = 1; | |
| 248 battery_gas_gauge_set(global.dataSendToSlave.data.newBatteryGaugePercentageFloat); | |
| 249 } | |
| 250 | |
| 251 if((global.mode == MODE_SURFACE) && (global.dataSendToSlave.mode == MODE_SHUTDOWN)) | |
| 252 { | |
| 253 global.mode = MODE_SHUTDOWN; | |
| 254 } | |
| 255 | |
| 256 if(global.mode == MODE_DIVE) | |
| 257 { | |
| 258 copyActualGas(global.dataSendToSlave.data.actualGas); | |
| 259 } | |
| 260 else | |
| 261 { | |
| 262 copyActualGas(Air); | |
| 263 global.settings.divetimeToCreateLogbook = global.dataSendToSlave.data.divetimeToCreateLogbook; | |
| 264 global.settings.timeoutDiveReachedZeroDepth = global.dataSendToSlave.data.timeoutDiveReachedZeroDepth; | |
| 265 } | |
| 266 | |
| 267 /* for simulation / testing */ | |
| 268 global.ceiling_from_main_CPU_mbar = global.dataSendToSlave.data.ambient_pressure_mbar_ceiling; | |
| 269 | |
| 270 /* for device data updates */ | |
| 271 deviceDataFlashValid = 0; | |
| 272 memcpy(&DeviceDataFlash, &global.dataSendToSlave.data.DeviceData, sizeof(SDevice)); | |
|
84
e6abbef57475
Remove unusable code!!! prepare data for SPI in ONLY 1 IRQ!!!!
Dmitry Romanov <kitt@bk.ru>
parents:
82
diff
changeset
|
273 |
|
e6abbef57475
Remove unusable code!!! prepare data for SPI in ONLY 1 IRQ!!!!
Dmitry Romanov <kitt@bk.ru>
parents:
82
diff
changeset
|
274 //TODO: (kittz) split by current mode. |
|
85
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
275 |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
276 // new hw 170523 |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
277 if(global.I2C_SystemStatus != HAL_OK) |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
278 { |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
279 MX_I2C1_TestAndClear(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
280 MX_I2C1_Init(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
281 if(!is_init_pressure_done()) |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
282 { |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
283 init_pressure(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
284 } |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
285 } |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
286 |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
287 pressure_update(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
288 copyPressureData(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
289 compass_read(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
290 acceleration_read(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
291 compass_calc(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
292 battery_gas_gauge_get_data(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
293 copyCompassData(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
294 |
|
84
e6abbef57475
Remove unusable code!!! prepare data for SPI in ONLY 1 IRQ!!!!
Dmitry Romanov <kitt@bk.ru>
parents:
82
diff
changeset
|
295 copyCnsAndOtuData(); |
|
e6abbef57475
Remove unusable code!!! prepare data for SPI in ONLY 1 IRQ!!!!
Dmitry Romanov <kitt@bk.ru>
parents:
82
diff
changeset
|
296 copyTimeData(); |
|
e6abbef57475
Remove unusable code!!! prepare data for SPI in ONLY 1 IRQ!!!!
Dmitry Romanov <kitt@bk.ru>
parents:
82
diff
changeset
|
297 copyBatteryData(); |
|
e6abbef57475
Remove unusable code!!! prepare data for SPI in ONLY 1 IRQ!!!!
Dmitry Romanov <kitt@bk.ru>
parents:
82
diff
changeset
|
298 copyDeviceData(); |
|
e6abbef57475
Remove unusable code!!! prepare data for SPI in ONLY 1 IRQ!!!!
Dmitry Romanov <kitt@bk.ru>
parents:
82
diff
changeset
|
299 copyVpmCrushingData(); |
| 86 | 300 |
| 301 deviceDataFlashValid = 1; | |
|
85
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
302 scheduleUpdateDeviceData(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
303 |
| 38 | 304 } |
| 305 | |
| 306 | |
| 307 /** | |
| 308 ****************************************************************************** | |
| 309 * @brief schedule_time_compare_helper. | |
| 310 * @author heinrichs weikamp gmbh | |
| 311 * @version V0.0.1 | |
| 312 * @date 20-Oct-2016 | |
| 313 ****************************************************************************** | |
| 314 */ | |
| 315 | |
| 316 uint8_t RtcBugFixChsw(uint8_t inStupidTime) | |
| 317 { | |
| 318 uint8_t multiplesOf16 = 0; | |
| 319 | |
| 320 multiplesOf16 = inStupidTime / 16; | |
| 321 | |
| 322 inStupidTime -= multiplesOf16 * 16; | |
| 323 | |
| 324 return (10 * multiplesOf16) + inStupidTime; | |
| 325 } | |
| 326 | |
| 327 | |
| 328 uint32_t minCounterDebug = 0; | |
| 329 | |
| 330 uint32_t schedule_time_compare_helper(RTC_TimeTypeDef timeNow, RTC_DateTypeDef dateNow, RTC_TimeTypeDef timeLast, RTC_DateTypeDef dateLast) | |
| 331 { | |
| 332 uint32_t nowInSeconds; | |
| 333 uint32_t lastInSeconds; | |
| 334 uint32_t resultDiff; | |
| 335 | |
| 336 if(timeNow.Minutes != timeLast.Minutes) | |
| 337 minCounterDebug++; | |
| 338 | |
| 339 nowInSeconds = (uint32_t)RtcBugFixChsw(timeNow.Hours) * 3600; | |
| 340 nowInSeconds += (uint32_t)RtcBugFixChsw(timeNow.Minutes) * 60; | |
| 341 nowInSeconds += (uint32_t)RtcBugFixChsw(timeNow.Seconds); | |
| 342 | |
| 343 lastInSeconds = (uint32_t)RtcBugFixChsw(timeLast.Hours) * 3600; | |
| 344 lastInSeconds += (uint32_t)RtcBugFixChsw(timeLast.Minutes) * 60; | |
| 345 lastInSeconds += (uint32_t)RtcBugFixChsw(timeLast.Seconds); | |
| 346 | |
| 347 /* | |
| 348 nowInSeconds = (uint32_t)timeNow.Hours * 3600; | |
| 349 nowInSeconds += (uint32_t)timeNow.Minutes * 60; | |
| 350 nowInSeconds += (uint32_t)timeNow.Seconds; | |
| 351 | |
| 352 lastInSeconds = (uint32_t)timeLast.Hours * 3600; | |
| 353 lastInSeconds += (uint32_t)timeLast.Minutes * 60; | |
| 354 lastInSeconds += (uint32_t)timeLast.Seconds; | |
| 355 */ | |
| 356 | |
| 357 if(dateNow.Date != dateLast.Date) | |
| 358 { | |
| 359 resultDiff = 86400 + nowInSeconds - lastInSeconds; | |
| 360 } | |
| 361 else | |
| 362 { | |
| 363 resultDiff = nowInSeconds - lastInSeconds; | |
| 364 } | |
| 365 return resultDiff; | |
| 366 } | |
| 367 | |
| 368 | |
| 369 | |
| 370 /** | |
| 371 ****************************************************************************** | |
| 372 * @brief schedule_update_timer_helper. | |
| 373 * @author heinrichs weikamp gmbh | |
| 374 * @version V0.0.1 | |
| 375 * @date 20-Oct-2016 | |
| 376 * @brief use 0 for init | |
| 377 use -1 for RTC controlled | |
| 378 use >= 1 for manual control | |
| 379 ****************************************************************************** | |
| 380 */ | |
| 381 extern RTC_HandleTypeDef RTCHandle; | |
| 382 | |
| 383 uint16_t schedule_update_timer_helper(int8_t thisSeconds) | |
| 384 { | |
| 385 static RTC_TimeTypeDef sTimeLast; | |
| 386 static RTC_DateTypeDef sDateLast; | |
| 387 RTC_TimeTypeDef sTimeNow; | |
| 388 RTC_DateTypeDef sDateNow; | |
| 389 uint32_t secondsPast; | |
| 390 uint32_t tempNewValue = 0; | |
| 391 | |
| 392 HAL_RTC_GetTime(&RTCHandle, &sTimeNow, RTC_FORMAT_BCD); | |
| 393 HAL_RTC_GetDate(&RTCHandle, &sDateNow, RTC_FORMAT_BCD); | |
| 394 | |
| 395 if(thisSeconds != 0) // otherwise just store sTimeLast, sDateLast and return 0 | |
| 396 { | |
| 397 secondsPast = schedule_time_compare_helper(sTimeNow, sDateNow, sTimeLast, sDateLast); | |
| 398 | |
| 399 if(thisSeconds > 0) // use this value instead, good for pre-loading sTimeLast and sDateLast | |
| 400 { | |
| 401 secondsPast = thisSeconds; | |
| 402 } | |
| 403 | |
| 404 if(global.seconds_since_last_dive) | |
| 405 { | |
| 406 if(secondsPast >= 777900) | |
| 407 { | |
| 408 global.seconds_since_last_dive = 0; | |
| 409 } | |
| 410 else | |
| 411 { | |
| 412 tempNewValue = ((uint32_t)global.seconds_since_last_dive) + secondsPast; | |
| 413 if(tempNewValue > 777900) // a bit more than nine days [seconds] | |
| 414 global.seconds_since_last_dive = 0; | |
| 415 else | |
| 416 global.seconds_since_last_dive = (long)tempNewValue; | |
| 417 } | |
| 418 } | |
| 419 } | |
| 420 | |
| 421 sTimeLast = sTimeNow; | |
| 422 sDateLast = sDateNow; | |
| 423 | |
| 424 return tempNewValue; | |
| 425 } | |
| 426 | |
| 427 | |
| 428 | |
| 429 | |
| 430 /** | |
| 431 ****************************************************************************** | |
| 432 * @brief schedule_check_resync. | |
| 433 * @author heinrichs weikamp gmbh | |
| 434 * @version V0.0.2 | |
| 435 * @date 18-June-2015 | |
| 436 ****************************************************************************** | |
| 437 */ | |
| 438 void schedule_check_resync(void) | |
| 439 { | |
| 82 | 440 //TODO: (kittz) test for stability |
| 441 if((global.check_sync_not_running >= 10)) | |
| 38 | 442 { |
| 443 global.dataSendToSlaveIsNotValidCount = 0; | |
| 444 global.check_sync_not_running = 0; | |
| 445 global.sync_error_count++; | |
| 446 MX_SPI_DeInit(); | |
| 447 HAL_Delay(30); /* could be closer to length of data transmission 23.Feb.2015 hw */ | |
| 448 MX_DMA_Init(); | |
| 449 MX_SPI1_Init(); | |
| 450 SPI_Start_single_TxRx_with_Master(); | |
| 451 } | |
| 452 } | |
| 453 | |
| 454 | |
| 455 /** | |
| 456 ****************************************************************************** | |
| 457 * @brief scheduleDiveMode. / Dive Mode: Main Loop | |
| 458 * @author Peter Ryser | |
| 459 * @version V0.0.1 | |
| 460 * @date 22-April-2014 | |
| 461 ****************************************************************************** | |
| 462 */ | |
| 463 void scheduleDiveMode(void) | |
| 464 { | |
| 465 uint32_t tickstart = 0; | |
| 466 uint32_t ticksdiff = 0; | |
| 467 uint32_t lasttick = 0; | |
| 468 tickstart = HAL_GetTick(); | |
| 469 uint8_t counterPressure100msec = 0; | |
| 470 uint8_t counterCompass100msec = 0; | |
| 471 uint8_t counterAmbientLight100msec = 0; | |
| 472 uint16_t counterWireless1msec = 0; | |
| 473 // uint8_t counterDemo250msec = 0; | |
| 474 uint32_t turbo_seconds = 0; | |
| 475 uint8_t counterAscentRate = 0; | |
| 476 float lastPressure_bar = 0.0f; | |
| 477 global.dataSendToMaster.mode = MODE_DIVE; | |
| 478 global.deviceDataSendToMaster.mode = MODE_DIVE; | |
| 479 //uint16_t counterSecondsShallowDepth = 0; | |
| 480 uint8_t counter_exit = 0; | |
| 481 | |
| 482 tickstart = HAL_GetTick() - 1000; | |
| 483 | |
| 484 global.deviceData.diveCycles.value_int32++; | |
| 485 scheduleSetDate(&global.deviceData.diveCycles); | |
| 486 global.lifeData.counterSecondsShallowDepth = 0; | |
| 487 | |
| 488 while(global.mode == MODE_DIVE) | |
| 489 { | |
| 490 schedule_check_resync(); | |
| 491 lasttick = HAL_GetTick(); | |
| 492 ticksdiff = time_elapsed_ms(tickstart,lasttick); | |
| 493 | |
| 494 | |
| 495 //Evaluate wireless data every ms, if present | |
| 496 if(ticksdiff > counterWireless1msec) | |
| 497 { | |
| 498 counterWireless1msec++; | |
| 499 changeAgeWirelessData(); | |
| 500 global.wirelessReceived = wireless_evaluate(global.wirelessdata,MAX_WIRELESS_BYTES, &global.wirelessConfidenceStatus); | |
| 501 if((global.wirelessReceived > 0) && !wireless_evaluate_crc_error(global.wirelessdata,global.wirelessReceived)) | |
| 502 { | |
| 503 copyWirelessData(); | |
| 504 } | |
| 505 } | |
| 506 | |
| 507 //Evaluate pressure at 20 ms, 120 ms, 220 ms,.... | |
| 508 if(ticksdiff >= counterPressure100msec * 100 + 20) | |
| 509 { | |
| 510 global.check_sync_not_running++; | |
|
85
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
511 // pressure_update(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
512 // scheduleUpdateDeviceData(); |
| 38 | 513 if(global.demo_mode) |
| 514 { | |
| 515 turbo_seconds = demo_modify_temperature_and_pressure(global.lifeData.dive_time_seconds, counterPressure100msec, global.ceiling_from_main_CPU_mbar); | |
| 516 if(turbo_seconds) | |
| 517 { | |
| 518 global.lifeData.dive_time_seconds += turbo_seconds; | |
| 519 decom_tissues_exposure((int)(turbo_seconds), &global.lifeData); | |
| 520 copyTissueData(); | |
| 521 } | |
| 522 if((global.lifeData.counterSecondsShallowDepth > 1) && (global.lifeData.counterSecondsShallowDepth < (global.settings.timeoutDiveReachedZeroDepth - 10))) | |
| 523 global.lifeData.counterSecondsShallowDepth = (global.settings.timeoutDiveReachedZeroDepth - 10); | |
| 524 } | |
| 525 | |
| 526 | |
| 527 //Calc ascentrate every two second (20 * 100 ms) | |
| 528 counterAscentRate++; | |
| 529 if(counterAscentRate == 20) | |
| 530 { | |
| 531 global.lifeData.pressure_ambient_bar = get_pressure_mbar() / 1000.0f; | |
| 532 if(lastPressure_bar >= 0) | |
| 533 { | |
| 534 //2 seconds * 30 == 1 minute, bar * 10 = meter | |
| 535 global.lifeData.ascent_rate_meter_per_min = (lastPressure_bar - global.lifeData.pressure_ambient_bar) * 30 * 10; | |
| 536 } | |
| 537 lastPressure_bar = global.lifeData.pressure_ambient_bar; | |
| 538 counterAscentRate = 0; | |
| 539 | |
| 540 // if(global.demo_mode) | |
| 541 // global.lifeData.ascent_rate_meter_per_min /= 4; | |
| 542 } | |
|
85
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
543 // copyPressureData(); |
| 38 | 544 counterPressure100msec++; |
| 545 } | |
| 546 //evaluate compass data at 50 ms, 150 ms, 250 ms,.... | |
| 547 if(ticksdiff >= counterCompass100msec * 100 + 50) | |
| 548 { | |
|
85
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
549 // compass_read(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
550 // acceleration_read(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
551 // compass_calc(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
552 // copyCompassData(); |
| 38 | 553 counterCompass100msec++; |
| 554 } | |
| 555 | |
| 556 if(ticksdiff >= counterAmbientLight100msec * 100 + 70) | |
| 557 { | |
| 558 adc_ambient_light_sensor_get_data(); | |
| 559 copyAmbientLightData(); | |
| 560 counterAmbientLight100msec++; | |
| 561 } | |
| 562 | |
| 563 /* if(global.demo_mode && (ticksdiff >= counterDemo250msec * 250 + 10)) | |
| 564 { | |
| 565 global.lifeData.dive_time_seconds++; | |
| 566 copyTimeData(); | |
| 567 counterDemo250msec++; | |
| 568 } | |
| 569 */ | |
| 570 //Evaluate tissues, toxic data, vpm, etc. once a second | |
| 571 if(ticksdiff >= 1000) | |
| 572 { | |
| 573 if(global.dataSendToSlave.diveModeInfo != DIVEMODE_Apnea) | |
| 574 { | |
| 575 scheduleUpdateLifeData(0); // includes tissues | |
| 576 global.lifeData.dive_time_seconds++; // there is dive_time_seconds_without_surface_time too | |
| 577 global.lifeData.ppO2 = decom_calc_ppO2(global.lifeData.pressure_ambient_bar, &global.lifeData.actualGas); | |
| 578 decom_oxygen_calculate_cns(&global.lifeData.cns,global.lifeData.ppO2); | |
| 579 decom_oxygen_calculate_otu(&global.lifeData.otu,global.lifeData.ppO2); | |
|
85
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
580 // battery_gas_gauge_get_data(); |
| 38 | 581 |
| 582 | |
| 583 /** counter_exit allows safe exit via button for testing | |
| 584 * and demo_mode is exited too if aplicable. | |
| 585 */ | |
| 586 if(global.dataSendToMaster.mode == MODE_ENDDIVE) | |
| 587 { | |
| 588 counter_exit++; | |
| 589 if(counter_exit >= 2) | |
| 590 { | |
| 591 global.mode = MODE_SURFACE; | |
| 592 global.demo_mode = 0; | |
| 593 } | |
| 594 } | |
| 595 | |
| 596 if(is_ambient_pressure_close_to_surface(&global.lifeData)) | |
| 597 { | |
| 598 global.lifeData.counterSecondsShallowDepth++; | |
| 599 if((global.lifeData.counterSecondsShallowDepth >= global.settings.timeoutDiveReachedZeroDepth) || ((global.lifeData.dive_time_seconds < 60) && (global.demo_mode == 0)) || (global.dataSendToSlave.setEndDive)) | |
| 600 { | |
| 601 global.seconds_since_last_dive = 1; // start counter | |
| 602 schedule_update_timer_helper(0); // zum starten :-) | |
| 603 global.dataSendToMaster.mode = MODE_ENDDIVE; | |
| 604 global.deviceDataSendToMaster.mode = MODE_ENDDIVE; | |
| 605 } | |
| 606 } | |
| 607 else | |
| 608 { | |
| 609 global.lifeData.counterSecondsShallowDepth = 0; | |
| 610 global.lifeData.dive_time_seconds_without_surface_time++; | |
| 611 } | |
| 612 vpm_crush2(); | |
| 613 } | |
| 614 else // DIVEMODE_Apnea | |
| 615 { | |
| 616 global.lifeData.dive_time_seconds++; | |
| 617 | |
| 618 // exit dive mode | |
| 619 if(global.dataSendToMaster.mode == MODE_ENDDIVE) | |
| 620 { | |
| 621 counter_exit++; | |
| 622 if(counter_exit >= 2) | |
| 623 { | |
| 624 scheduleUpdateLifeData(-1); // 'restart' tissue calculations without calculating time during apnea mode | |
| 625 global.lifeData.dive_time_seconds = 0; // use backup noflytime and desaturation time | |
| 626 global.mode = MODE_SURFACE; | |
| 627 global.demo_mode = 0; | |
| 628 } | |
| 629 } | |
| 630 | |
| 631 // surface break | |
| 632 if(is_ambient_pressure_close_to_surface(&global.lifeData)) | |
| 633 { | |
| 634 global.lifeData.counterSecondsShallowDepth++; | |
| 635 if(global.lifeData.counterSecondsShallowDepth > 3) // time for main cpu to copy to apnea_last_dive_time_seconds | |
| 636 { | |
| 637 global.lifeData.dive_time_seconds = 0; // this apnea dive ends here | |
| 638 } | |
| 639 if((global.lifeData.counterSecondsShallowDepth >= global.settings.timeoutDiveReachedZeroDepth) || (global.dataSendToSlave.setEndDive)) | |
| 640 { | |
| 641 global.dataSendToMaster.mode = MODE_ENDDIVE; | |
| 642 global.deviceDataSendToMaster.mode = MODE_ENDDIVE; | |
| 643 } | |
| 644 } | |
| 645 else | |
| 646 { | |
| 647 global.lifeData.counterSecondsShallowDepth = 0; | |
| 648 global.lifeData.dive_time_seconds_without_surface_time++; | |
| 649 } | |
| 650 } // standard dive or DIVEMODE_Apnea | |
| 651 | |
|
84
e6abbef57475
Remove unusable code!!! prepare data for SPI in ONLY 1 IRQ!!!!
Dmitry Romanov <kitt@bk.ru>
parents:
82
diff
changeset
|
652 // copyVpmCrushingData(); |
|
e6abbef57475
Remove unusable code!!! prepare data for SPI in ONLY 1 IRQ!!!!
Dmitry Romanov <kitt@bk.ru>
parents:
82
diff
changeset
|
653 // copyTimeData(); |
|
e6abbef57475
Remove unusable code!!! prepare data for SPI in ONLY 1 IRQ!!!!
Dmitry Romanov <kitt@bk.ru>
parents:
82
diff
changeset
|
654 // copyCnsAndOtuData(); |
|
e6abbef57475
Remove unusable code!!! prepare data for SPI in ONLY 1 IRQ!!!!
Dmitry Romanov <kitt@bk.ru>
parents:
82
diff
changeset
|
655 // copyBatteryData(); |
| 38 | 656 |
|
85
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
657 // // new hw 170523 |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
658 // if(global.I2C_SystemStatus != HAL_OK) |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
659 // { |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
660 // MX_I2C1_TestAndClear(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
661 // MX_I2C1_Init(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
662 // if(!is_init_pressure_done()) |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
663 // { |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
664 // init_pressure(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
665 // } |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
666 // } |
| 38 | 667 |
| 668 counterCompass100msec = 0; | |
| 669 counterPressure100msec = 0; | |
| 670 counterAmbientLight100msec = 0; | |
| 671 counterWireless1msec = 0; | |
| 672 // counterDemo250msec = 0; | |
| 673 | |
| 674 /** keep it in rhythm, do not drop the execution time | |
| 675 * therefore do not use tickstart = HAL_GetTick(); | |
| 676 * here | |
| 677 */ | |
| 678 tickstart += 1000; | |
| 679 } | |
| 680 } | |
| 681 } | |
| 682 | |
| 683 | |
| 684 /** | |
| 685 ****************************************************************************** | |
| 686 * @brief scheduleSurfaceMode / surface mode: Main Loop | |
| 687 * @author Peter Ryser | |
| 688 * @version V0.0.1 | |
| 689 * @date 22-April-2014 | |
| 690 ****************************************************************************** | |
| 691 */ | |
| 692 | |
| 693 | |
| 694 // =============================================================================== | |
| 695 // scheduleTestMode | |
| 696 /// @brief included for sealed hardware with permanent RTE update message | |
| 697 // =============================================================================== | |
| 698 void scheduleTestMode(void) | |
| 699 { | |
| 700 uint32_t tickstart = 0; | |
| 701 uint32_t ticksdiff = 0; | |
| 702 uint32_t lasttick = 0; | |
| 703 tickstart = HAL_GetTick(); | |
| 704 | |
| 705 uint8_t counterPressure100msec = 0; | |
| 706 | |
| 707 float temperature_carousel = 0.0f; | |
| 708 float temperature_changer = 0.1f; | |
| 709 | |
| 710 while(global.mode == MODE_TEST) | |
| 711 { | |
| 712 schedule_check_resync(); | |
| 713 lasttick = HAL_GetTick(); | |
| 714 ticksdiff = time_elapsed_ms(tickstart,lasttick); | |
| 715 | |
| 716 //Evaluate pressure at 20 ms, 120 ms, 220 ms,... | |
| 717 if(ticksdiff >= counterPressure100msec * 100 + 20) | |
| 718 { | |
| 719 global.check_sync_not_running++; | |
| 720 | |
|
85
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
721 //pressure_update(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
722 //scheduleUpdateDeviceData(); |
| 38 | 723 global.lifeData.ascent_rate_meter_per_min = 0; |
|
85
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
724 //copyPressureData(); |
| 38 | 725 |
| 726 if(temperature_carousel > 20.0f) | |
| 727 { | |
| 728 temperature_carousel = 20.0f; | |
| 729 temperature_changer = -0.1f; | |
| 730 } | |
| 731 else | |
| 732 if(temperature_carousel < 0) | |
| 733 { | |
| 734 temperature_carousel = 0; | |
| 735 temperature_changer = +0.1f; | |
| 736 } | |
| 737 | |
| 738 temperature_carousel += temperature_changer; | |
| 739 | |
| 740 uint8_t boolPressureData = !global.dataSendToMaster.boolPressureData; | |
| 741 | |
| 742 global.dataSendToMaster.data[boolPressureData].pressure_mbar = get_pressure_mbar(); | |
| 743 | |
| 744 global.dataSendToMaster.data[boolPressureData].temperature = temperature_carousel; | |
| 745 global.dataSendToMaster.data[boolPressureData].pressure_uTick = HAL_GetTick(); | |
| 746 global.dataSendToMaster.boolPressureData = boolPressureData; | |
| 747 | |
| 748 | |
| 749 counterPressure100msec++; | |
| 750 } | |
| 751 | |
| 752 if(ticksdiff >= 1000) | |
| 753 { | |
| 754 //Set back tick counter | |
| 755 tickstart = HAL_GetTick(); | |
| 756 counterPressure100msec = 0; | |
| 757 } | |
| 758 }; | |
| 759 } | |
| 760 | |
| 761 | |
| 762 void scheduleSurfaceMode(void) | |
| 763 { | |
| 764 uint32_t tickstart = 0; | |
| 765 uint32_t ticksdiff = 0; | |
| 766 uint32_t lasttick = 0; | |
| 767 tickstart = HAL_GetTick(); | |
| 768 uint8_t counterPressure100msec = 0; | |
| 769 uint8_t counterCompass100msec = 0; | |
| 770 uint8_t counterAmbientLight100msec = 0; | |
| 771 uint16_t counterWireless1msec = 0; | |
| 772 global.dataSendToMaster.mode = MODE_SURFACE; | |
| 773 global.deviceDataSendToMaster.mode = MODE_SURFACE; | |
| 774 | |
| 775 while(global.mode == MODE_SURFACE) | |
| 776 { | |
| 777 printf("surface...\n"); | |
| 778 | |
| 779 schedule_check_resync(); | |
| 780 lasttick = HAL_GetTick(); | |
| 781 ticksdiff = time_elapsed_ms(tickstart,lasttick); | |
| 782 | |
| 783 if(ticksdiff > counterWireless1msec) | |
| 784 { | |
| 785 counterWireless1msec++; | |
| 786 changeAgeWirelessData(); | |
| 787 global.wirelessReceived = wireless_evaluate(global.wirelessdata,MAX_WIRELESS_BYTES, &global.wirelessConfidenceStatus); | |
| 788 if((global.wirelessReceived > 0) && !wireless_evaluate_crc_error(global.wirelessdata,global.wirelessReceived)) | |
| 789 { | |
| 790 copyWirelessData(); | |
| 791 } | |
| 792 } | |
| 793 if(setButtonsNow == 1) | |
| 794 { | |
| 795 if(scheduleSetButtonResponsiveness()) | |
| 796 setButtonsNow = 0; | |
| 797 } | |
| 798 | |
| 799 //Evaluate pressure at 20 ms, 120 ms, 220 ms,... | |
| 800 if(ticksdiff >= counterPressure100msec * 100 + 20) | |
| 801 { | |
| 802 global.check_sync_not_running++; | |
|
85
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
803 // pressure_update(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
804 // scheduleUpdateDeviceData(); |
| 38 | 805 global.lifeData.ascent_rate_meter_per_min = 0; |
|
85
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
806 // copyPressureData(); |
| 38 | 807 counterPressure100msec++; |
| 808 | |
| 809 if(scheduleCheck_pressure_reached_dive_mode_level()) | |
| 810 global.mode = MODE_DIVE; | |
| 811 } | |
| 812 | |
| 813 //evaluate compass data at 50 ms, 150 ms, 250 ms,... | |
| 814 | |
| 815 if(ticksdiff >= counterCompass100msec * 100 + 50) | |
| 816 { | |
|
85
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
817 // compass_read(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
818 // acceleration_read(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
819 // compass_calc(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
820 // copyCompassData(); |
| 38 | 821 counterCompass100msec++; |
| 822 } | |
| 823 | |
| 824 //evaluate compass data at 70 ms, 170 ms, 270 ms,... | |
| 825 if(ticksdiff >= counterAmbientLight100msec * 100 + 70) | |
| 826 { | |
| 827 adc_ambient_light_sensor_get_data(); | |
| 828 copyAmbientLightData(); | |
| 829 counterAmbientLight100msec++; | |
| 830 } | |
| 831 //Evaluate tissues, toxic data, etc. once a second | |
| 832 if(ticksdiff >= 1000) | |
| 833 { | |
| 834 if(clearDecoNow) | |
| 835 { | |
| 836 decom_reset_with_1000mbar(&global.lifeData); ///< this should almost reset desaturation time | |
| 837 // new 160215 hw | |
| 838 global.repetitive_dive = 0; | |
| 839 global.seconds_since_last_dive = 0; ///< this will reset OTU and CNS as well | |
| 840 global.no_fly_time_minutes = 0; | |
| 841 global.accidentFlag = 0; | |
| 842 global.accidentRemainingSeconds = 0; | |
| 843 vpm_init(&global.vpm, global.conservatism, global.repetitive_dive, global.seconds_since_last_dive); | |
| 844 clearDecoNow = 0; | |
| 845 } | |
| 846 | |
| 847 //Set back tick counter | |
| 848 tickstart = HAL_GetTick(); | |
| 849 | |
| 850 | |
| 851 if(global.seconds_since_last_dive) | |
| 852 { | |
| 853 schedule_update_timer_helper(-1); | |
| 854 // global.seconds_since_last_dive++; | |
| 855 // if(global.seconds_since_last_dive > 777900) // a bit more than nine days [seconds] | |
| 856 // global.seconds_since_last_dive = 0; | |
| 857 } | |
| 858 | |
| 859 if(global.accidentRemainingSeconds) | |
| 860 { | |
| 861 global.accidentRemainingSeconds--; | |
| 862 if(!global.accidentRemainingSeconds) | |
| 863 global.accidentFlag = 0; | |
| 864 } | |
| 865 global.dataSendToMaster.accidentFlags = global.accidentFlag; | |
| 866 | |
| 867 update_surface_pressure(1); | |
| 868 scheduleUpdateLifeData(0); | |
| 869 decom_oxygen_calculate_otu_degrade(&global.lifeData.otu, global.seconds_since_last_dive); | |
| 870 decom_oxygen_calculate_cns_degrade(&global.lifeData.cns, global.seconds_since_last_dive); | |
| 871 global.lifeData.desaturation_time_minutes = decom_calc_desaturation_time(global.lifeData.tissue_nitrogen_bar,global.lifeData.tissue_helium_bar,global.lifeData.pressure_surface_bar); | |
| 872 battery_charger_get_status_and_contral_battery_gas_gauge(0); | |
|
85
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
873 // battery_gas_gauge_get_data(); |
| 38 | 874 |
|
84
e6abbef57475
Remove unusable code!!! prepare data for SPI in ONLY 1 IRQ!!!!
Dmitry Romanov <kitt@bk.ru>
parents:
82
diff
changeset
|
875 // copyCnsAndOtuData(); |
|
e6abbef57475
Remove unusable code!!! prepare data for SPI in ONLY 1 IRQ!!!!
Dmitry Romanov <kitt@bk.ru>
parents:
82
diff
changeset
|
876 // copyTimeData(); |
|
e6abbef57475
Remove unusable code!!! prepare data for SPI in ONLY 1 IRQ!!!!
Dmitry Romanov <kitt@bk.ru>
parents:
82
diff
changeset
|
877 // copyBatteryData(); |
|
e6abbef57475
Remove unusable code!!! prepare data for SPI in ONLY 1 IRQ!!!!
Dmitry Romanov <kitt@bk.ru>
parents:
82
diff
changeset
|
878 // copyDeviceData(); |
| 38 | 879 |
|
85
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
880 // // new hw 170523 |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
881 // if(global.I2C_SystemStatus != HAL_OK) |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
882 // { |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
883 // MX_I2C1_TestAndClear(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
884 // MX_I2C1_Init(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
885 // if(!is_init_pressure_done()) |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
886 // { |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
887 // init_pressure(); |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
888 // } |
|
923c4566a2a1
increased interCPU baudrate, cpu2: i2c in SPI1 IRQ
Dmitry Romanov <kitt@bk.ru>
parents:
84
diff
changeset
|
889 // } |
| 38 | 890 |
| 891 counterCompass100msec = 0; | |
| 892 counterPressure100msec = 0; | |
| 893 counterAmbientLight100msec = 0; | |
| 894 counterWireless1msec = 0; | |
| 895 } | |
| 896 } | |
| 897 } | |
| 898 | |
| 899 | |
| 900 /** | |
| 901 ****************************************************************************** | |
| 902 * @brief scheduleCompassCalibrationMode | |
| 903 * @author heinrichs weikamp gmbh | |
| 904 * @version V0.0.1 | |
| 905 * @since 31-March-2015 | |
| 906 * @date 31-March-2015 | |
| 907 ****************************************************************************** | |
| 908 */ | |
| 909 void scheduleCompassCalibrationMode(void) | |
| 910 { | |
| 911 compass_init(1,7); // fast mode, max gain | |
| 912 compass_calib(); // duration : 1 minute! | |
| 913 compass_init(0,7); // back to normal mode | |
| 914 | |
| 915 if(global.seconds_since_last_dive) | |
| 916 { | |
| 917 schedule_update_timer_helper(-1); | |
| 918 // global.seconds_since_last_dive += 60; | |
| 919 // if(global.seconds_since_last_dive > 777900) // a bit more than nine days [seconds] | |
| 920 // global.seconds_since_last_dive = 0; | |
| 921 } | |
| 922 | |
| 923 scheduleUpdateLifeData(0); | |
| 924 global.mode = MODE_SURFACE; | |
| 925 } | |
| 926 | |
| 927 | |
| 928 /** | |
| 929 ****************************************************************************** | |
| 930 * @brief scheduleSleepMode / sleep mode: Main Loop | |
| 931 * @author heinrichs weikamp gmbh | |
| 932 * @version V0.0.2 | |
| 933 * @since 31-March-2015 | |
| 934 * @date 22-April-2014 | |
| 935 ****************************************************************************** | |
| 936 */ | |
| 937 | |
| 938 void scheduleSleepMode(void) | |
| 939 { | |
| 940 global.dataSendToMaster.mode = 0; | |
| 941 global.deviceDataSendToMaster.mode = 0; | |
| 942 | |
| 943 /* prevent button wake up problem while in sleep_prepare | |
| 944 * sleep prepare does I2C_DeInit() | |
| 945 */ | |
| 946 if(global.mode != MODE_SLEEP) | |
| 947 MX_I2C1_Init(); | |
| 948 else | |
| 949 do | |
| 950 { | |
| 951 I2C_DeInit(); | |
| 952 | |
| 953 #ifdef DEBUGMODE | |
| 954 HAL_Delay(2000); | |
| 955 #else | |
| 956 RTC_StopMode_2seconds(); | |
| 957 #endif | |
| 958 | |
| 959 | |
| 960 | |
| 961 if(global.mode == MODE_SLEEP) | |
| 962 secondsCount += 2; | |
| 963 | |
| 964 MX_I2C1_Init(); | |
| 965 pressure_sensor_get_pressure_raw(); | |
| 966 | |
| 967 if(secondsCount >= 30) | |
| 968 { | |
| 969 pressure_sensor_get_temperature_raw(); | |
| 970 battery_gas_gauge_get_data(); | |
| 971 // ReInit_battery_charger_status_pins(); | |
| 972 battery_charger_get_status_and_contral_battery_gas_gauge(1); | |
| 973 // DeInit_battery_charger_status_pins(); | |
| 974 secondsCount = 0; | |
| 975 } | |
| 976 | |
| 977 pressure_calculation(); | |
| 978 | |
| 979 scheduleUpdateDeviceData(); | |
| 980 update_surface_pressure(2); | |
| 981 | |
| 982 if(global.seconds_since_last_dive) | |
| 983 { | |
| 984 schedule_update_timer_helper(-1); | |
| 985 // global.seconds_since_last_dive += 2; | |
| 986 // if(global.seconds_since_last_dive > 777900) // a bit more than nine days [seconds] | |
| 987 // global.seconds_since_last_dive = 0; | |
| 988 } | |
| 989 | |
| 990 if(global.accidentRemainingSeconds) | |
| 991 { | |
| 992 if(global.accidentRemainingSeconds > 2) | |
| 993 global.accidentRemainingSeconds -= 2; | |
| 994 else | |
| 995 { | |
| 996 global.accidentRemainingSeconds = 0; | |
| 997 global.accidentFlag = 0; | |
| 998 } | |
| 999 } | |
| 1000 | |
| 1001 if(scheduleCheck_pressure_reached_dive_mode_level()) | |
| 1002 global.mode = MODE_BOOT; | |
| 1003 | |
| 1004 scheduleUpdateLifeData(2000); | |
| 1005 } | |
| 1006 while(global.mode == MODE_SLEEP); | |
| 1007 /* new section for system after Standby */ | |
| 1008 scheduleUpdateLifeData(-1); | |
| 1009 clearDecoNow = 0; | |
| 1010 setButtonsNow = 0; | |
| 1011 } | |
| 1012 | |
| 1013 | |
| 1014 | |
| 1015 /* Private functions ---------------------------------------------------------*/ | |
| 1016 | |
| 1017 | |
| 1018 /** | |
| 1019 ****************************************************************************** | |
| 1020 * @brief scheduleCheck_pressure_reached_dive_mode_level | |
| 1021 * @author heinrichs weikamp gmbh | |
| 1022 * @version V0.0.1 from inline code | |
| 1023 * @date 09-Sept-2015 | |
| 1024 ****************************************************************************** | |
| 1025 */ | |
| 1026 _Bool scheduleCheck_pressure_reached_dive_mode_level(void) | |
| 1027 { | |
| 1028 if(get_pressure_mbar() > 1160) | |
| 1029 return 1; | |
| 1030 else | |
| 1031 if((global.mode == MODE_SURFACE) && (get_pressure_mbar() > (get_surface_mbar() + 100)) && (get_surface_mbar() > 880)) | |
| 1032 return 1; | |
| 1033 else | |
| 1034 return 0; | |
| 1035 } | |
| 1036 | |
| 1037 | |
| 1038 /** | |
| 1039 ****************************************************************************** | |
| 1040 * @brief scheduleUpdateLifeData / calculates tissues | |
| 1041 * @author Peter Ryser | |
| 1042 * @version V0.0.1 | |
| 1043 * @date 22-April-2014 | |
| 1044 ****************************************************************************** | |
| 1045 */ | |
| 1046 | |
| 1047 | |
| 1048 void scheduleUpdateLifeData(int32_t asynchron_milliseconds_since_last) | |
| 1049 { | |
| 1050 static _Bool first = 1; | |
| 1051 static uint32_t tickstart = 0; | |
| 1052 static uint32_t ticksrest = 0; | |
| 1053 | |
| 1054 uint32_t ticksdiff = 0; | |
| 1055 uint32_t ticksnow = 0; | |
| 1056 uint32_t time_seconds = 0; | |
| 1057 uint8_t whichGasTmp = 0; | |
| 1058 | |
| 1059 if(asynchron_milliseconds_since_last < 0) | |
| 1060 { | |
| 1061 first = 1; | |
| 1062 tickstart = 0; | |
| 1063 ticksrest = 0; | |
| 1064 return; | |
| 1065 } | |
| 1066 | |
| 1067 if(!asynchron_milliseconds_since_last && first) | |
| 1068 { | |
| 1069 tickstart = HAL_GetTick(); | |
| 1070 first = 0; | |
| 1071 return; | |
| 1072 } | |
| 1073 | |
| 1074 whichGasTmp = global.whichGas; | |
| 1075 global.lifeData.actualGas = global.aktualGas[whichGasTmp]; | |
| 1076 global.lifeData.pressure_ambient_bar = get_pressure_mbar() / 1000.0f; | |
| 1077 global.lifeData.pressure_surface_bar = get_surface_mbar() / 1000.0f; | |
| 1078 | |
| 1079 if(!asynchron_milliseconds_since_last) | |
| 1080 { | |
| 1081 ticksnow = HAL_GetTick(); | |
| 1082 ticksdiff = time_elapsed_ms(tickstart,ticksnow); | |
| 1083 } | |
| 1084 else | |
| 1085 { | |
| 1086 first = 1; | |
| 1087 ticksdiff = asynchron_milliseconds_since_last; | |
| 1088 } | |
| 1089 | |
| 1090 if(ticksrest > 1000) // whatever happens after standby with STM32L476 | |
| 1091 ticksrest = 0; // maybe move static to SRAM2 | |
| 1092 | |
| 1093 ticksdiff += ticksrest; | |
| 1094 time_seconds = ticksdiff/ 1000; | |
| 1095 ticksrest = ticksdiff - time_seconds * 1000; | |
| 1096 tickstart = ticksnow; | |
| 1097 | |
| 1098 decom_tissues_exposure((int)time_seconds, &global.lifeData); | |
| 1099 if(global.demo_mode) | |
| 1100 decom_tissues_exposure((int)(3*time_seconds), &global.lifeData); | |
| 1101 copyTissueData(); | |
| 1102 } | |
| 1103 | |
| 1104 | |
| 1105 /** | |
| 1106 ****************************************************************************** | |
| 1107 * @brief scheduleUpdateDeviceData | |
| 1108 * @author heinrichs weikamp gmbh | |
| 1109 * @version V0.0.1 | |
| 1110 * @date 16-March-2015 | |
| 1111 * | |
| 1112 * two step process | |
| 1113 * first compare with data from main CPU == externalLogbookFlash | |
| 1114 * second update with new sensor data | |
| 1115 ****************************************************************************** | |
| 1116 */ | |
| 1117 void scheduleSetDate(SDeviceLine *line) | |
| 1118 { | |
| 1119 extern RTC_HandleTypeDef RTCHandle; | |
| 1120 | |
| 1121 line->date_rtc_dr = (uint32_t)(RTCHandle.Instance->DR & RTC_DR_RESERVED_MASK); | |
| 1122 line->time_rtc_tr = (uint32_t)(RTCHandle.Instance->TR & RTC_TR_RESERVED_MASK); | |
| 1123 } | |
| 1124 | |
| 1125 | |
| 1126 void scheduleCopyDeviceData(SDeviceLine *lineWrite, const SDeviceLine *lineRead) | |
| 1127 { | |
| 1128 lineWrite->date_rtc_dr = lineRead->date_rtc_dr; | |
| 1129 lineWrite->time_rtc_tr = lineRead->time_rtc_tr; | |
| 1130 lineWrite->value_int32 = lineRead->value_int32; | |
| 1131 } | |
| 1132 | |
| 1133 | |
| 1134 void scheduleUpdateDeviceData(void) | |
| 1135 { | |
| 1136 /* first step, main CPU */ | |
| 1137 | |
| 1138 if(deviceDataFlashValid) | |
| 1139 { | |
| 1140 /* max values */ | |
| 1141 if(global.deviceData.batteryChargeCompleteCycles.value_int32 < DeviceDataFlash.batteryChargeCompleteCycles.value_int32) | |
| 1142 { | |
| 1143 scheduleCopyDeviceData(&global.deviceData.batteryChargeCompleteCycles, &DeviceDataFlash.batteryChargeCompleteCycles); | |
| 1144 } | |
| 1145 if(global.deviceData.batteryChargeCycles.value_int32 < DeviceDataFlash.batteryChargeCycles.value_int32) | |
| 1146 { | |
| 1147 scheduleCopyDeviceData(&global.deviceData.batteryChargeCycles, &DeviceDataFlash.batteryChargeCycles); | |
| 1148 } | |
| 1149 if(global.deviceData.temperatureMaximum.value_int32 < DeviceDataFlash.temperatureMaximum.value_int32) | |
| 1150 { | |
| 1151 scheduleCopyDeviceData(&global.deviceData.temperatureMaximum, &DeviceDataFlash.temperatureMaximum); | |
| 1152 } | |
| 1153 if(global.deviceData.depthMaximum.value_int32 < DeviceDataFlash.depthMaximum.value_int32) | |
| 1154 { | |
| 1155 scheduleCopyDeviceData(&global.deviceData.depthMaximum, &DeviceDataFlash.depthMaximum); | |
| 1156 } | |
| 1157 if(global.deviceData.diveCycles.value_int32 < DeviceDataFlash.diveCycles.value_int32) | |
| 1158 { | |
| 1159 scheduleCopyDeviceData(&global.deviceData.diveCycles, &DeviceDataFlash.diveCycles); | |
| 1160 } | |
| 1161 if(global.deviceData.hoursOfOperation.value_int32 < DeviceDataFlash.hoursOfOperation.value_int32) | |
| 1162 { | |
| 1163 scheduleCopyDeviceData(&global.deviceData.hoursOfOperation, &DeviceDataFlash.hoursOfOperation); | |
| 1164 } | |
| 1165 | |
| 1166 /* min values */ | |
| 1167 if(global.deviceData.temperatureMinimum.value_int32 > DeviceDataFlash.temperatureMinimum.value_int32) | |
| 1168 { | |
| 1169 scheduleCopyDeviceData(&global.deviceData.temperatureMinimum, &DeviceDataFlash.temperatureMinimum); | |
| 1170 } | |
| 1171 if(global.deviceData.voltageMinimum.value_int32 > DeviceDataFlash.voltageMinimum.value_int32) | |
| 1172 { | |
| 1173 scheduleCopyDeviceData(&global.deviceData.voltageMinimum, &DeviceDataFlash.voltageMinimum); | |
| 1174 } | |
| 1175 } | |
| 1176 | |
| 1177 /* second step, sensor data */ | |
| 1178 int32_t temperature_centigrad_int32; | |
| 1179 int32_t pressure_mbar_int32; | |
| 1180 int32_t voltage_mvolt_int32; | |
| 1181 | |
| 1182 temperature_centigrad_int32 = (int32_t)(get_temperature() * 100); | |
| 1183 if(temperature_centigrad_int32 < global.deviceData.temperatureMinimum.value_int32) | |
| 1184 { | |
| 1185 global.deviceData.temperatureMinimum.value_int32 = temperature_centigrad_int32; | |
|
84
e6abbef57475
Remove unusable code!!! prepare data for SPI in ONLY 1 IRQ!!!!
Dmitry Romanov <kitt@bk.ru>
parents:
82
diff
changeset
|
1186 //WTF? scheduleSetDate(&global.deviceData.temperatureMinimum); |
| 38 | 1187 } |
| 1188 | |
| 1189 if(temperature_centigrad_int32 > global.deviceData.temperatureMaximum.value_int32) | |
| 1190 { | |
| 1191 global.deviceData.temperatureMaximum.value_int32 = temperature_centigrad_int32; | |
|
84
e6abbef57475
Remove unusable code!!! prepare data for SPI in ONLY 1 IRQ!!!!
Dmitry Romanov <kitt@bk.ru>
parents:
82
diff
changeset
|
1192 //WTF? scheduleSetDate(&global.deviceData.temperatureMaximum); |
| 38 | 1193 } |
| 1194 | |
| 1195 pressure_mbar_int32 = (int32_t)get_pressure_mbar(); | |
| 1196 if(pressure_mbar_int32 > global.deviceData.depthMaximum.value_int32) | |
| 1197 { | |
| 1198 global.deviceData.depthMaximum.value_int32 = pressure_mbar_int32; | |
|
84
e6abbef57475
Remove unusable code!!! prepare data for SPI in ONLY 1 IRQ!!!!
Dmitry Romanov <kitt@bk.ru>
parents:
82
diff
changeset
|
1199 //WTF? scheduleSetDate(&global.deviceData.depthMaximum); |
| 38 | 1200 } |
| 1201 | |
| 1202 voltage_mvolt_int32 = (int32_t)(get_voltage() * 1000); | |
| 1203 if(voltage_mvolt_int32 < global.deviceData.voltageMinimum.value_int32) | |
| 1204 { | |
| 1205 global.deviceData.voltageMinimum.value_int32 = voltage_mvolt_int32; | |
|
84
e6abbef57475
Remove unusable code!!! prepare data for SPI in ONLY 1 IRQ!!!!
Dmitry Romanov <kitt@bk.ru>
parents:
82
diff
changeset
|
1206 //WTF? scheduleSetDate(&global.deviceData.voltageMinimum); |
| 38 | 1207 } |
| 1208 | |
| 1209 /* third step, counter */ | |
| 1210 switch (global.mode) | |
| 1211 { | |
| 1212 case MODE_SURFACE: | |
| 1213 case MODE_DIVE: | |
| 1214 default: | |
| 1215 deviceDataSubSeconds++; | |
| 1216 if(deviceDataSubSeconds > 10) | |
| 1217 { | |
| 1218 deviceDataSubSeconds = 0; | |
| 1219 global.deviceData.hoursOfOperation.value_int32++; | |
| 1220 } | |
| 1221 break; | |
| 1222 | |
| 1223 case MODE_SLEEP: | |
| 1224 case MODE_SHUTDOWN: | |
| 1225 break; | |
| 1226 } | |
| 1227 } | |
| 1228 | |
| 1229 | |
| 1230 void scheduleUpdateDeviceDataChargerFull(void) | |
| 1231 { | |
| 1232 global.deviceData.batteryChargeCompleteCycles.value_int32++; | |
|
84
e6abbef57475
Remove unusable code!!! prepare data for SPI in ONLY 1 IRQ!!!!
Dmitry Romanov <kitt@bk.ru>
parents:
82
diff
changeset
|
1233 //WTF? scheduleSetDate(&global.deviceData.batteryChargeCompleteCycles); |
| 38 | 1234 } |
| 1235 | |
| 1236 | |
| 1237 void scheduleUpdateDeviceDataChargerCharging(void) | |
| 1238 { | |
| 1239 global.deviceData.batteryChargeCycles.value_int32++; | |
|
84
e6abbef57475
Remove unusable code!!! prepare data for SPI in ONLY 1 IRQ!!!!
Dmitry Romanov <kitt@bk.ru>
parents:
82
diff
changeset
|
1240 //WTF? scheduleSetDate(&global.deviceData.batteryChargeCycles); |
| 38 | 1241 } |
| 1242 | |
| 1243 | |
| 1244 /** | |
| 1245 ****************************************************************************** | |
| 1246 * @brief vpm_crush / calls vpm calc_crushing_pressure every four seconds during descend | |
| 1247 * @author Peter Ryser | |
| 1248 * @version V0.0.1 | |
| 1249 * @date 22-April-2014 | |
| 1250 ****************************************************************************** | |
| 1251 */ | |
| 1252 _Bool vpm_crush2(void) | |
| 1253 { | |
| 1254 int i = 0; | |
| 1255 static float starting_ambient_pressure = 0; | |
| 1256 static float ending_ambient_pressure = 0; | |
| 1257 static float time_calc_begin = -1; | |
| 1258 static float initial_helium_pressure[16]; | |
| 1259 static float initial_nitrogen_pressure[16]; | |
| 1260 ending_ambient_pressure = global.lifeData.pressure_ambient_bar * 10; | |
| 1261 | |
| 1262 if((global.lifeData.dive_time_seconds <= 4) || (starting_ambient_pressure >= ending_ambient_pressure)) | |
| 1263 { | |
| 1264 time_calc_begin = global.lifeData.dive_time_seconds; | |
| 1265 starting_ambient_pressure = global.lifeData.pressure_ambient_bar * 10; | |
| 1266 for( i = 0; i < 16; i++) | |
| 1267 { | |
| 1268 initial_helium_pressure[i] = global.lifeData.tissue_helium_bar[i] * 10; | |
| 1269 initial_nitrogen_pressure[i] = global.lifeData.tissue_nitrogen_bar[i] * 10; | |
| 1270 } | |
| 1271 return 0; | |
| 1272 } | |
| 1273 if(global.lifeData.dive_time_seconds - time_calc_begin >= 4) | |
| 1274 { | |
| 1275 if(ending_ambient_pressure > starting_ambient_pressure + 0.5f) | |
| 1276 { | |
| 1277 float rate = (ending_ambient_pressure - starting_ambient_pressure) * 60 / 4; | |
| 1278 calc_crushing_pressure(&global.lifeData, &global.vpm, initial_helium_pressure, initial_nitrogen_pressure, starting_ambient_pressure, rate); | |
| 1279 | |
| 1280 time_calc_begin = global.lifeData.dive_time_seconds; | |
| 1281 starting_ambient_pressure = global.lifeData.pressure_ambient_bar * 10; | |
| 1282 for( i = 0; i < 16; i++) | |
| 1283 { | |
| 1284 initial_helium_pressure[i] = global.lifeData.tissue_helium_bar[i] * 10; | |
| 1285 initial_nitrogen_pressure[i] = global.lifeData.tissue_nitrogen_bar[i] * 10; | |
| 1286 } | |
| 1287 | |
| 1288 return 1; | |
| 1289 } | |
| 1290 | |
| 1291 } | |
| 1292 return 0; | |
| 1293 }; | |
| 1294 | |
| 1295 | |
| 1296 void initStructWithZeero(uint8_t* data, uint16_t length) | |
| 1297 { | |
| 1298 for(uint16_t i = 0; i < length; i++) | |
| 1299 data[i] = 0; | |
| 1300 } | |
| 1301 | |
| 1302 | |
| 1303 long get_nofly_time_minutes(void) | |
| 1304 { | |
| 1305 | |
| 1306 if(global.no_fly_time_minutes <= 0) | |
| 1307 return 0; | |
| 1308 | |
| 1309 long minutes_since_last_dive = global.seconds_since_last_dive/60; | |
| 1310 | |
| 1311 if((global.seconds_since_last_dive > 0) && (global.no_fly_time_minutes > minutes_since_last_dive)) | |
| 1312 { | |
| 1313 return (global.no_fly_time_minutes - minutes_since_last_dive); | |
| 1314 } | |
| 1315 else | |
| 1316 { | |
| 1317 global.no_fly_time_minutes = 0; | |
| 1318 return 0; | |
| 1319 } | |
| 1320 } | |
| 1321 | |
| 1322 | |
| 1323 //Supports threadsave copying!!! | |
| 1324 void copyActualGas(SGas gas) | |
| 1325 { | |
| 1326 uint8_t whichGas = !global.whichGas; | |
| 1327 global.aktualGas[whichGas] = gas; | |
| 1328 global.whichGas = whichGas; | |
| 1329 } | |
| 1330 | |
| 1331 | |
| 1332 //Supports threadsave copying!!! | |
| 1333 void copyPressureData(void) | |
| 1334 { | |
| 1335 global.dataSendToMaster.sensorErrors = I2C1_Status(); | |
| 1336 //uint8_t dataSendToMaster. | |
| 1337 uint8_t boolPressureData = !global.dataSendToMaster.boolPressureData; | |
| 1338 global.dataSendToMaster.data[boolPressureData].temperature = get_temperature(); | |
| 1339 global.dataSendToMaster.data[boolPressureData].pressure_mbar = get_pressure_mbar(); | |
| 1340 global.dataSendToMaster.data[boolPressureData].surface_mbar = get_surface_mbar(); | |
| 1341 global.dataSendToMaster.data[boolPressureData].ascent_rate_meter_per_min = global.lifeData.ascent_rate_meter_per_min; | |
| 1342 global.dataSendToMaster.data[boolPressureData].pressure_uTick = HAL_GetTick(); | |
| 1343 global.dataSendToMaster.boolPressureData = boolPressureData; | |
| 1344 } | |
| 1345 | |
| 1346 | |
| 1347 //Supports threadsave copying!!! | |
| 1348 void copyCnsAndOtuData(void) | |
| 1349 { | |
| 1350 //uint8_t dataSendToMaster. | |
| 1351 uint8_t boolToxicData = !global.dataSendToMaster.boolToxicData; | |
| 1352 global.dataSendToMaster.data[boolToxicData].cns = global.lifeData.cns; | |
| 1353 global.dataSendToMaster.data[boolToxicData].otu = global.lifeData.otu; | |
| 1354 global.dataSendToMaster.data[boolToxicData].desaturation_time_minutes = global.lifeData.desaturation_time_minutes; | |
| 1355 global.dataSendToMaster.data[boolToxicData].no_fly_time_minutes = get_nofly_time_minutes(); | |
| 1356 global.dataSendToMaster.boolToxicData = boolToxicData; | |
| 1357 } | |
| 1358 | |
| 1359 | |
| 1360 //Supports threadsave copying!!! | |
| 1361 void copyTimeData(void) | |
| 1362 { | |
| 1363 extern RTC_HandleTypeDef RTCHandle; | |
| 1364 | |
| 1365 uint8_t boolTimeData = !global.dataSendToMaster.boolTimeData; | |
| 1366 global.dataSendToMaster.data[boolTimeData].localtime_rtc_tr = (uint32_t)(RTCHandle.Instance->TR & RTC_TR_RESERVED_MASK); | |
| 1367 global.dataSendToMaster.data[boolTimeData].localtime_rtc_dr = (uint32_t)(RTCHandle.Instance->DR & RTC_DR_RESERVED_MASK); | |
| 1368 global.dataSendToMaster.data[boolTimeData].divetime_seconds = (uint32_t)global.lifeData.dive_time_seconds; | |
| 1369 global.dataSendToMaster.data[boolTimeData].dive_time_seconds_without_surface_time = (uint32_t)global.lifeData.dive_time_seconds_without_surface_time; | |
| 1370 global.dataSendToMaster.data[boolTimeData].surfacetime_seconds = (uint32_t)global.seconds_since_last_dive; | |
| 1371 global.dataSendToMaster.data[boolTimeData].counterSecondsShallowDepth = (uint32_t)global.lifeData.counterSecondsShallowDepth; | |
| 1372 global.dataSendToMaster.boolTimeData = boolTimeData; | |
| 1373 } | |
| 1374 | |
| 1375 | |
| 1376 //Supports threadsave copying!!! | |
| 1377 void copyCompassData(void) | |
| 1378 { | |
| 1379 extern float compass_heading; | |
| 1380 extern float compass_roll; | |
| 1381 extern float compass_pitch; | |
| 1382 //uint8_t dataSendToMaster. | |
| 1383 uint8_t boolCompassData = !global.dataSendToMaster.boolCompassData; | |
| 1384 global.dataSendToMaster.data[boolCompassData].compass_heading = compass_heading; | |
| 1385 global.dataSendToMaster.data[boolCompassData].compass_roll = compass_roll; | |
| 1386 global.dataSendToMaster.data[boolCompassData].compass_pitch = compass_pitch; | |
| 1387 global.dataSendToMaster.data[boolCompassData].compass_DX_f = 0; | |
| 1388 global.dataSendToMaster.data[boolCompassData].compass_DY_f = 0; | |
| 1389 global.dataSendToMaster.data[boolCompassData].compass_DZ_f = 0; | |
| 1390 global.dataSendToMaster.data[boolCompassData].compass_uTick = HAL_GetTick(); | |
| 1391 global.dataSendToMaster.boolCompassData = boolCompassData; | |
| 1392 } | |
| 1393 | |
| 1394 | |
| 1395 void copyCompassDataDuringCalibration(int16_t dx, int16_t dy, int16_t dz) | |
| 1396 { | |
| 1397 extern float compass_heading; | |
| 1398 extern float compass_roll; | |
| 1399 extern float compass_pitch; | |
| 1400 //uint8_t dataSendToMaster. | |
| 1401 uint8_t boolCompassData = !global.dataSendToMaster.boolCompassData; | |
| 1402 global.dataSendToMaster.data[boolCompassData].compass_heading = compass_heading; | |
| 1403 global.dataSendToMaster.data[boolCompassData].compass_roll = compass_roll; | |
| 1404 global.dataSendToMaster.data[boolCompassData].compass_pitch = compass_pitch; | |
| 1405 global.dataSendToMaster.data[boolCompassData].compass_DX_f = dx; | |
| 1406 global.dataSendToMaster.data[boolCompassData].compass_DY_f = dy; | |
| 1407 global.dataSendToMaster.data[boolCompassData].compass_DZ_f = dz; | |
| 1408 global.dataSendToMaster.boolCompassData = boolCompassData; | |
| 1409 } | |
| 1410 | |
| 1411 | |
| 1412 //Supports threadsave copying!!! | |
| 1413 void copyBatteryData(void) | |
| 1414 { | |
| 1415 uint8_t boolBatteryData = !global.dataSendToMaster.boolBatteryData; | |
| 1416 global.dataSendToMaster.data[boolBatteryData].battery_voltage = get_voltage(); | |
| 1417 global.dataSendToMaster.data[boolBatteryData].battery_charge= get_charge(); | |
| 1418 global.dataSendToMaster.boolBatteryData = boolBatteryData; | |
| 1419 } | |
| 1420 | |
| 1421 | |
| 1422 //Supports threadsave copying!!! | |
| 1423 void copyAmbientLightData(void) | |
| 1424 { | |
| 1425 uint8_t boolAmbientLightData = !global.dataSendToMaster.boolAmbientLightData; | |
| 1426 global.dataSendToMaster.data[boolAmbientLightData].ambient_light_level = get_ambient_light_level(); | |
| 1427 global.dataSendToMaster.boolAmbientLightData = boolAmbientLightData; | |
| 1428 } | |
| 1429 | |
| 1430 | |
| 1431 //Supports threadsave copying!!! | |
| 1432 void copyTissueData(void) | |
| 1433 { | |
| 1434 //uint8_t dataSendToMaster. | |
| 1435 uint8_t boolTisssueData = !global.dataSendToMaster.boolTisssueData; | |
| 1436 for(int i = 0; i < 16; i++) | |
| 1437 { | |
| 1438 global.dataSendToMaster.data[boolTisssueData].tissue_nitrogen_bar[i] = global.lifeData.tissue_nitrogen_bar[i]; | |
| 1439 global.dataSendToMaster.data[boolTisssueData].tissue_helium_bar[i] = global.lifeData.tissue_helium_bar[i]; | |
| 1440 } | |
| 1441 global.dataSendToMaster.boolTisssueData = boolTisssueData; | |
| 1442 } | |
| 1443 | |
| 1444 | |
| 1445 //Supports threadsave copying!!! | |
| 1446 void copyVpmCrushingData(void) | |
| 1447 { | |
| 1448 //uint8_t dataSendToMaster. | |
| 1449 uint8_t boolCrushingData = !global.dataSendToMaster.boolCrushingData; | |
| 1450 for(int i = 0; i < 16; i++) | |
| 1451 { | |
| 1452 global.dataSendToMaster.data[boolCrushingData].max_crushing_pressure_n2[i] = global.vpm.max_crushing_pressure_n2[i]; | |
| 1453 global.dataSendToMaster.data[boolCrushingData].max_crushing_pressure_he[i] = global.vpm.max_crushing_pressure_he[i]; | |
| 1454 global.dataSendToMaster.data[boolCrushingData].adjusted_critical_radius_he[i] = global.vpm.adjusted_critical_radius_he[i]; | |
| 1455 global.dataSendToMaster.data[boolCrushingData].adjusted_critical_radius_n2[i] = global.vpm.adjusted_critical_radius_n2[i]; | |
| 1456 } | |
| 1457 global.dataSendToMaster.boolCrushingData = boolCrushingData; | |
| 1458 } | |
| 1459 | |
| 1460 | |
| 1461 void copyDeviceData(void) | |
| 1462 { | |
| 1463 uint8_t boolDeviceData = !global.deviceDataSendToMaster.boolDeviceData; | |
| 1464 memcpy(&global.deviceDataSendToMaster.DeviceData[boolDeviceData], &global.deviceData,sizeof(SDevice)); | |
| 1465 global.deviceDataSendToMaster.boolDeviceData = boolDeviceData; | |
| 1466 | |
| 1467 global.deviceDataSendToMaster.boolVpmRepetitiveDataValid = 0; | |
| 1468 memcpy(&global.deviceDataSendToMaster.VpmRepetitiveData.adjusted_critical_radius_he, &global.vpm.adjusted_critical_radius_he, sizeof(16*4)); | |
| 1469 memcpy(&global.deviceDataSendToMaster.VpmRepetitiveData.adjusted_critical_radius_n2, &global.vpm.adjusted_critical_radius_n2, sizeof(16*4)); | |
| 1470 memcpy(&global.deviceDataSendToMaster.VpmRepetitiveData.adjusted_crushing_pressure_he, &global.vpm.adjusted_crushing_pressure_he, sizeof(16*4)); | |
| 1471 memcpy(&global.deviceDataSendToMaster.VpmRepetitiveData.adjusted_crushing_pressure_n2, &global.vpm.adjusted_crushing_pressure_n2, sizeof(16*4)); | |
| 1472 memcpy(&global.deviceDataSendToMaster.VpmRepetitiveData.initial_allowable_gradient_he, &global.vpm.initial_allowable_gradient_he, sizeof(16*4)); | |
| 1473 memcpy(&global.deviceDataSendToMaster.VpmRepetitiveData.initial_allowable_gradient_n2, &global.vpm.initial_allowable_gradient_n2, sizeof(16*4)); | |
| 1474 memcpy(&global.deviceDataSendToMaster.VpmRepetitiveData.max_actual_gradient, &global.vpm.max_actual_gradient, sizeof(16*4)); | |
| 1475 global.deviceDataSendToMaster.VpmRepetitiveData.repetitive_variables_not_valid = global.vpm.repetitive_variables_not_valid; | |
| 1476 global.deviceDataSendToMaster.boolVpmRepetitiveDataValid = 1; | |
| 1477 } | |
| 1478 | |
| 1479 void changeAgeWirelessData(void) | |
| 1480 { | |
| 1481 for(int i=0;i<4;i++) | |
| 1482 { | |
| 1483 if(global.dataSendToMaster.data[global.dataSendToMaster.boolWirelessData].wireless_data[i].ageInMilliSeconds) | |
| 1484 global.dataSendToMaster.data[global.dataSendToMaster.boolWirelessData].wireless_data[i].ageInMilliSeconds++; | |
| 1485 } | |
| 1486 } | |
| 1487 | |
| 1488 void copyWirelessData(void) | |
| 1489 { | |
| 1490 uint8_t boolWirelessData = !global.dataSendToMaster.boolWirelessData; | |
| 1491 SDataWireless *dataOld, *dataNew; | |
| 1492 for(int i=0;i<3;i++) | |
| 1493 { | |
| 1494 dataNew = &global.dataSendToMaster.data[boolWirelessData].wireless_data[i+1]; | |
| 1495 dataOld = &global.dataSendToMaster.data[!boolWirelessData].wireless_data[i]; | |
| 1496 dataNew->ageInMilliSeconds = dataOld->ageInMilliSeconds; | |
| 1497 dataNew->numberOfBytes = dataOld->numberOfBytes; | |
| 1498 dataNew->status = dataOld->status; | |
| 1499 memcpy(dataNew->data, dataOld->data,8); | |
| 1500 } | |
| 1501 | |
| 1502 global.dataSendToMaster.data[boolWirelessData].wireless_data[0].ageInMilliSeconds = 1; | |
| 1503 global.dataSendToMaster.data[boolWirelessData].wireless_data[0].numberOfBytes = global.wirelessReceived; | |
| 1504 global.dataSendToMaster.data[boolWirelessData].wireless_data[0].status = global.wirelessConfidenceStatus; | |
| 1505 for(int i=0;i<MAX_WIRELESS_BYTES;i++) | |
| 1506 global.dataSendToMaster.data[boolWirelessData].wireless_data[0].data[i] = global.wirelessdata[i]; | |
| 1507 for(int i=MAX_WIRELESS_BYTES;i<12;i++) | |
| 1508 global.dataSendToMaster.data[boolWirelessData].wireless_data[0].data[i] = 0xFF; | |
| 1509 | |
| 1510 global.dataSendToMaster.boolWirelessData = boolWirelessData; | |
| 1511 } | |
| 1512 | |
| 1513 /* copyPICdata(); is used in spi.c */ | |
| 1514 void copyPICdata(void) | |
| 1515 { | |
| 1516 uint8_t boolPICdata = !global.dataSendToMaster.boolPICdata; | |
| 1517 for(int i = 0; i < 3; i++) | |
| 1518 { | |
| 1519 global.dataSendToMaster.data[boolPICdata].button_setting[i] = global.ButtonPICdata[i]; | |
| 1520 } | |
| 1521 global.dataSendToMaster.boolPICdata = boolPICdata; | |
| 1522 } | |
| 1523 | |
| 1524 | |
| 1525 | |
| 1526 | |
| 1527 typedef enum | |
| 1528 { | |
| 1529 SPI3_OK = 0x00, | |
| 1530 SPI3_DEINIT = 0x01, | |
| 1531 } SPI3_StatusTypeDef; | |
| 1532 /* if spi3 is running and the SPI3_ButtonAdjust call returns OK, all is fine | |
| 1533 if the SPI3_ButtonAdjust call returns error, the spi3 is DeInit | |
| 1534 and will be init the next call of scheduleSetButtonResponsiveness() | |
| 1535 and data will be send again on the third call | |
| 1536 therefore on return 0 of scheduleSetButtonResponsiveness() the caller flag should kept active | |
| 1537 */ | |
| 1538 uint8_t scheduleSetButtonResponsiveness(void) | |
| 1539 { | |
| 1540 static uint8_t SPI3status = SPI3_OK; | |
| 1541 | |
| 1542 if((SPI3status == SPI3_OK) && (SPI3_ButtonAdjust(global.ButtonResponsiveness, global.ButtonPICdata))) | |
| 1543 { | |
| 1544 copyPICdata(); | |
| 1545 return 1; | |
| 1546 } | |
| 1547 else | |
| 1548 { | |
| 1549 for(int i=0;i<3;i++) | |
| 1550 { | |
| 1551 global.ButtonPICdata[i] = 0xFF; | |
| 1552 } | |
| 1553 copyPICdata(); | |
| 1554 | |
| 1555 if(SPI3status == SPI3_OK) | |
| 1556 { | |
| 1557 MX_SPI3_DeInit(); | |
| 1558 SPI3status = SPI3_DEINIT; | |
| 1559 } | |
| 1560 else | |
| 1561 { | |
| 1562 MX_SPI3_Init(); | |
| 1563 SPI3status = SPI3_OK; | |
| 1564 } | |
| 1565 return 0; | |
| 1566 } | |
| 1567 } | |
| 1568 | |
| 1569 | |
| 1570 //save time diffenrence | |
| 1571 uint32_t time_elapsed_ms(uint32_t ticksstart,uint32_t ticksnow) | |
| 1572 { | |
| 1573 if(ticksstart <= ticksnow) | |
| 1574 { | |
| 1575 return ticksnow - ticksstart; | |
| 1576 } | |
| 1577 else | |
| 1578 { | |
| 1579 return 0xFFFFFFFF - ticksstart + ticksnow; | |
| 1580 } | |
| 1581 } | |
| 1582 | |
| 1583 /* same as in data_central.c */ | |
| 1584 _Bool is_ambient_pressure_close_to_surface(SLifeData *lifeDataCall) | |
| 1585 { | |
| 1586 if(lifeDataCall->pressure_ambient_bar < (lifeDataCall->pressure_surface_bar + 0.1f)) // hw 161121 now 1 mter, before 0.04f | |
| 1587 return true; | |
| 1588 else | |
| 1589 return false; | |
| 1590 } | |
| 1591 | |
| 1592 | |
| 1593 /************************ (C) COPYRIGHT heinrichs weikamp *****END OF FILE****/ | |
| 1594 |