38
+ − 1 ///////////////////////////////////////////////////////////////////////////////
+ − 2 /// -*- coding: UTF-8 -*-
+ − 3 ///
+ − 4 /// \file Discovery/Src/simulation.c
+ − 5 /// \brief Contains dive simulation functionality
+ − 6 /// \author Heinrichs Weikamp gmbh
+ − 7 /// \date 13-Oct-2014
+ − 8 ///
+ − 9 /// \details
+ − 10 /// The simulation uses "extern SDiveState stateSim" defined in dataCentral.h"
+ − 11 ///
+ − 12 /// simulation_start(void) sets stateUsed to stateSim and initializes simulation
+ − 13 /// simulation_UpdateLifeData should be called at least once per second
+ − 14 /// simulation_end() sets stateUsed back to stateReal
+ − 15 ///
+ − 16 /// $Id$
+ − 17 ///////////////////////////////////////////////////////////////////////////////
+ − 18 /// \par Copyright (c) 2014-2018 Heinrichs Weikamp gmbh
+ − 19 ///
+ − 20 /// This program is free software: you can redistribute it and/or modify
+ − 21 /// it under the terms of the GNU General Public License as published by
+ − 22 /// the Free Software Foundation, either version 3 of the License, or
+ − 23 /// (at your option) any later version.
+ − 24 ///
+ − 25 /// This program is distributed in the hope that it will be useful,
+ − 26 /// but WITHOUT ANY WARRANTY; without even the implied warranty of
+ − 27 /// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ − 28 /// GNU General Public License for more details.
+ − 29 ///
+ − 30 /// You should have received a copy of the GNU General Public License
+ − 31 /// along with this program. If not, see <http://www.gnu.org/licenses/>.
+ − 32 //////////////////////////////////////////////////////////////////////////////
+ − 33
+ − 34 #include <string.h>
+ − 35 #include "simulation.h"
+ − 36
+ − 37 #include "decom.h"
+ − 38 #include "calc_crush.h"
+ − 39 #include "data_exchange.h"
308
+ − 40 #include "data_exchange_main.h"
38
+ − 41 #include "timer.h"
+ − 42 #include "check_warning.h"
+ − 43 #include "vpm.h"
+ − 44 #include "buehlmann.h"
+ − 45 #include "logbook_miniLive.h"
+ − 46
450
+ − 47 #include "configuration.h"
+ − 48
38
+ − 49 //Private state variables
225
+ − 50 static float sim_aim_depth_meter;
760
+ − 51 static float sim_aim_time_minutes;
225
+ − 52 static _Bool sim_heed_decostops = 1;
38
+ − 53
897
+ − 54 static float sim_descent_rate_meter_per_min = 20;
+ − 55
+ − 56 static uint16_t* pReplayData; /* pointer to source dive data */
+ − 57 static uint8_t simReplayActive = 0;
38
+ − 58
924
+ − 59 static uint16_t simScrubberTimeoutCount = 0;
+ − 60
38
+ − 61
+ − 62 //Private functions
300
+ − 63 static float sim_get_ambient_pressure(SDiveState * pDiveState);
225
+ − 64 static void sim_reduce_deco_time_one_second(SDiveState* pDiveState);
+ − 65 static void simulation_set_aim_depth(int depth_meter);
38
+ − 66
629
+ − 67 #define NUM_OF_SENSORS (3u)
+ − 68 #define SIM_PPO2_STEP (1.1f)
+ − 69 static float simSensmVOffset[NUM_OF_SENSORS];
+ − 70
38
+ − 71 /**
+ − 72 ******************************************************************************
+ − 73 * @brief sets heed_decostops_while_ascending
+ − 74 ******************************************************************************
+ − 75 * @param heed_decostops_while_ascending : true -> deco_stops are considered while ascending
+ − 76 * @return void
+ − 77 */
+ − 78 void simulation_set_heed_decostops(_Bool heed_decostops_while_ascending)
+ − 79 {
629
+ − 80 sim_heed_decostops = heed_decostops_while_ascending;
38
+ − 81 }
+ − 82
+ − 83 /**
+ − 84 ******************************************************************************
+ − 85 * @brief start of simulation
+ − 86 ******************************************************************************
+ − 87 * @return void
+ − 88 */
760
+ − 89 void simulation_start(int aim_depth, uint16_t aim_time_minutes)
38
+ − 90 {
897
+ − 91 uint16_t replayDataLength = 0;
+ − 92 uint8_t* pReplayMarker;
+ − 93 uint16_t max_depth = 10;
+ − 94 uint16_t diveMinutes = 0;
+ − 95
629
+ − 96 copyDiveSettingsToSim();
38
+ − 97 copyVpmRepetetiveDataToSim();
901
+ − 98
38
+ − 99 //vpm_init(&stateSimGetPointerWrite()->vpm, stateSimGetPointerWrite()->diveSettings.vpm_conservatism, 0, 0);
+ − 100 stateSimGetPointerWrite()->lifeData.counterSecondsShallowDepth = 0;
629
+ − 101 stateSimGetPointerWrite()->mode = MODE_DIVE;
38
+ − 102 if(aim_depth <= 0)
+ − 103 aim_depth = 20;
897
+ − 104 sim_descent_rate_meter_per_min = 20;
629
+ − 105 simulation_set_aim_depth(aim_depth);
760
+ − 106 sim_aim_time_minutes = aim_time_minutes;
629
+ − 107 timer_init();
+ − 108 set_stateUsedToSim();
38
+ − 109 stateSim.lifeData.boolResetAverageDepth = 1;
629
+ − 110 decoLock = DECO_CALC_init_as_is_start_of_dive;
38
+ − 111
+ − 112 stateSim.lifeData.apnea_total_max_depth_meter = 0;
924
+ − 113
+ − 114 memcpy(stateSim.scrubberDataDive, settingsGetPointer()->scrubberData, sizeof(stateSim.scrubberDataDive));
629
+ − 115 memset(simSensmVOffset,0,sizeof(simSensmVOffset));
897
+ − 116 if(getReplayOffset() != 0xFFFF)
+ − 117 {
+ − 118 simReplayActive = 1;
+ − 119 getReplayInfo(&pReplayData, &pReplayMarker, &replayDataLength, &max_depth, &diveMinutes);
+ − 120 }
38
+ − 121 }
+ − 122
+ − 123 /**
+ − 124 ******************************************************************************
+ − 125 * @brief end of simulation
+ − 126 ******************************************************************************
+ − 127 *
+ − 128 * @return void
+ − 129 */
+ − 130 void simulation_exit(void)
+ − 131 {
+ − 132 timer_Stopwatch_Stop();
805
dd7ce655db26
Adds a simple countdown timer, available as a custom view in surface and dive mode.
heinrichsweikamp
diff
changeset
+ − 133
dd7ce655db26
Adds a simple countdown timer, available as a custom view in surface and dive mode.
heinrichsweikamp
diff
changeset
+ − 134 disableTimer();
dd7ce655db26
Adds a simple countdown timer, available as a custom view in surface and dive mode.
heinrichsweikamp
diff
changeset
+ − 135
38
+ − 136 set_stateUsedToReal();
+ − 137 }
+ − 138
+ − 139 /**
+ − 140 ******************************************************************************
+ − 141 * @brief simulates change of Lifedata (saturation, depth change, etc.) within one second
+ − 142 ******************************************************************************
+ − 143 *
+ − 144 * @param checkOncePerSecond : true -> simulation in real time (function is evaluated only once per second)
+ − 145 * and copy of parts of LifeData from SmallCPU with each call from HAL_TIM_PeriodElapsedCallback()
+ − 146 * : false -> fast simulation (many simulation cycles per second are possible)
+ − 147 * @return void
+ − 148 */
+ − 149 void simulation_UpdateLifeData( _Bool checkOncePerSecond)
+ − 150 {
+ − 151 SDiveState * pDiveState = &stateSim;
813
+ − 152 const SDiveState * pRealState = stateRealGetPointer();
629
+ − 153 SSettings *pSettings;
38
+ − 154
+ − 155 static int last_second = -1;
+ − 156 static _Bool two_second = 0;
+ − 157 static float lastPressure_bar = 0;
+ − 158
924
+ − 159 pSettings = settingsGetPointer();
+ − 160
897
+ − 161 if ((sim_aim_time_minutes && sim_aim_time_minutes * 60 <= pDiveState->lifeData.dive_time_seconds)
+ − 162 && (!simReplayActive))
+ − 163 {
760
+ − 164 simulation_set_aim_depth(0);
+ − 165 }
+ − 166
699
+ − 167 float localCalibCoeff[3] = { 0.0, 0.0, 0.0 };
629
+ − 168 uint8_t index, index2;
+ − 169
38
+ − 170 if(checkOncePerSecond)
+ − 171 {
901
+ − 172 int now = current_second();
+ − 173 if( last_second == now)
+ − 174 return;
+ − 175 last_second = now;
629
+ − 176
901
+ − 177 if(!two_second)
+ − 178 two_second = 1;
+ − 179 else
+ − 180 {
+ − 181 two_second = 0;
+ − 182 }
924
+ − 183
629
+ − 184 for(index = 0; index < 3; index++)
+ − 185 {
+ − 186 localCalibCoeff[index] = pSettings->ppo2sensors_calibCoeff[index];
+ − 187 if(localCalibCoeff[index] < 0.01)
+ − 188 {
+ − 189 for(index2 = 0; index2 < 3; index2++) /* no valid coeff => check other entries */
+ − 190 {
+ − 191 if(pSettings->ppo2sensors_calibCoeff[index2] > 0.01)
+ − 192 {
+ − 193 localCalibCoeff[index] = pSettings->ppo2sensors_calibCoeff[index2];
+ − 194 break;
+ − 195 }
+ − 196 if(index2 == 3) /* no coeff at all => use default */
+ − 197 {
+ − 198 localCalibCoeff[index] = 0.02;
+ − 199 }
+ − 200 }
+ − 201 }
+ − 202 }
+ − 203
813
+ − 204 pDiveState->lifeData.temperature_celsius = pRealState->lifeData.temperature_celsius;
+ − 205 pDiveState->lifeData.battery_charge = pRealState->lifeData.battery_charge;
+ − 206 pDiveState->lifeData.compass_heading = pRealState->lifeData.compass_heading;
+ − 207 pDiveState->lifeData.compass_roll = pRealState->lifeData.compass_roll;
+ − 208 pDiveState->lifeData.compass_pitch = pRealState->lifeData.compass_pitch;
+ − 209
+ − 210 for(index = 0; index < 3; index++)
+ − 211 {
+ − 212 memcpy(&pDiveState->lifeData.extIf_sensor_data[index], &pRealState->lifeData.extIf_sensor_data[index], 32);
+ − 213 }
548
+ − 214
446
+ − 215 #ifdef ENABLE_BOTTLE_SENSOR
813
+ − 216 pDiveState->lifeData.bottle_bar[pDiveState->lifeData.actualGas.GasIdInSettings] = pRealState->lifeData.bottle_bar[pRealState->lifeData.actualGas.GasIdInSettings];
+ − 217 pDiveState->lifeData.bottle_bar_age_MilliSeconds[pDiveState->lifeData.actualGas.GasIdInSettings] = pRealState->lifeData.bottle_bar_age_MilliSeconds[pRealState->lifeData.actualGas.GasIdInSettings];
446
+ − 218 #endif
38
+ − 219 }
+ − 220 else if(pDiveState->lifeData.depth_meter <= (float)(decom_get_actual_deco_stop(pDiveState) + 0.001))
901
+ − 221 {
+ − 222 if(decoLock == DECO_CALC_FINSHED_vpm)
+ − 223 {
+ − 224 sim_reduce_deco_time_one_second(&stateDeco);
+ − 225 }
+ − 226 else
+ − 227 {
+ − 228 sim_reduce_deco_time_one_second(pDiveState);
+ − 229 }
+ − 230 }
897
+ − 231
38
+ − 232 pDiveState->lifeData.dive_time_seconds += 1;
300
+ − 233 pDiveState->lifeData.pressure_ambient_bar = sim_get_ambient_pressure(pDiveState);
953
+ − 234 if(pDiveState->lifeData.depth_meter < 1.5)
897
+ − 235 {
+ − 236 lastPressure_bar = 0;
+ − 237 pDiveState->lifeData.ascent_rate_meter_per_min = 0;
+ − 238 }
924
+ − 239
+ − 240 if((pSettings->scrubTimerMode != SCRUB_TIMER_OFF) && (isLoopMode(pSettings->dive_mode)) && (pDiveState->mode == MODE_DIVE) && isLoopMode(pDiveState->diveSettings.diveMode))
+ − 241 {
+ − 242 simScrubberTimeoutCount++;
+ − 243 if(simScrubberTimeoutCount >= 60) /* resolution is minutes */
+ − 244 {
+ − 245 simScrubberTimeoutCount = 0;
+ − 246 if(pDiveState->scrubberDataDive[pSettings->scubberActiveId].TimerCur > MIN_SCRUBBER_TIME)
+ − 247 {
+ − 248 pDiveState->scrubberDataDive[pSettings->scubberActiveId].TimerCur--;
+ − 249 }
+ − 250 translateDate(stateUsed->lifeData.dateBinaryFormat, &stateUsedWrite->scrubberDataDive[pSettings->scubberActiveId].lastDive);
+ − 251 }
+ − 252 }
+ − 253
+ − 254
897
+ − 255 if(lastPressure_bar > 0)
+ − 256 {
+ − 257 //1 second * 60 == 1 minute, bar * 10 = meter
+ − 258 pDiveState->lifeData.ascent_rate_meter_per_min = (lastPressure_bar - pDiveState->lifeData.pressure_ambient_bar) * 600.0;
+ − 259 }
+ − 260 lastPressure_bar = pDiveState->lifeData.pressure_ambient_bar;
38
+ − 261
813
+ − 262 pDiveState->lifeData.sensorVoltage_mV[0] = pRealState->lifeData.sensorVoltage_mV[0] + simSensmVOffset[0];
629
+ − 263 if(pDiveState->lifeData.sensorVoltage_mV[0] < 0.0) { pDiveState->lifeData.sensorVoltage_mV[0] = 0.0; }
813
+ − 264 pDiveState->lifeData.sensorVoltage_mV[1] = pRealState->lifeData.sensorVoltage_mV[1] + simSensmVOffset[1];
629
+ − 265 if(pDiveState->lifeData.sensorVoltage_mV[1] < 0.0) { pDiveState->lifeData.sensorVoltage_mV[1] = 0.0; }
813
+ − 266 pDiveState->lifeData.sensorVoltage_mV[2] = pRealState->lifeData.sensorVoltage_mV[2] + simSensmVOffset[2];
629
+ − 267 if(pDiveState->lifeData.sensorVoltage_mV[2] < 0.0) { pDiveState->lifeData.sensorVoltage_mV[2] = 0.0; }
+ − 268
+ − 269 pDiveState->lifeData.ppO2Sensor_bar[0] = pDiveState->lifeData.sensorVoltage_mV[0] * localCalibCoeff[0] * pDiveState->lifeData.pressure_ambient_bar;
+ − 270 pDiveState->lifeData.ppO2Sensor_bar[1] = pDiveState->lifeData.sensorVoltage_mV[1] * localCalibCoeff[1] * pDiveState->lifeData.pressure_ambient_bar;
+ − 271 pDiveState->lifeData.ppO2Sensor_bar[2] = pDiveState->lifeData.sensorVoltage_mV[2] * localCalibCoeff[2] * pDiveState->lifeData.pressure_ambient_bar;
+ − 272
813
+ − 273 pDiveState->lifeData.CO2_data.CO2_ppm = pRealState->lifeData.CO2_data.CO2_ppm;
629
+ − 274
38
+ − 275 if(is_ambient_pressure_close_to_surface(&pDiveState->lifeData)) // new hw 170214
+ − 276 {
+ − 277 if(!(stateSimGetPointer()->lifeData.counterSecondsShallowDepth))
+ − 278 {
+ − 279 if(pDiveState->diveSettings.diveMode != DIVEMODE_Apnea)
+ − 280 pDiveState->lifeData.counterSecondsShallowDepth = settingsGetPointer()->timeoutDiveReachedZeroDepth - 15;
+ − 281 else
+ − 282 {
+ − 283 pDiveState->lifeData.apnea_last_dive_time_seconds = pDiveState->lifeData.dive_time_seconds;
+ − 284 if(pDiveState->lifeData.apnea_last_dive_time_seconds > pDiveState->lifeData.dive_time_seconds_without_surface_time)
+ − 285 pDiveState->lifeData.apnea_last_dive_time_seconds = pDiveState->lifeData.dive_time_seconds_without_surface_time;
+ − 286 pDiveState->lifeData.apnea_last_max_depth_meter = pDiveState->lifeData.max_depth_meter;
+ − 287 pDiveState->lifeData.counterSecondsShallowDepth = 1;
+ − 288 }
+ − 289 }
+ − 290 }
+ − 291 else
+ − 292 {
+ − 293 pDiveState->lifeData.counterSecondsShallowDepth = 0;
+ − 294 }
+ − 295
304
43b44f8d4fb0
bugfix, simulator: fix the 1 sec difference between stopwatch and divetime
Jan Mulder <jlmulder@xs4all.nl>
diff
changeset
+ − 296 if(!is_ambient_pressure_close_to_surface(&pDiveState->lifeData) && !(stateSimGetPointer()->lifeData.counterSecondsShallowDepth) )
43b44f8d4fb0
bugfix, simulator: fix the 1 sec difference between stopwatch and divetime
Jan Mulder <jlmulder@xs4all.nl>
diff
changeset
+ − 297 {
43b44f8d4fb0
bugfix, simulator: fix the 1 sec difference between stopwatch and divetime
Jan Mulder <jlmulder@xs4all.nl>
diff
changeset
+ − 298 pDiveState->lifeData.dive_time_seconds_without_surface_time += 1;
43b44f8d4fb0
bugfix, simulator: fix the 1 sec difference between stopwatch and divetime
Jan Mulder <jlmulder@xs4all.nl>
diff
changeset
+ − 299 }
43b44f8d4fb0
bugfix, simulator: fix the 1 sec difference between stopwatch and divetime
Jan Mulder <jlmulder@xs4all.nl>
diff
changeset
+ − 300
38
+ − 301 pDiveState->lifeData.depth_meter = (pDiveState->lifeData.pressure_ambient_bar - pDiveState->lifeData.pressure_surface_bar) * 10.0f;
+ − 302 if(pDiveState->lifeData.max_depth_meter < pDiveState->lifeData.depth_meter)
+ − 303 pDiveState->lifeData.max_depth_meter = pDiveState->lifeData.depth_meter;
+ − 304
+ − 305 /* apnoe specials
+ − 306 */
+ − 307 if(pDiveState->diveSettings.diveMode == DIVEMODE_Apnea)
+ − 308 {
+ − 309 if(pDiveState->lifeData.max_depth_meter > pDiveState->lifeData.apnea_total_max_depth_meter)
+ − 310 pDiveState->lifeData.apnea_total_max_depth_meter = pDiveState->lifeData.max_depth_meter;
+ − 311
+ − 312 if(pDiveState->lifeData.counterSecondsShallowDepth)
+ − 313 {
+ − 314 pDiveState->lifeData.dive_time_seconds = 0;
+ − 315 pDiveState->lifeData.max_depth_meter = 0;
+ − 316 pDiveState->lifeData.boolResetAverageDepth = 1;
+ − 317 }
+ − 318 }
+ − 319
308
+ − 320 setAvgDepth(pDiveState);
38
+ − 321
+ − 322 /* Exposure Tissues
+ − 323 */
+ − 324 decom_tissues_exposure(1, &pDiveState->lifeData);
+ − 325 decom_oxygen_calculate_cns_exposure(1, &pDiveState->lifeData.actualGas, pDiveState->lifeData.pressure_ambient_bar, &pDiveState->lifeData.cns);
233
+ − 326
38
+ − 327 if(stateSimGetPointer()->lifeData.counterSecondsShallowDepth)
+ − 328 {
+ − 329 stateSimGetPointerWrite()->lifeData.counterSecondsShallowDepth += 1;
+ − 330 if(stateSimGetPointer()->lifeData.counterSecondsShallowDepth >= settingsGetPointer()->timeoutDiveReachedZeroDepth)
+ − 331 simulation_exit();
+ − 332 }
+ − 333 vpm_crush(pDiveState);
+ − 334 }
+ − 335
+ − 336 /**
+ − 337 ******************************************************************************
+ − 338 * @brief adds extra time for fast simulation
+ − 339 ******************************************************************************
+ − 340 *@param minutes
+ − 341 * @return float : new pressure
+ − 342 */
225
+ − 343 static void simulation_add_time(int minutes)
38
+ − 344 {
+ − 345 for(int i = 0; i < 60 * minutes; i++)
+ − 346 {
+ − 347 simulation_UpdateLifeData(0);
+ − 348 updateMiniLiveLogbook(0);
+ − 349 timer_UpdateSecond(0);
+ − 350 }
+ − 351 }
+ − 352
+ − 353 /**
+ − 354 ******************************************************************************
+ − 355 * @brief get aim_depth
+ − 356 ******************************************************************************
+ − 357 * @return sim_aim_depth_meter;
+ − 358 */
+ − 359
+ − 360 uint16_t simulation_get_aim_depth(void)
+ − 361 {
+ − 362 return (uint16_t)sim_aim_depth_meter;
+ − 363 }
+ − 364
+ − 365 /**
+ − 366 ******************************************************************************
+ − 367 * @brief get heed decostops
+ − 368 ******************************************************************************
+ − 369 * @return true if ascend follows decostops;
+ − 370 */
+ − 371
+ − 372 _Bool simulation_get_heed_decostops(void)
+ − 373 {
225
+ − 374 return sim_heed_decostops;
38
+ − 375 }
+ − 376
+ − 377 /**
+ − 378 ******************************************************************************
+ − 379 * @brief sets aim_depth
+ − 380 ******************************************************************************
+ − 381 *@param depth_meter
+ − 382 * @return float : new pressure
+ − 383 */
225
+ − 384 static void simulation_set_aim_depth(int depth_meter)
38
+ − 385 {
+ − 386 sim_aim_depth_meter = depth_meter;
+ − 387 }
+ − 388
+ − 389 /**
+ − 390 ******************************************************************************
300
+ − 391 * @brief simulates ambient pressure depending on aim depth
38
+ − 392 ******************************************************************************
+ − 393 * @note if aim_depth != actual depth, the depth change within one second
+ − 394 * (depending on descent or ascent) rate is calculated
+ − 395 * @param SDiveState* pDiveState:
300
+ − 396 * @return float : new ambient pressure
38
+ − 397 */
300
+ − 398 static float sim_get_ambient_pressure(SDiveState * pDiveState)
38
+ − 399 {
+ − 400 //Calc next depth
+ − 401 uint8_t actual_deco_stop = decom_get_actual_deco_stop(pDiveState);
+ − 402 float depth_meter = pDiveState->lifeData.depth_meter;
+ − 403 float surface_pressure_bar = pDiveState->lifeData.pressure_surface_bar;
897
+ − 404 static uint8_t sampleToggle = 0;
910
+ − 405 static float sim_ascent_rate_meter_per_min_local = 0;
+ − 406 uint8_t sampleTime = getReplayDataResolution();
897
+ − 407
910
+ − 408 if(simReplayActive) /* precondition: function is called once per second, sample rate is a multiple of second */
897
+ − 409 {
+ − 410 if(sampleToggle == 0)
+ − 411 {
910
+ − 412 sampleToggle = sampleTime - 1;
897
+ − 413 sim_aim_depth_meter = (float)(*pReplayData++/100.0);
910
+ − 414 if(sim_aim_depth_meter > depth_meter)
+ − 415 {
+ − 416 sim_descent_rate_meter_per_min = (sim_aim_depth_meter - depth_meter) * (60 / sampleTime);
+ − 417 }
+ − 418 else
+ − 419 {
+ − 420 sim_ascent_rate_meter_per_min_local = (depth_meter - sim_aim_depth_meter) * (60 / sampleTime);
+ − 421 }
897
+ − 422 }
+ − 423 else
+ − 424 {
910
+ − 425 sampleToggle--;
897
+ − 426 }
+ − 427 }
910
+ − 428 else
+ − 429 {
+ − 430 sim_ascent_rate_meter_per_min_local = pDiveState->diveSettings.ascentRate_meterperminute;
+ − 431 }
897
+ − 432
38
+ − 433 if(depth_meter < sim_aim_depth_meter)
+ − 434 {
+ − 435 depth_meter = depth_meter + sim_descent_rate_meter_per_min / 60;
+ − 436 if(depth_meter > sim_aim_depth_meter)
+ − 437 depth_meter = sim_aim_depth_meter;
+ − 438 }
+ − 439 else if(depth_meter > sim_aim_depth_meter)
+ − 440 {
+ − 441
910
+ − 442 depth_meter -= sim_ascent_rate_meter_per_min_local / 60;
38
+ − 443 if(depth_meter < sim_aim_depth_meter)
+ − 444 depth_meter = sim_aim_depth_meter;
+ − 445
225
+ − 446 if(sim_heed_decostops && depth_meter < actual_deco_stop)
38
+ − 447 {
910
+ − 448 if(actual_deco_stop < (depth_meter + sim_ascent_rate_meter_per_min_local / 60))
38
+ − 449 depth_meter = actual_deco_stop;
+ − 450 else
910
+ − 451 depth_meter += sim_ascent_rate_meter_per_min_local / 60;
38
+ − 452 }
+ − 453
+ − 454 }
+ − 455
+ − 456 return surface_pressure_bar + depth_meter / 10;
+ − 457 }
+ − 458
+ − 459
+ − 460 /**
+ − 461 ******************************************************************************
+ − 462 * @brief Reduces deco time of deepest stop by one second
+ − 463 ******************************************************************************
+ − 464 * @note called during fast simulation
+ − 465 * @param SDiveState* pDiveState:
+ − 466 * @return void
+ − 467 */
300
+ − 468 static void sim_reduce_deco_time_one_second(SDiveState* pDiveState)
38
+ − 469 {
+ − 470 SDecoinfo* pDecoinfo;
901
+ − 471 int8_t index = 0;
+ − 472
+ − 473
38
+ − 474 if(pDiveState->diveSettings.deco_type.ub.standard == GF_MODE)
+ − 475 pDecoinfo = &pDiveState->decolistBuehlmann;
+ − 476 else
+ − 477 pDecoinfo = &pDiveState->decolistVPM;
+ − 478
+ − 479 //Reduce deco time of deepest stop by one second
901
+ − 480 for(index = DECOINFO_STRUCT_MAX_STOPS -1 ;index >= 0; index--)
38
+ − 481 {
901
+ − 482 if(pDecoinfo->output_stop_length_seconds[index] > 0)
38
+ − 483 {
901
+ − 484 pDecoinfo->output_stop_length_seconds[index]--;
38
+ − 485 break;
+ − 486 }
+ − 487 }
901
+ − 488 /* update TTS */
+ − 489 if(pDecoinfo->output_time_to_surface_seconds)
+ − 490 {
+ − 491 pDecoinfo->output_time_to_surface_seconds--;
+ − 492 }
38
+ − 493 }
+ − 494
+ − 495 SDecoinfo* simulation_decoplaner(uint16_t depth_meter, uint16_t intervall_time_minutes, uint16_t dive_time_minutes, uint8_t *gasChangeListDepthGas20x2)
+ − 496 {
+ − 497 uint8_t ptrGasChangeList = 0; // new hw 160704
888
+ − 498 uint8_t index = 0;
678
+ − 499 for (int i = 0; i < 40; i++)
+ − 500 gasChangeListDepthGas20x2[i] = 0;
+ − 501
38
+ − 502 SDiveState * pDiveState = &stateSim;
+ − 503 copyDiveSettingsToSim();
888
+ − 504
+ − 505 /* activate deco calculation for all deco gases */
+ − 506 for(index = 0; index < 1 + (2*NUM_GASES); index++)
+ − 507 {
+ − 508 if(pDiveState->diveSettings.gas[index].note.ub.deco)
+ − 509 {
+ − 510 pDiveState->diveSettings.gas[index].note.ub.decocalc = 1;
+ − 511 }
+ − 512 }
+ − 513
38
+ − 514 vpm_init(&pDiveState->vpm, pDiveState->diveSettings.vpm_conservatism, 0, 0);
+ − 515 //buehlmann_init();
+ − 516 //timer_init();
+ − 517 memset(&pDiveState->events,0, sizeof(SEvents));
+ − 518 pDiveState->diveSettings.internal__pressure_first_stop_ambient_bar_as_upper_limit_for_gf_low_otherwise_zero = 0;
+ − 519 //Calc desaturation during intervall (with Air)
+ − 520 setActualGasAir(&pDiveState->lifeData);
+ − 521 if(intervall_time_minutes > 0)
+ − 522 {
+ − 523 decom_tissues_exposure(intervall_time_minutes * 60, &pDiveState->lifeData);
+ − 524 decom_oxygen_calculate_cns_degrade(&pDiveState->lifeData.cns, intervall_time_minutes * 60);
+ − 525 }
+ − 526
+ − 527 //Switch to first Gas
+ − 528 setActualGasFirst(&pDiveState->lifeData);
+ − 529
+ − 530 // new hw 160704
+ − 531 if(gasChangeListDepthGas20x2)
+ − 532 {
+ − 533 gasChangeListDepthGas20x2[ptrGasChangeList++] = 0;
+ − 534 gasChangeListDepthGas20x2[ptrGasChangeList++] = pDiveState->lifeData.actualGas.GasIdInSettings;
+ − 535 gasChangeListDepthGas20x2[0] =0; // depth zero
+ − 536 }
+ − 537
+ − 538 //Going down / descent
+ − 539 simulation_set_aim_depth(depth_meter);
790
+ − 540 sim_aim_time_minutes = 0;
38
+ − 541 for(int i = 0; i < 60 * dive_time_minutes; i++)
+ − 542 {
+ − 543 simulation_UpdateLifeData(0);
+ − 544 check_warning2(pDiveState);
+ − 545 if(pDiveState->warnings.betterGas)
+ − 546 {
+ − 547 setActualGas(&pDiveState->lifeData,actualBetterGasId(),pDiveState->lifeData.actualGas.setPoint_cbar);
+ − 548 if(gasChangeListDepthGas20x2 && (pDiveState->diveSettings.diveMode == DIVEMODE_OC))
+ − 549 {
+ − 550 gasChangeListDepthGas20x2[ptrGasChangeList++] = pDiveState->lifeData.depth_meter;
+ − 551 gasChangeListDepthGas20x2[ptrGasChangeList++] = actualBetterGasId();
+ − 552 }
+ − 553 }
+ − 554 }
+ − 555
+ − 556 decom_CreateGasChangeList(&pDiveState->diveSettings, &pDiveState->lifeData); // was there before and needed for buehlmann_calc_deco and vpm_calc
+ − 557
+ − 558 // new hw 160704
+ − 559 if(gasChangeListDepthGas20x2 && (pDiveState->diveSettings.diveMode == DIVEMODE_OC))
+ − 560 {
+ − 561 // change direction from better gas to deco gas
+ − 562 gasChangeListDepthGas20x2[ptrGasChangeList++] = 255;
+ − 563 gasChangeListDepthGas20x2[ptrGasChangeList++] = 255;
+ − 564
+ − 565 // ascend (deco) gases
+ − 566 for(int i=1; i<=5;i++)
+ − 567 {
830
+ − 568 if((pDiveState->diveSettings.decogaslist[i].change_during_ascent_depth_meter_otherwise_zero == 0)
+ − 569 || (pDiveState->diveSettings.gas[pDiveState->diveSettings.decogaslist[i].GasIdInSettings].note.ub.decocalc == 0))
38
+ − 570 break;
+ − 571 gasChangeListDepthGas20x2[ptrGasChangeList++] = pDiveState->diveSettings.decogaslist[i].change_during_ascent_depth_meter_otherwise_zero;
+ − 572 gasChangeListDepthGas20x2[ptrGasChangeList++] = pDiveState->diveSettings.decogaslist[i].GasIdInSettings;
+ − 573 }
+ − 574 gasChangeListDepthGas20x2[0] = 0;
+ − 575 }
+ − 576
+ − 577 // deco and ascend calc
+ − 578 if(pDiveState->diveSettings.deco_type.ub.standard == GF_MODE)
+ − 579 {
+ − 580 /* this does modify the cns now 11.06.2015 */
+ − 581 buehlmann_calc_deco(&pDiveState->lifeData,&pDiveState->diveSettings,&pDiveState->decolistBuehlmann);
+ − 582 pDiveState->lifeData.cns += buehlmann_get_gCNS();
+ − 583 return &pDiveState->decolistBuehlmann;
+ − 584 }
+ − 585 else
+ − 586 {
+ − 587 /* this does modify the cns now 11.06.2015 */
+ − 588 vpm_calc(&pDiveState->lifeData,&pDiveState->diveSettings,&pDiveState->vpm,&pDiveState->decolistVPM, DECOSTOPS);
+ − 589 pDiveState->lifeData.cns += vpm_get_CNS();
910
+ − 590
+ − 591 while(decoLock == DECO_CALC_FINSHED_vpm)
+ − 592 {
+ − 593 HAL_Delay(2); /* The deco data is copied during the timer ISR => wait till this has happened */
+ − 594 }
38
+ − 595 return &pDiveState->decolistVPM;
+ − 596 }
+ − 597 }
+ − 598
225
+ − 599 static float sGChelper_bar(uint16_t depth_meter)
38
+ − 600 {
+ − 601 SDiveState * pDiveState = &stateSim;
+ − 602 float ambient, surface, density, meter;
+ − 603
+ − 604 surface = pDiveState->lifeData.pressure_surface_bar;
+ − 605
+ − 606 if(!depth_meter)
+ − 607 return surface;
+ − 608
+ − 609 density = ((float)( 100 + settingsGetPointer()->salinity)) / 100.0f;
+ − 610 meter = depth_meter * (0.09807f * density);
+ − 611 ambient = (meter + surface);
+ − 612
+ − 613 return ambient;
+ − 614 }
+ − 615
+ − 616
+ − 617 /**
+ − 618 ******************************************************************************
+ − 619 * @brief simulation_helper_change_points
+ − 620 ******************************************************************************
+ − 621 * @param
+ − 622 * @return void
+ − 623 */
+ − 624 void simulation_helper_change_points(SSimDataSummary *outputSummary, uint16_t depth_meter, uint16_t dive_time_minutes, SDecoinfo *decoInfoInput, const uint8_t *gasChangeListDepthGas20x2)
+ − 625 {
+ − 626 uint8_t ptrDecoInfo = 0;
+ − 627 uint16_t actualDepthPoint = 0;
+ − 628 uint16_t nextDepthPoint = 0;
+ − 629 uint8_t actualConsumGasId = 0;
+ − 630 uint8_t nextGasChangeMeter = 0;
+ − 631 uint8_t ptrChangeList = 0;
+ − 632
+ − 633 float timeThis = 0;
+ − 634 float timeSummary = 0;
+ − 635 float sim_descent_rate_meter_per_min_local = 10;
+ − 636 float sim_ascent_rate_meter_per_min_local = 10;
+ − 637
+ − 638 SDiveState * pDiveState = &stateSim;
+ − 639
+ − 640 uint8_t depthDecoNext, depthLast, depthSecond, depthInc;
+ − 641
+ − 642 if(pDiveState->diveSettings.deco_type.ub.standard == GF_MODE)
+ − 643 {
+ − 644 sim_descent_rate_meter_per_min_local = sim_descent_rate_meter_per_min; // const float
+ − 645 sim_ascent_rate_meter_per_min_local = pDiveState->diveSettings.ascentRate_meterperminute;
+ − 646 }
+ − 647 else
+ − 648 {
+ − 649 sim_descent_rate_meter_per_min_local = sim_descent_rate_meter_per_min; // const float
+ − 650 sim_ascent_rate_meter_per_min_local = 10;// fix in vpm_calc_deco();
+ − 651 }
+ − 652
+ − 653 outputSummary->descentRateMeterPerMinute = sim_descent_rate_meter_per_min_local;
+ − 654 outputSummary->ascentRateMeterPerMinute = sim_ascent_rate_meter_per_min_local;
+ − 655
+ − 656 // bottom gas ppO2
+ − 657 if(gasChangeListDepthGas20x2)
+ − 658 {
+ − 659 nextGasChangeMeter = gasChangeListDepthGas20x2[ptrChangeList++];
+ − 660 actualConsumGasId = gasChangeListDepthGas20x2[ptrChangeList++];
+ − 661 nextGasChangeMeter = gasChangeListDepthGas20x2[ptrChangeList++];
+ − 662
+ − 663 while(actualDepthPoint < depth_meter)
+ − 664 {
+ − 665 if(nextGasChangeMeter && (nextGasChangeMeter < depth_meter) && (gasChangeListDepthGas20x2[ptrChangeList] != 255)) // list has 255,255 for turn from travel to deco
+ − 666 {
+ − 667 nextDepthPoint = nextGasChangeMeter;
+ − 668 }
+ − 669 else
+ − 670 {
+ − 671 nextDepthPoint = depth_meter;
+ − 672 }
+ − 673
+ − 674 if(actualConsumGasId > 5) // safety first
+ − 675 actualConsumGasId = 0;
+ − 676
+ − 677 actualDepthPoint = nextDepthPoint;
+ − 678
+ − 679 if(actualDepthPoint != depth_meter)
+ − 680 {
+ − 681 actualConsumGasId = gasChangeListDepthGas20x2[ptrChangeList++];
+ − 682 nextGasChangeMeter = gasChangeListDepthGas20x2[ptrChangeList++];
+ − 683 }
+ − 684 }
+ − 685 }
+ − 686 else
+ − 687 {
+ − 688 actualConsumGasId = pDiveState->lifeData.actualGas.GasIdInSettings;
+ − 689 nextGasChangeMeter = 0;
+ − 690 }
+ − 691 outputSummary->ppO2AtBottom = (sGChelper_bar(depth_meter) - WATER_VAPOUR_PRESSURE) * pDiveState->diveSettings.gas[actualConsumGasId].oxygen_percentage / 100.0f;
+ − 692
+ − 693
+ − 694 // going down
+ − 695 actualDepthPoint = 0;
+ − 696 nextDepthPoint = depth_meter;
+ − 697
+ − 698 timeThis = ((float)(nextDepthPoint - actualDepthPoint)) / sim_descent_rate_meter_per_min_local;
+ − 699 timeSummary += timeThis;
+ − 700 outputSummary->timeToBottom = (uint16_t)timeThis;
+ − 701
+ − 702 // bottom time
+ − 703 timeThis = ((float)dive_time_minutes) - timeSummary;
+ − 704 timeSummary += timeThis;
+ − 705 outputSummary->timeAtBottom = (uint16_t)timeSummary;
+ − 706
+ − 707
+ − 708 // ascend to first deco stop
+ − 709 actualDepthPoint = depth_meter; // that is where we are
+ − 710 timeThis = 0;
+ − 711
+ − 712 if(!decoInfoInput->output_stop_length_seconds[0]) // NDL dive
+ − 713 {
+ − 714 depthLast = 0;
+ − 715 ptrDecoInfo = 0;
+ − 716 depthDecoNext = 0;
+ − 717 }
+ − 718 else
+ − 719 {
+ − 720 // prepare deco stop list
+ − 721 depthLast = (uint8_t)(stateUsed->diveSettings.last_stop_depth_bar * 10);
+ − 722 depthSecond = (uint8_t)(stateUsed->diveSettings.input_second_to_last_stop_depth_bar * 10);
+ − 723 depthInc = (uint8_t)(stateUsed->diveSettings.input_next_stop_increment_depth_bar * 10);
+ − 724
+ − 725 for(ptrDecoInfo=DECOINFO_STRUCT_MAX_STOPS-1; ptrDecoInfo>0; ptrDecoInfo--)
+ − 726 if(decoInfoInput->output_stop_length_seconds[ptrDecoInfo]) break;
+ − 727
+ − 728 if(ptrDecoInfo == 0)
+ − 729 {
+ − 730 depthDecoNext = depthLast;
+ − 731 }
+ − 732 else
+ − 733 depthDecoNext = depthSecond + (( ptrDecoInfo - 1 )* depthInc);
+ − 734 }
+ − 735
+ − 736 nextDepthPoint = depthDecoNext;
+ − 737 if(actualDepthPoint > nextDepthPoint)
+ − 738 {
+ − 739 // flip signs! It's going up
+ − 740 timeThis = ((float)(actualDepthPoint - nextDepthPoint)) / sim_ascent_rate_meter_per_min_local;
+ − 741 actualDepthPoint = nextDepthPoint; // that is where we are
+ − 742 }
+ − 743 timeSummary += timeThis;
+ − 744 outputSummary->timeToFirstStop = (uint16_t)timeSummary;
+ − 745 outputSummary->depthMeterFirstStop = actualDepthPoint;
+ − 746
901
+ − 747 if(decoInfoInput->output_time_to_surface_seconds)
38
+ − 748 {
901
+ − 749 outputSummary->timeToSurface = outputSummary->timeAtBottom + (decoInfoInput->output_time_to_surface_seconds / 60);
38
+ − 750 }
901
+ − 751 else
+ − 752 {
+ − 753 outputSummary->timeToSurface = outputSummary->timeToFirstStop;
+ − 754 }
38
+ − 755 }
+ − 756
+ − 757
+ − 758 /**
+ − 759 ******************************************************************************
+ − 760 * @brief simulation_gas_consumption
+ − 761 ******************************************************************************
+ − 762 * @note called by openEdit_PlanResult() in tMenuEditPlanner.c
+ − 763 * @note the ascend and descend time is taken from pDiveState->lifeData.ascent_rate_meter_per_min and const float sim_descent_rate_meter_per_min
+ − 764 * @param outputConsumptionList list from 1 to 5 for gas 1 to 5
+ − 765 * @param depth_meter for descend
+ − 766 * @param dive_time_minutes for descend and bottom time
+ − 767 * @param the calculated deco list
+ − 768 * @param gasConsumTravelInput: how many l/min for all but deco stops
+ − 769 * @param gasConsumDecoInput: how many l/min for deco stops only
+ − 770 * @return void
+ − 771 */
+ − 772
+ − 773 void simulation_gas_consumption(uint16_t *outputConsumptionList, uint16_t depth_meter, uint16_t dive_time_minutes, SDecoinfo *decoInfoInput, uint8_t gasConsumTravelInput, uint8_t gasConsumDecoInput, const uint8_t *gasChangeListDepthGas20x2)
+ − 774 {
+ − 775 uint8_t ptrDecoInfo = 0;
+ − 776 uint8_t ptrChangeList = 0;
+ − 777 uint8_t actualConsumGasId = 0;
+ − 778 uint8_t nextGasChangeMeter = 0;
+ − 779 uint16_t actualDepthPoint = 0;
+ − 780 uint16_t nextDepthPoint = 0;
+ − 781 uint16_t inBetweenDepthPoint = 0;
+ − 782 float timeThis = 0;
+ − 783 float consumThis = 0;
+ − 784 float timeSummary = 0;
+ − 785 float outputConsumptionTempFloat[6];
+ − 786 float sim_descent_rate_meter_per_min_local = 10;
+ − 787 float sim_ascent_rate_meter_per_min_local = 10;
+ − 788
+ − 789 SDiveState * pDiveState = &stateSim;
+ − 790
51
+ − 791 uint8_t depthDecoNext = 0;
+ − 792 uint8_t depthLast = 0;
+ − 793 uint8_t depthSecond = 0;
+ − 794 uint8_t depthInc = 0;
38
+ − 795
+ − 796 for(int i = 1; i < 6; i++)
+ − 797 outputConsumptionTempFloat[i] = 0;
+ − 798
+ − 799 if(gasChangeListDepthGas20x2)
+ − 800 {
+ − 801 nextGasChangeMeter = gasChangeListDepthGas20x2[ptrChangeList++];
+ − 802 actualConsumGasId = gasChangeListDepthGas20x2[ptrChangeList++];
+ − 803 nextGasChangeMeter = gasChangeListDepthGas20x2[ptrChangeList++];
+ − 804 }
+ − 805 else
+ − 806 {
+ − 807 actualConsumGasId = pDiveState->lifeData.actualGas.GasIdInSettings;
+ − 808 nextGasChangeMeter = 0;
+ − 809 }
+ − 810
+ − 811 if(pDiveState->diveSettings.deco_type.ub.standard == GF_MODE)
+ − 812 {
+ − 813 sim_descent_rate_meter_per_min_local = sim_descent_rate_meter_per_min; // const float
+ − 814 sim_ascent_rate_meter_per_min_local = pDiveState->diveSettings.ascentRate_meterperminute;
+ − 815 }
+ − 816 else
+ − 817 {
+ − 818 sim_descent_rate_meter_per_min_local = sim_descent_rate_meter_per_min; // const float
+ − 819 sim_ascent_rate_meter_per_min_local = 10;// fix in vpm_calc_deco();
+ − 820 }
+ − 821
+ − 822 // while((nextGasChangeMeter < depth_meter) && (actualDepthPoint < depth_meter))
+ − 823 while(actualDepthPoint < depth_meter)
+ − 824 {
+ − 825 if(nextGasChangeMeter && (nextGasChangeMeter < depth_meter) && (gasChangeListDepthGas20x2[ptrChangeList] != 255)) // list has 255,255 for turn from travel to deco
+ − 826 {
+ − 827 nextDepthPoint = nextGasChangeMeter;
+ − 828 }
+ − 829 else
+ − 830 {
+ − 831 nextDepthPoint = depth_meter;
+ − 832 }
+ − 833
+ − 834 if(actualConsumGasId > 5) // safety first
+ − 835 actualConsumGasId = 0;
+ − 836
+ − 837 timeThis = ((float)(nextDepthPoint - actualDepthPoint)) / sim_descent_rate_meter_per_min_local;
+ − 838 if(actualDepthPoint) // not if on surface
+ − 839 {
+ − 840 consumThis = ((float)gasConsumTravelInput) * sGChelper_bar(actualDepthPoint) * timeThis;
+ − 841 }
+ − 842 consumThis += ((float)gasConsumTravelInput) * sGChelper_bar(nextDepthPoint -actualDepthPoint) * timeThis / 2;
+ − 843 outputConsumptionTempFloat[actualConsumGasId] += consumThis;
+ − 844 timeSummary += timeThis;
+ − 845
+ − 846 actualDepthPoint = nextDepthPoint;
+ − 847
+ − 848 if(actualDepthPoint != depth_meter)
+ − 849 {
+ − 850 actualConsumGasId = gasChangeListDepthGas20x2[ptrChangeList++];
+ − 851 nextGasChangeMeter = gasChangeListDepthGas20x2[ptrChangeList++];
+ − 852 }
+ − 853 }
+ − 854
+ − 855 // bottom Time
+ − 856 timeThis = ((float)dive_time_minutes) - timeSummary;
+ − 857
+ − 858 if(timeThis > 0)
+ − 859 {
+ − 860 consumThis = ((float)gasConsumTravelInput) * sGChelper_bar(depth_meter) * timeThis;
+ − 861 outputConsumptionTempFloat[actualConsumGasId] += consumThis;
+ − 862 }
+ − 863
+ − 864 // ascend with deco stops prepare
+ − 865 if(gasChangeListDepthGas20x2)
+ − 866 {
+ − 867 ptrChangeList++;// gasChangeListDepthGas20x2[ptrChangeList++]; // should be the 255
+ − 868 nextGasChangeMeter = gasChangeListDepthGas20x2[ptrChangeList++];
+ − 869 }
+ − 870 else
+ − 871 {
+ − 872 nextGasChangeMeter = 0;
+ − 873 }
+ − 874
+ − 875
+ − 876 if(!decoInfoInput->output_stop_length_seconds[0]) // NDL dive
+ − 877 {
+ − 878 depthLast = 0;
+ − 879 ptrDecoInfo = 0;
+ − 880 }
+ − 881 else
+ − 882 {
+ − 883 // prepare deco stop list
+ − 884 depthLast = (uint8_t)(stateUsed->diveSettings.last_stop_depth_bar * 10);
+ − 885 depthSecond = (uint8_t)(stateUsed->diveSettings.input_second_to_last_stop_depth_bar * 10);
+ − 886 depthInc = (uint8_t)(stateUsed->diveSettings.input_next_stop_increment_depth_bar * 10);
+ − 887
+ − 888 for(ptrDecoInfo=DECOINFO_STRUCT_MAX_STOPS-1; ptrDecoInfo>0; ptrDecoInfo--)
+ − 889 if(decoInfoInput->output_stop_length_seconds[ptrDecoInfo]) break;
+ − 890 }
+ − 891
+ − 892 actualDepthPoint = depth_meter; // that is where we are
+ − 893
+ − 894 // ascend with deco stops
+ − 895 while(actualDepthPoint)
+ − 896 {
+ − 897 if(ptrDecoInfo == 0)
+ − 898 {
+ − 899 depthDecoNext = depthLast;
+ − 900 }
+ − 901 else
+ − 902 depthDecoNext = depthSecond + (( ptrDecoInfo - 1 )* depthInc);
+ − 903
+ − 904 if(nextGasChangeMeter && (nextGasChangeMeter > depthDecoNext))
+ − 905 {
+ − 906 nextDepthPoint = nextGasChangeMeter;
+ − 907 }
+ − 908 else
+ − 909 {
+ − 910 nextDepthPoint = depthDecoNext;
+ − 911 }
+ − 912
+ − 913 if(actualConsumGasId > 5) // safety first
+ − 914 actualConsumGasId = 0;
+ − 915
+ − 916 if(actualDepthPoint > nextDepthPoint)
+ − 917 {
+ − 918 // flip signs! It's going up
+ − 919 timeThis = ((float)(actualDepthPoint - nextDepthPoint)) / sim_ascent_rate_meter_per_min_local;
+ − 920 inBetweenDepthPoint = nextDepthPoint + ((actualDepthPoint - nextDepthPoint)/2);
+ − 921 consumThis = ((float)gasConsumDecoInput) * sGChelper_bar(inBetweenDepthPoint) * timeThis;
+ − 922 /*
+ − 923 if(nextDepthPoint)
+ − 924 {
+ − 925 consumThis = ((float)gasConsumDecoInput) * sGChelper_bar(nextDepthPoint) * timeThis;
+ − 926 }
+ − 927 else
+ − 928 {
+ − 929 consumThis = 0;
+ − 930 }
+ − 931 consumThis += ((float)gasConsumDecoInput) * sGChelper_bar(actualDepthPoint - nextDepthPoint) * timeThis / 2;
+ − 932 */
+ − 933 outputConsumptionTempFloat[actualConsumGasId] += consumThis;
+ − 934 }
+ − 935
+ − 936 if(nextGasChangeMeter && (nextDepthPoint == nextGasChangeMeter))
+ − 937 {
+ − 938 actualConsumGasId = gasChangeListDepthGas20x2[ptrChangeList++];
+ − 939 nextGasChangeMeter = gasChangeListDepthGas20x2[ptrChangeList++];
+ − 940 }
+ − 941
+ − 942 if(actualConsumGasId > 5) // safety first
+ − 943 actualConsumGasId = 0;
+ − 944
+ − 945 if(nextDepthPoint && (nextDepthPoint == depthDecoNext))
+ − 946 {
+ − 947 if(decoInfoInput->output_stop_length_seconds[ptrDecoInfo])
+ − 948 {
+ − 949 timeThis = ((float)(decoInfoInput->output_stop_length_seconds[ptrDecoInfo])) / 60.0f;
+ − 950 consumThis = ((float)gasConsumDecoInput) * sGChelper_bar(nextDepthPoint) * timeThis;
+ − 951 outputConsumptionTempFloat[actualConsumGasId] += consumThis;
+ − 952 }
+ − 953 if(ptrDecoInfo != 0)
+ − 954 {
+ − 955 ptrDecoInfo--;
+ − 956 }
+ − 957 else
+ − 958 {
+ − 959 depthLast = 0;
+ − 960 }
+ − 961 }
+ − 962 actualDepthPoint = nextDepthPoint;
+ − 963 }
+ − 964
+ − 965 // copy and return
+ − 966 for(int i = 1; i < 6; i++)
+ − 967 outputConsumptionList[i] = (uint16_t)(outputConsumptionTempFloat[i]);
+ − 968 }
+ − 969
+ − 970 /**
+ − 971 ******************************************************************************
+ − 972 * @brief Simulator control during simulated dive
+ − 973 ******************************************************************************
+ − 974 * @note called by user via tHomeDiveMenuControl()
+ − 975 * @param void
+ − 976 * @return void
+ − 977 */
+ − 978
+ − 979
+ − 980 void Sim_Descend (void)
+ − 981 {
+ − 982 stateSimGetPointerWrite()->lifeData.counterSecondsShallowDepth = 0;
+ − 983 if(simulation_get_aim_depth() < 200)
+ − 984 simulation_set_aim_depth(simulation_get_aim_depth() + 1);
+ − 985 }
+ − 986
+ − 987
+ − 988 void Sim_Ascend (void)
+ − 989 {
+ − 990 if(simulation_get_aim_depth() > 0)
+ − 991 simulation_set_aim_depth(simulation_get_aim_depth() - 1);
+ − 992 }
+ − 993
+ − 994
+ − 995 void Sim_Divetime (void)
+ − 996 {
+ − 997 simulation_add_time(5);
+ − 998 }
+ − 999
+ − 1000
+ − 1001 void Sim_Quit (void)
+ − 1002 {
+ − 1003 if(stateSimGetPointer()->lifeData.counterSecondsShallowDepth)
+ − 1004 {
+ − 1005 simulation_exit();
+ − 1006 return;
+ − 1007 }
+ − 1008
+ − 1009 if(simulation_get_aim_depth() > 0)
+ − 1010 {
+ − 1011 simulation_set_aim_depth(0);
+ − 1012 }
+ − 1013 else
+ − 1014 {
+ − 1015 stateSimGetPointerWrite()->lifeData.depth_meter = 0;
+ − 1016 if(stateSimGetPointer()->diveSettings.diveMode == DIVEMODE_Apnea)
+ − 1017 {
+ − 1018 stateSimGetPointerWrite()->lifeData.counterSecondsShallowDepth = 1;
+ − 1019 }
+ − 1020 else
+ − 1021 {
+ − 1022 stateSimGetPointerWrite()->lifeData.counterSecondsShallowDepth = settingsGetPointer()->timeoutDiveReachedZeroDepth - 15;
+ − 1023 }
+ − 1024 }
+ − 1025 }
760
+ − 1026
629
+ − 1027 void Sim_IncreasePPO(uint8_t sensorIdx)
+ − 1028 {
+ − 1029 if((sensorIdx < NUM_OF_SENSORS) && (simSensmVOffset[sensorIdx] + SIM_PPO2_STEP < 100.0) && ((stateUsed->diveSettings.ppo2sensors_deactivated & (1 << sensorIdx)) == 0))
+ − 1030 {
+ − 1031 simSensmVOffset[sensorIdx] += SIM_PPO2_STEP;
+ − 1032 }
+ − 1033 }
+ − 1034 void Sim_DecreasePPO(uint8_t sensorIdx)
+ − 1035 {
+ − 1036 if((sensorIdx < NUM_OF_SENSORS) && (simSensmVOffset[sensorIdx] - SIM_PPO2_STEP >= -100.0))
+ − 1037 {
+ − 1038 simSensmVOffset[sensorIdx] -= SIM_PPO2_STEP;
+ − 1039 }
+ − 1040 }
