Mercurial > public > ostc4
annotate Discovery/Src/simulation.c @ 888:07af9efd7c13 Evo_2_23
Dev bugfix: Consider decogas in planner independen from calculation setting:
Some time ago the selection if a deco gas is used for live deco calculation or not was introduced. The planner did not consider the option as well causing it to ingnore deco gases in the planning what is not intended. To fix this the calculation flag is set at planer simulation start for all deco gases.
Beside this the cursor is now placed in the bottom line at "next" instead of the first menu item.
| author | Ideenmodellierer |
|---|---|
| date | Tue, 03 Sep 2024 20:46:42 +0200 |
| parents | b7d93ff6b3b2 |
| children | 65772ddee88c |
| rev | line source |
|---|---|
| 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
1203255481e4
cleanup: introduce function setAvgDepth
Jan Mulder <jlmulder@xs4all.nl>
parents:
307
diff
changeset
|
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
2bb1db22b5f5
cleanup: random set of cleanups
Jan Mulder <jlmulder@xs4all.nl>
parents:
176
diff
changeset
|
50 static float sim_aim_depth_meter; |
|
760
21949c88da90
Quit simualted dives after the dive time set in the SIM tab.
heinrichsweikamp
parents:
748
diff
changeset
|
51 static float sim_aim_time_minutes; |
|
225
2bb1db22b5f5
cleanup: random set of cleanups
Jan Mulder <jlmulder@xs4all.nl>
parents:
176
diff
changeset
|
52 static _Bool sim_heed_decostops = 1; |
| 38 | 53 |
|
225
2bb1db22b5f5
cleanup: random set of cleanups
Jan Mulder <jlmulder@xs4all.nl>
parents:
176
diff
changeset
|
54 static const float sim_descent_rate_meter_per_min = 20; |
| 38 | 55 |
| 56 | |
| 57 //Private functions | |
|
300
5ca177d2df5d
cleanup: remove commented/unused code, make static
Jan Mulder <jlmulder@xs4all.nl>
parents:
233
diff
changeset
|
58 static float sim_get_ambient_pressure(SDiveState * pDiveState); |
|
225
2bb1db22b5f5
cleanup: random set of cleanups
Jan Mulder <jlmulder@xs4all.nl>
parents:
176
diff
changeset
|
59 static void sim_reduce_deco_time_one_second(SDiveState* pDiveState); |
|
2bb1db22b5f5
cleanup: random set of cleanups
Jan Mulder <jlmulder@xs4all.nl>
parents:
176
diff
changeset
|
60 static void simulation_set_aim_depth(int depth_meter); |
| 38 | 61 |
|
629
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
62 #define NUM_OF_SENSORS (3u) |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
63 #define SIM_PPO2_STEP (1.1f) |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
64 static float simSensmVOffset[NUM_OF_SENSORS]; |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
65 |
| 38 | 66 /** |
| 67 ****************************************************************************** | |
| 68 * @brief sets heed_decostops_while_ascending | |
| 69 ****************************************************************************** | |
| 70 * @param heed_decostops_while_ascending : true -> deco_stops are considered while ascending | |
| 71 * @return void | |
| 72 */ | |
| 73 void simulation_set_heed_decostops(_Bool heed_decostops_while_ascending) | |
| 74 { | |
|
629
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
75 sim_heed_decostops = heed_decostops_while_ascending; |
| 38 | 76 } |
| 77 | |
| 78 /** | |
| 79 ****************************************************************************** | |
| 80 * @brief start of simulation | |
| 81 ****************************************************************************** | |
| 82 * @return void | |
| 83 */ | |
|
760
21949c88da90
Quit simualted dives after the dive time set in the SIM tab.
heinrichsweikamp
parents:
748
diff
changeset
|
84 void simulation_start(int aim_depth, uint16_t aim_time_minutes) |
| 38 | 85 { |
|
629
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
86 copyDiveSettingsToSim(); |
| 38 | 87 copyVpmRepetetiveDataToSim(); |
| 88 //vpm_init(&stateSimGetPointerWrite()->vpm, stateSimGetPointerWrite()->diveSettings.vpm_conservatism, 0, 0); | |
| 89 stateSimGetPointerWrite()->lifeData.counterSecondsShallowDepth = 0; | |
|
629
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
90 stateSimGetPointerWrite()->mode = MODE_DIVE; |
| 38 | 91 if(aim_depth <= 0) |
| 92 aim_depth = 20; | |
|
629
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
93 simulation_set_aim_depth(aim_depth); |
|
760
21949c88da90
Quit simualted dives after the dive time set in the SIM tab.
heinrichsweikamp
parents:
748
diff
changeset
|
94 sim_aim_time_minutes = aim_time_minutes; |
|
629
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
95 timer_init(); |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
96 set_stateUsedToSim(); |
| 38 | 97 stateSim.lifeData.boolResetAverageDepth = 1; |
|
629
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
98 decoLock = DECO_CALC_init_as_is_start_of_dive; |
| 38 | 99 |
| 100 stateSim.lifeData.apnea_total_max_depth_meter = 0; | |
|
629
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
101 memset(simSensmVOffset,0,sizeof(simSensmVOffset)); |
| 38 | 102 } |
| 103 | |
| 104 /** | |
| 105 ****************************************************************************** | |
| 106 * @brief end of simulation | |
| 107 ****************************************************************************** | |
| 108 * | |
| 109 * @return void | |
| 110 */ | |
| 111 void simulation_exit(void) | |
| 112 { | |
| 113 timer_Stopwatch_Stop(); | |
|
805
dd7ce655db26
Adds a simple countdown timer, available as a custom view in surface and dive mode.
heinrichsweikamp
parents:
790
diff
changeset
|
114 |
|
dd7ce655db26
Adds a simple countdown timer, available as a custom view in surface and dive mode.
heinrichsweikamp
parents:
790
diff
changeset
|
115 disableTimer(); |
|
dd7ce655db26
Adds a simple countdown timer, available as a custom view in surface and dive mode.
heinrichsweikamp
parents:
790
diff
changeset
|
116 |
| 38 | 117 set_stateUsedToReal(); |
| 118 } | |
| 119 | |
| 120 /** | |
| 121 ****************************************************************************** | |
| 122 * @brief simulates change of Lifedata (saturation, depth change, etc.) within one second | |
| 123 ****************************************************************************** | |
| 124 * | |
| 125 * @param checkOncePerSecond : true -> simulation in real time (function is evaluated only once per second) | |
| 126 * and copy of parts of LifeData from SmallCPU with each call from HAL_TIM_PeriodElapsedCallback() | |
| 127 * : false -> fast simulation (many simulation cycles per second are possible) | |
| 128 * @return void | |
| 129 */ | |
| 130 void simulation_UpdateLifeData( _Bool checkOncePerSecond) | |
| 131 { | |
| 132 SDiveState * pDiveState = &stateSim; | |
| 813 | 133 const SDiveState * pRealState = stateRealGetPointer(); |
|
629
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
134 SSettings *pSettings; |
| 38 | 135 |
| 136 static int last_second = -1; | |
| 137 static _Bool two_second = 0; | |
| 138 static float lastPressure_bar = 0; | |
| 139 | |
|
790
3b5f9557c053
Fix bug introduced in 04b98a2, causing the deco planner to not show deco stops.
heinrichsweikamp
parents:
760
diff
changeset
|
140 if (sim_aim_time_minutes && sim_aim_time_minutes * 60 <= pDiveState->lifeData.dive_time_seconds) { |
|
760
21949c88da90
Quit simualted dives after the dive time set in the SIM tab.
heinrichsweikamp
parents:
748
diff
changeset
|
141 simulation_set_aim_depth(0); |
|
21949c88da90
Quit simualted dives after the dive time set in the SIM tab.
heinrichsweikamp
parents:
748
diff
changeset
|
142 } |
|
21949c88da90
Quit simualted dives after the dive time set in the SIM tab.
heinrichsweikamp
parents:
748
diff
changeset
|
143 |
| 699 | 144 float localCalibCoeff[3] = { 0.0, 0.0, 0.0 }; |
|
629
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
145 uint8_t index, index2; |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
146 |
| 38 | 147 if(checkOncePerSecond) |
| 148 { | |
|
629
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
149 |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
150 pSettings = settingsGetPointer(); |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
151 for(index = 0; index < 3; index++) |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
152 { |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
153 localCalibCoeff[index] = pSettings->ppo2sensors_calibCoeff[index]; |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
154 if(localCalibCoeff[index] < 0.01) |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
155 { |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
156 for(index2 = 0; index2 < 3; index2++) /* no valid coeff => check other entries */ |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
157 { |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
158 if(pSettings->ppo2sensors_calibCoeff[index2] > 0.01) |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
159 { |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
160 localCalibCoeff[index] = pSettings->ppo2sensors_calibCoeff[index2]; |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
161 break; |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
162 } |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
163 if(index2 == 3) /* no coeff at all => use default */ |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
164 { |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
165 localCalibCoeff[index] = 0.02; |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
166 } |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
167 } |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
168 } |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
169 } |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
170 |
| 813 | 171 pDiveState->lifeData.temperature_celsius = pRealState->lifeData.temperature_celsius; |
| 172 pDiveState->lifeData.battery_charge = pRealState->lifeData.battery_charge; | |
| 173 pDiveState->lifeData.compass_heading = pRealState->lifeData.compass_heading; | |
| 174 pDiveState->lifeData.compass_roll = pRealState->lifeData.compass_roll; | |
| 175 pDiveState->lifeData.compass_pitch = pRealState->lifeData.compass_pitch; | |
| 176 | |
| 177 for(index = 0; index < 3; index++) | |
| 178 { | |
| 179 memcpy(&pDiveState->lifeData.extIf_sensor_data[index], &pRealState->lifeData.extIf_sensor_data[index], 32); | |
| 180 } | |
|
548
e7e44986684a
Update roll and pitch value in simulation mode:
Ideenmodellierer
parents:
450
diff
changeset
|
181 |
|
446
f1257a32f2d4
Introduced configuration header for variant managment:
ideenmodellierer
parents:
308
diff
changeset
|
182 #ifdef ENABLE_BOTTLE_SENSOR |
| 813 | 183 pDiveState->lifeData.bottle_bar[pDiveState->lifeData.actualGas.GasIdInSettings] = pRealState->lifeData.bottle_bar[pRealState->lifeData.actualGas.GasIdInSettings]; |
| 184 pDiveState->lifeData.bottle_bar_age_MilliSeconds[pDiveState->lifeData.actualGas.GasIdInSettings] = pRealState->lifeData.bottle_bar_age_MilliSeconds[pRealState->lifeData.actualGas.GasIdInSettings]; | |
|
446
f1257a32f2d4
Introduced configuration header for variant managment:
ideenmodellierer
parents:
308
diff
changeset
|
185 #endif |
| 38 | 186 int now = current_second(); |
| 187 if( last_second == now) | |
| 188 return; | |
| 189 last_second = now; | |
| 190 | |
| 191 if(!two_second) | |
| 192 two_second = 1; | |
| 193 else | |
| 194 { | |
| 195 two_second = 0; | |
| 196 if(lastPressure_bar >= 0) | |
| 197 { | |
| 198 //2 seconds * 30 == 1 minute, bar * 10 = meter | |
| 199 pDiveState->lifeData.ascent_rate_meter_per_min = (lastPressure_bar - pDiveState->lifeData.pressure_ambient_bar) * 30 * 10; | |
| 200 } | |
| 201 lastPressure_bar = pDiveState->lifeData.pressure_ambient_bar; | |
| 202 } | |
| 203 } | |
| 204 else if(pDiveState->lifeData.depth_meter <= (float)(decom_get_actual_deco_stop(pDiveState) + 0.001)) | |
| 205 sim_reduce_deco_time_one_second(pDiveState); | |
| 206 | |
| 207 pDiveState->lifeData.dive_time_seconds += 1; | |
|
300
5ca177d2df5d
cleanup: remove commented/unused code, make static
Jan Mulder <jlmulder@xs4all.nl>
parents:
233
diff
changeset
|
208 pDiveState->lifeData.pressure_ambient_bar = sim_get_ambient_pressure(pDiveState); |
| 38 | 209 |
| 813 | 210 pDiveState->lifeData.sensorVoltage_mV[0] = pRealState->lifeData.sensorVoltage_mV[0] + simSensmVOffset[0]; |
|
629
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
211 if(pDiveState->lifeData.sensorVoltage_mV[0] < 0.0) { pDiveState->lifeData.sensorVoltage_mV[0] = 0.0; } |
| 813 | 212 pDiveState->lifeData.sensorVoltage_mV[1] = pRealState->lifeData.sensorVoltage_mV[1] + simSensmVOffset[1]; |
|
629
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
213 if(pDiveState->lifeData.sensorVoltage_mV[1] < 0.0) { pDiveState->lifeData.sensorVoltage_mV[1] = 0.0; } |
| 813 | 214 pDiveState->lifeData.sensorVoltage_mV[2] = pRealState->lifeData.sensorVoltage_mV[2] + simSensmVOffset[2]; |
|
629
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
215 if(pDiveState->lifeData.sensorVoltage_mV[2] < 0.0) { pDiveState->lifeData.sensorVoltage_mV[2] = 0.0; } |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
216 |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
217 pDiveState->lifeData.ppO2Sensor_bar[0] = pDiveState->lifeData.sensorVoltage_mV[0] * localCalibCoeff[0] * pDiveState->lifeData.pressure_ambient_bar; |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
218 pDiveState->lifeData.ppO2Sensor_bar[1] = pDiveState->lifeData.sensorVoltage_mV[1] * localCalibCoeff[1] * pDiveState->lifeData.pressure_ambient_bar; |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
219 pDiveState->lifeData.ppO2Sensor_bar[2] = pDiveState->lifeData.sensorVoltage_mV[2] * localCalibCoeff[2] * pDiveState->lifeData.pressure_ambient_bar; |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
220 |
| 813 | 221 pDiveState->lifeData.CO2_data.CO2_ppm = pRealState->lifeData.CO2_data.CO2_ppm; |
|
629
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
222 |
| 38 | 223 if(is_ambient_pressure_close_to_surface(&pDiveState->lifeData)) // new hw 170214 |
| 224 { | |
| 225 if(!(stateSimGetPointer()->lifeData.counterSecondsShallowDepth)) | |
| 226 { | |
| 227 if(pDiveState->diveSettings.diveMode != DIVEMODE_Apnea) | |
| 228 pDiveState->lifeData.counterSecondsShallowDepth = settingsGetPointer()->timeoutDiveReachedZeroDepth - 15; | |
| 229 else | |
| 230 { | |
| 231 pDiveState->lifeData.apnea_last_dive_time_seconds = pDiveState->lifeData.dive_time_seconds; | |
| 232 if(pDiveState->lifeData.apnea_last_dive_time_seconds > pDiveState->lifeData.dive_time_seconds_without_surface_time) | |
| 233 pDiveState->lifeData.apnea_last_dive_time_seconds = pDiveState->lifeData.dive_time_seconds_without_surface_time; | |
| 234 pDiveState->lifeData.apnea_last_max_depth_meter = pDiveState->lifeData.max_depth_meter; | |
| 235 pDiveState->lifeData.counterSecondsShallowDepth = 1; | |
| 236 } | |
| 237 } | |
| 238 } | |
| 239 else | |
| 240 { | |
| 241 pDiveState->lifeData.counterSecondsShallowDepth = 0; | |
| 242 } | |
| 243 | |
|
304
43b44f8d4fb0
bugfix, simulator: fix the 1 sec difference between stopwatch and divetime
Jan Mulder <jlmulder@xs4all.nl>
parents:
300
diff
changeset
|
244 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>
parents:
300
diff
changeset
|
245 { |
|
43b44f8d4fb0
bugfix, simulator: fix the 1 sec difference between stopwatch and divetime
Jan Mulder <jlmulder@xs4all.nl>
parents:
300
diff
changeset
|
246 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>
parents:
300
diff
changeset
|
247 } |
|
43b44f8d4fb0
bugfix, simulator: fix the 1 sec difference between stopwatch and divetime
Jan Mulder <jlmulder@xs4all.nl>
parents:
300
diff
changeset
|
248 |
| 38 | 249 pDiveState->lifeData.depth_meter = (pDiveState->lifeData.pressure_ambient_bar - pDiveState->lifeData.pressure_surface_bar) * 10.0f; |
| 250 if(pDiveState->lifeData.max_depth_meter < pDiveState->lifeData.depth_meter) | |
| 251 pDiveState->lifeData.max_depth_meter = pDiveState->lifeData.depth_meter; | |
| 252 | |
| 253 /* apnoe specials | |
| 254 */ | |
| 255 if(pDiveState->diveSettings.diveMode == DIVEMODE_Apnea) | |
| 256 { | |
| 257 if(pDiveState->lifeData.max_depth_meter > pDiveState->lifeData.apnea_total_max_depth_meter) | |
| 258 pDiveState->lifeData.apnea_total_max_depth_meter = pDiveState->lifeData.max_depth_meter; | |
| 259 | |
| 260 if(pDiveState->lifeData.counterSecondsShallowDepth) | |
| 261 { | |
| 262 pDiveState->lifeData.dive_time_seconds = 0; | |
| 263 pDiveState->lifeData.max_depth_meter = 0; | |
| 264 pDiveState->lifeData.boolResetAverageDepth = 1; | |
| 265 } | |
| 266 } | |
| 267 | |
|
308
1203255481e4
cleanup: introduce function setAvgDepth
Jan Mulder <jlmulder@xs4all.nl>
parents:
307
diff
changeset
|
268 setAvgDepth(pDiveState); |
| 38 | 269 |
| 270 /* Exposure Tissues | |
| 271 */ | |
| 272 decom_tissues_exposure(1, &pDiveState->lifeData); | |
| 273 decom_oxygen_calculate_cns_exposure(1, &pDiveState->lifeData.actualGas, pDiveState->lifeData.pressure_ambient_bar, &pDiveState->lifeData.cns); | |
|
233
9f0efc4df01e
cleanup, bugfix: do not exit simulator on 5h dive time
Jan Mulder <jlmulder@xs4all.nl>
parents:
225
diff
changeset
|
274 |
| 38 | 275 if(stateSimGetPointer()->lifeData.counterSecondsShallowDepth) |
| 276 { | |
| 277 stateSimGetPointerWrite()->lifeData.counterSecondsShallowDepth += 1; | |
| 278 if(stateSimGetPointer()->lifeData.counterSecondsShallowDepth >= settingsGetPointer()->timeoutDiveReachedZeroDepth) | |
| 279 simulation_exit(); | |
| 280 } | |
| 281 vpm_crush(pDiveState); | |
| 282 } | |
| 283 | |
| 284 /** | |
| 285 ****************************************************************************** | |
| 286 * @brief adds extra time for fast simulation | |
| 287 ****************************************************************************** | |
| 288 *@param minutes | |
| 289 * @return float : new pressure | |
| 290 */ | |
|
225
2bb1db22b5f5
cleanup: random set of cleanups
Jan Mulder <jlmulder@xs4all.nl>
parents:
176
diff
changeset
|
291 static void simulation_add_time(int minutes) |
| 38 | 292 { |
| 293 for(int i = 0; i < 60 * minutes; i++) | |
| 294 { | |
| 295 simulation_UpdateLifeData(0); | |
| 296 updateMiniLiveLogbook(0); | |
| 297 timer_UpdateSecond(0); | |
| 298 } | |
| 299 } | |
| 300 | |
| 301 /** | |
| 302 ****************************************************************************** | |
| 303 * @brief get aim_depth | |
| 304 ****************************************************************************** | |
| 305 * @return sim_aim_depth_meter; | |
| 306 */ | |
| 307 | |
| 308 uint16_t simulation_get_aim_depth(void) | |
| 309 { | |
| 310 return (uint16_t)sim_aim_depth_meter; | |
| 311 } | |
| 312 | |
| 313 /** | |
| 314 ****************************************************************************** | |
| 315 * @brief get heed decostops | |
| 316 ****************************************************************************** | |
| 317 * @return true if ascend follows decostops; | |
| 318 */ | |
| 319 | |
| 320 _Bool simulation_get_heed_decostops(void) | |
| 321 { | |
|
225
2bb1db22b5f5
cleanup: random set of cleanups
Jan Mulder <jlmulder@xs4all.nl>
parents:
176
diff
changeset
|
322 return sim_heed_decostops; |
| 38 | 323 } |
| 324 | |
| 325 /** | |
| 326 ****************************************************************************** | |
| 327 * @brief sets aim_depth | |
| 328 ****************************************************************************** | |
| 329 *@param depth_meter | |
| 330 * @return float : new pressure | |
| 331 */ | |
|
225
2bb1db22b5f5
cleanup: random set of cleanups
Jan Mulder <jlmulder@xs4all.nl>
parents:
176
diff
changeset
|
332 static void simulation_set_aim_depth(int depth_meter) |
| 38 | 333 { |
| 334 sim_aim_depth_meter = depth_meter; | |
| 335 } | |
| 336 | |
| 337 /** | |
| 338 ****************************************************************************** | |
|
300
5ca177d2df5d
cleanup: remove commented/unused code, make static
Jan Mulder <jlmulder@xs4all.nl>
parents:
233
diff
changeset
|
339 * @brief simulates ambient pressure depending on aim depth |
| 38 | 340 ****************************************************************************** |
| 341 * @note if aim_depth != actual depth, the depth change within one second | |
| 342 * (depending on descent or ascent) rate is calculated | |
| 343 * @param SDiveState* pDiveState: | |
|
300
5ca177d2df5d
cleanup: remove commented/unused code, make static
Jan Mulder <jlmulder@xs4all.nl>
parents:
233
diff
changeset
|
344 * @return float : new ambient pressure |
| 38 | 345 */ |
|
300
5ca177d2df5d
cleanup: remove commented/unused code, make static
Jan Mulder <jlmulder@xs4all.nl>
parents:
233
diff
changeset
|
346 static float sim_get_ambient_pressure(SDiveState * pDiveState) |
| 38 | 347 { |
| 348 //Calc next depth | |
| 349 uint8_t actual_deco_stop = decom_get_actual_deco_stop(pDiveState); | |
| 350 float depth_meter = pDiveState->lifeData.depth_meter; | |
| 351 float surface_pressure_bar = pDiveState->lifeData.pressure_surface_bar; | |
| 352 if(depth_meter < sim_aim_depth_meter) | |
| 353 { | |
| 354 depth_meter = depth_meter + sim_descent_rate_meter_per_min / 60; | |
| 355 if(depth_meter > sim_aim_depth_meter) | |
| 356 depth_meter = sim_aim_depth_meter; | |
| 357 } | |
| 358 else if(depth_meter > sim_aim_depth_meter) | |
| 359 { | |
| 360 | |
| 361 depth_meter -= pDiveState->diveSettings.ascentRate_meterperminute / 60; | |
| 362 if(depth_meter < sim_aim_depth_meter) | |
| 363 depth_meter = sim_aim_depth_meter; | |
| 364 | |
|
225
2bb1db22b5f5
cleanup: random set of cleanups
Jan Mulder <jlmulder@xs4all.nl>
parents:
176
diff
changeset
|
365 if(sim_heed_decostops && depth_meter < actual_deco_stop) |
| 38 | 366 { |
| 367 if(actual_deco_stop < (depth_meter + pDiveState->diveSettings.ascentRate_meterperminute / 60)) | |
| 368 depth_meter = actual_deco_stop; | |
| 369 else | |
| 370 depth_meter += pDiveState->diveSettings.ascentRate_meterperminute / 60; | |
| 371 } | |
| 372 | |
| 373 } | |
| 374 | |
| 375 return surface_pressure_bar + depth_meter / 10; | |
| 376 } | |
| 377 | |
| 378 | |
| 379 /** | |
| 380 ****************************************************************************** | |
| 381 * @brief Reduces deco time of deepest stop by one second | |
| 382 ****************************************************************************** | |
| 383 * @note called during fast simulation | |
| 384 * @param SDiveState* pDiveState: | |
| 385 * @return void | |
| 386 */ | |
|
300
5ca177d2df5d
cleanup: remove commented/unused code, make static
Jan Mulder <jlmulder@xs4all.nl>
parents:
233
diff
changeset
|
387 static void sim_reduce_deco_time_one_second(SDiveState* pDiveState) |
| 38 | 388 { |
| 389 SDecoinfo* pDecoinfo; | |
| 390 if(pDiveState->diveSettings.deco_type.ub.standard == GF_MODE) | |
| 391 pDecoinfo = &pDiveState->decolistBuehlmann; | |
| 392 else | |
| 393 pDecoinfo = &pDiveState->decolistVPM; | |
| 394 | |
| 395 //Reduce deco time of deepest stop by one second | |
| 396 for(int i = DECOINFO_STRUCT_MAX_STOPS -1 ;i >= 0; i--) | |
| 397 { | |
| 398 if(pDecoinfo->output_stop_length_seconds[i] > 0) | |
| 399 { | |
| 400 pDecoinfo->output_stop_length_seconds[i]--; | |
| 401 break; | |
| 402 } | |
| 403 } | |
| 404 } | |
| 405 | |
| 406 SDecoinfo* simulation_decoplaner(uint16_t depth_meter, uint16_t intervall_time_minutes, uint16_t dive_time_minutes, uint8_t *gasChangeListDepthGas20x2) | |
| 407 { | |
| 408 uint8_t ptrGasChangeList = 0; // new hw 160704 | |
|
888
07af9efd7c13
Dev bugfix: Consider decogas in planner independen from calculation setting:
Ideenmodellierer
parents:
830
diff
changeset
|
409 uint8_t index = 0; |
|
678
05cdd367dbd0
Bugfix: deco planner did not initialize properly
Jan Mulder <jan@jlmulder.nl>
parents:
629
diff
changeset
|
410 for (int i = 0; i < 40; i++) |
|
05cdd367dbd0
Bugfix: deco planner did not initialize properly
Jan Mulder <jan@jlmulder.nl>
parents:
629
diff
changeset
|
411 gasChangeListDepthGas20x2[i] = 0; |
|
05cdd367dbd0
Bugfix: deco planner did not initialize properly
Jan Mulder <jan@jlmulder.nl>
parents:
629
diff
changeset
|
412 |
| 38 | 413 SDiveState * pDiveState = &stateSim; |
| 414 copyDiveSettingsToSim(); | |
|
888
07af9efd7c13
Dev bugfix: Consider decogas in planner independen from calculation setting:
Ideenmodellierer
parents:
830
diff
changeset
|
415 |
|
07af9efd7c13
Dev bugfix: Consider decogas in planner independen from calculation setting:
Ideenmodellierer
parents:
830
diff
changeset
|
416 /* activate deco calculation for all deco gases */ |
|
07af9efd7c13
Dev bugfix: Consider decogas in planner independen from calculation setting:
Ideenmodellierer
parents:
830
diff
changeset
|
417 for(index = 0; index < 1 + (2*NUM_GASES); index++) |
|
07af9efd7c13
Dev bugfix: Consider decogas in planner independen from calculation setting:
Ideenmodellierer
parents:
830
diff
changeset
|
418 { |
|
07af9efd7c13
Dev bugfix: Consider decogas in planner independen from calculation setting:
Ideenmodellierer
parents:
830
diff
changeset
|
419 if(pDiveState->diveSettings.gas[index].note.ub.deco) |
|
07af9efd7c13
Dev bugfix: Consider decogas in planner independen from calculation setting:
Ideenmodellierer
parents:
830
diff
changeset
|
420 { |
|
07af9efd7c13
Dev bugfix: Consider decogas in planner independen from calculation setting:
Ideenmodellierer
parents:
830
diff
changeset
|
421 pDiveState->diveSettings.gas[index].note.ub.decocalc = 1; |
|
07af9efd7c13
Dev bugfix: Consider decogas in planner independen from calculation setting:
Ideenmodellierer
parents:
830
diff
changeset
|
422 } |
|
07af9efd7c13
Dev bugfix: Consider decogas in planner independen from calculation setting:
Ideenmodellierer
parents:
830
diff
changeset
|
423 } |
|
07af9efd7c13
Dev bugfix: Consider decogas in planner independen from calculation setting:
Ideenmodellierer
parents:
830
diff
changeset
|
424 |
| 38 | 425 vpm_init(&pDiveState->vpm, pDiveState->diveSettings.vpm_conservatism, 0, 0); |
| 426 //buehlmann_init(); | |
| 427 //timer_init(); | |
| 428 memset(&pDiveState->events,0, sizeof(SEvents)); | |
| 429 pDiveState->diveSettings.internal__pressure_first_stop_ambient_bar_as_upper_limit_for_gf_low_otherwise_zero = 0; | |
| 430 //Calc desaturation during intervall (with Air) | |
| 431 setActualGasAir(&pDiveState->lifeData); | |
| 432 if(intervall_time_minutes > 0) | |
| 433 { | |
| 434 decom_tissues_exposure(intervall_time_minutes * 60, &pDiveState->lifeData); | |
| 435 decom_oxygen_calculate_cns_degrade(&pDiveState->lifeData.cns, intervall_time_minutes * 60); | |
| 436 } | |
| 437 | |
| 438 //Switch to first Gas | |
| 439 setActualGasFirst(&pDiveState->lifeData); | |
| 440 | |
| 441 // new hw 160704 | |
| 442 if(gasChangeListDepthGas20x2) | |
| 443 { | |
| 444 gasChangeListDepthGas20x2[ptrGasChangeList++] = 0; | |
| 445 gasChangeListDepthGas20x2[ptrGasChangeList++] = pDiveState->lifeData.actualGas.GasIdInSettings; | |
| 446 gasChangeListDepthGas20x2[0] =0; // depth zero | |
| 447 } | |
| 448 | |
| 449 //Going down / descent | |
| 450 simulation_set_aim_depth(depth_meter); | |
|
790
3b5f9557c053
Fix bug introduced in 04b98a2, causing the deco planner to not show deco stops.
heinrichsweikamp
parents:
760
diff
changeset
|
451 sim_aim_time_minutes = 0; |
| 38 | 452 for(int i = 0; i < 60 * dive_time_minutes; i++) |
| 453 { | |
| 454 simulation_UpdateLifeData(0); | |
| 455 check_warning2(pDiveState); | |
| 456 if(pDiveState->warnings.betterGas) | |
| 457 { | |
| 458 setActualGas(&pDiveState->lifeData,actualBetterGasId(),pDiveState->lifeData.actualGas.setPoint_cbar); | |
| 459 if(gasChangeListDepthGas20x2 && (pDiveState->diveSettings.diveMode == DIVEMODE_OC)) | |
| 460 { | |
| 461 gasChangeListDepthGas20x2[ptrGasChangeList++] = pDiveState->lifeData.depth_meter; | |
| 462 gasChangeListDepthGas20x2[ptrGasChangeList++] = actualBetterGasId(); | |
| 463 } | |
| 464 } | |
| 465 } | |
| 466 | |
| 467 decom_CreateGasChangeList(&pDiveState->diveSettings, &pDiveState->lifeData); // was there before and needed for buehlmann_calc_deco and vpm_calc | |
| 468 | |
| 469 // new hw 160704 | |
| 470 if(gasChangeListDepthGas20x2 && (pDiveState->diveSettings.diveMode == DIVEMODE_OC)) | |
| 471 { | |
| 472 // change direction from better gas to deco gas | |
| 473 gasChangeListDepthGas20x2[ptrGasChangeList++] = 255; | |
| 474 gasChangeListDepthGas20x2[ptrGasChangeList++] = 255; | |
| 475 | |
| 476 // ascend (deco) gases | |
| 477 for(int i=1; i<=5;i++) | |
| 478 { | |
|
830
b7d93ff6b3b2
Added selection if an active gas shall be used for deco calculation or not:
Ideenmodellierer
parents:
813
diff
changeset
|
479 if((pDiveState->diveSettings.decogaslist[i].change_during_ascent_depth_meter_otherwise_zero == 0) |
|
b7d93ff6b3b2
Added selection if an active gas shall be used for deco calculation or not:
Ideenmodellierer
parents:
813
diff
changeset
|
480 || (pDiveState->diveSettings.gas[pDiveState->diveSettings.decogaslist[i].GasIdInSettings].note.ub.decocalc == 0)) |
| 38 | 481 break; |
| 482 gasChangeListDepthGas20x2[ptrGasChangeList++] = pDiveState->diveSettings.decogaslist[i].change_during_ascent_depth_meter_otherwise_zero; | |
| 483 gasChangeListDepthGas20x2[ptrGasChangeList++] = pDiveState->diveSettings.decogaslist[i].GasIdInSettings; | |
| 484 } | |
| 485 gasChangeListDepthGas20x2[0] = 0; | |
| 486 } | |
| 487 | |
| 488 // deco and ascend calc | |
| 489 if(pDiveState->diveSettings.deco_type.ub.standard == GF_MODE) | |
| 490 { | |
| 491 /* this does modify the cns now 11.06.2015 */ | |
| 492 buehlmann_calc_deco(&pDiveState->lifeData,&pDiveState->diveSettings,&pDiveState->decolistBuehlmann); | |
| 493 pDiveState->lifeData.cns += buehlmann_get_gCNS(); | |
| 494 return &pDiveState->decolistBuehlmann; | |
| 495 } | |
| 496 else | |
| 497 { | |
| 498 /* this does modify the cns now 11.06.2015 */ | |
| 499 vpm_calc(&pDiveState->lifeData,&pDiveState->diveSettings,&pDiveState->vpm,&pDiveState->decolistVPM, DECOSTOPS); | |
| 500 pDiveState->lifeData.cns += vpm_get_CNS(); | |
| 501 return &pDiveState->decolistVPM; | |
| 502 } | |
| 503 } | |
| 504 | |
|
225
2bb1db22b5f5
cleanup: random set of cleanups
Jan Mulder <jlmulder@xs4all.nl>
parents:
176
diff
changeset
|
505 static float sGChelper_bar(uint16_t depth_meter) |
| 38 | 506 { |
| 507 SDiveState * pDiveState = &stateSim; | |
| 508 float ambient, surface, density, meter; | |
| 509 | |
| 510 surface = pDiveState->lifeData.pressure_surface_bar; | |
| 511 | |
| 512 if(!depth_meter) | |
| 513 return surface; | |
| 514 | |
| 515 density = ((float)( 100 + settingsGetPointer()->salinity)) / 100.0f; | |
| 516 meter = depth_meter * (0.09807f * density); | |
| 517 ambient = (meter + surface); | |
| 518 | |
| 519 return ambient; | |
| 520 } | |
| 521 | |
| 522 | |
| 523 /** | |
| 524 ****************************************************************************** | |
| 525 * @brief simulation_helper_change_points | |
| 526 ****************************************************************************** | |
| 527 * @param | |
| 528 * @return void | |
| 529 */ | |
| 530 void simulation_helper_change_points(SSimDataSummary *outputSummary, uint16_t depth_meter, uint16_t dive_time_minutes, SDecoinfo *decoInfoInput, const uint8_t *gasChangeListDepthGas20x2) | |
| 531 { | |
| 532 uint8_t ptrDecoInfo = 0; | |
| 533 uint16_t actualDepthPoint = 0; | |
| 534 uint16_t nextDepthPoint = 0; | |
| 535 uint8_t actualConsumGasId = 0; | |
| 536 uint8_t nextGasChangeMeter = 0; | |
| 537 uint8_t ptrChangeList = 0; | |
| 538 | |
| 539 float timeThis = 0; | |
| 540 float timeSummary = 0; | |
| 541 float sim_descent_rate_meter_per_min_local = 10; | |
| 542 float sim_ascent_rate_meter_per_min_local = 10; | |
| 543 | |
| 544 SDiveState * pDiveState = &stateSim; | |
| 545 | |
| 546 uint8_t depthDecoNext, depthLast, depthSecond, depthInc; | |
| 547 | |
| 548 if(pDiveState->diveSettings.deco_type.ub.standard == GF_MODE) | |
| 549 { | |
| 550 sim_descent_rate_meter_per_min_local = sim_descent_rate_meter_per_min; // const float | |
| 551 sim_ascent_rate_meter_per_min_local = pDiveState->diveSettings.ascentRate_meterperminute; | |
| 552 } | |
| 553 else | |
| 554 { | |
| 555 sim_descent_rate_meter_per_min_local = sim_descent_rate_meter_per_min; // const float | |
| 556 sim_ascent_rate_meter_per_min_local = 10;// fix in vpm_calc_deco(); | |
| 557 } | |
| 558 | |
| 559 outputSummary->descentRateMeterPerMinute = sim_descent_rate_meter_per_min_local; | |
| 560 outputSummary->ascentRateMeterPerMinute = sim_ascent_rate_meter_per_min_local; | |
| 561 | |
| 562 // bottom gas ppO2 | |
| 563 if(gasChangeListDepthGas20x2) | |
| 564 { | |
| 565 nextGasChangeMeter = gasChangeListDepthGas20x2[ptrChangeList++]; | |
| 566 actualConsumGasId = gasChangeListDepthGas20x2[ptrChangeList++]; | |
| 567 nextGasChangeMeter = gasChangeListDepthGas20x2[ptrChangeList++]; | |
| 568 | |
| 569 while(actualDepthPoint < depth_meter) | |
| 570 { | |
| 571 if(nextGasChangeMeter && (nextGasChangeMeter < depth_meter) && (gasChangeListDepthGas20x2[ptrChangeList] != 255)) // list has 255,255 for turn from travel to deco | |
| 572 { | |
| 573 nextDepthPoint = nextGasChangeMeter; | |
| 574 } | |
| 575 else | |
| 576 { | |
| 577 nextDepthPoint = depth_meter; | |
| 578 } | |
| 579 | |
| 580 if(actualConsumGasId > 5) // safety first | |
| 581 actualConsumGasId = 0; | |
| 582 | |
| 583 actualDepthPoint = nextDepthPoint; | |
| 584 | |
| 585 if(actualDepthPoint != depth_meter) | |
| 586 { | |
| 587 actualConsumGasId = gasChangeListDepthGas20x2[ptrChangeList++]; | |
| 588 nextGasChangeMeter = gasChangeListDepthGas20x2[ptrChangeList++]; | |
| 589 } | |
| 590 } | |
| 591 } | |
| 592 else | |
| 593 { | |
| 594 actualConsumGasId = pDiveState->lifeData.actualGas.GasIdInSettings; | |
| 595 nextGasChangeMeter = 0; | |
| 596 } | |
| 597 outputSummary->ppO2AtBottom = (sGChelper_bar(depth_meter) - WATER_VAPOUR_PRESSURE) * pDiveState->diveSettings.gas[actualConsumGasId].oxygen_percentage / 100.0f; | |
| 598 | |
| 599 | |
| 600 // going down | |
| 601 actualDepthPoint = 0; | |
| 602 nextDepthPoint = depth_meter; | |
| 603 | |
| 604 timeThis = ((float)(nextDepthPoint - actualDepthPoint)) / sim_descent_rate_meter_per_min_local; | |
| 605 timeSummary += timeThis; | |
| 606 outputSummary->timeToBottom = (uint16_t)timeThis; | |
| 607 | |
| 608 // bottom time | |
| 609 timeThis = ((float)dive_time_minutes) - timeSummary; | |
| 610 timeSummary += timeThis; | |
| 611 outputSummary->timeAtBottom = (uint16_t)timeSummary; | |
| 612 | |
| 613 | |
| 614 // ascend to first deco stop | |
| 615 actualDepthPoint = depth_meter; // that is where we are | |
| 616 timeThis = 0; | |
| 617 | |
| 618 if(!decoInfoInput->output_stop_length_seconds[0]) // NDL dive | |
| 619 { | |
| 620 depthLast = 0; | |
| 621 ptrDecoInfo = 0; | |
| 622 depthDecoNext = 0; | |
| 623 } | |
| 624 else | |
| 625 { | |
| 626 // prepare deco stop list | |
| 627 depthLast = (uint8_t)(stateUsed->diveSettings.last_stop_depth_bar * 10); | |
| 628 depthSecond = (uint8_t)(stateUsed->diveSettings.input_second_to_last_stop_depth_bar * 10); | |
| 629 depthInc = (uint8_t)(stateUsed->diveSettings.input_next_stop_increment_depth_bar * 10); | |
| 630 | |
| 631 for(ptrDecoInfo=DECOINFO_STRUCT_MAX_STOPS-1; ptrDecoInfo>0; ptrDecoInfo--) | |
| 632 if(decoInfoInput->output_stop_length_seconds[ptrDecoInfo]) break; | |
| 633 | |
| 634 if(ptrDecoInfo == 0) | |
| 635 { | |
| 636 depthDecoNext = depthLast; | |
| 637 } | |
| 638 else | |
| 639 depthDecoNext = depthSecond + (( ptrDecoInfo - 1 )* depthInc); | |
| 640 } | |
| 641 | |
| 642 nextDepthPoint = depthDecoNext; | |
| 643 if(actualDepthPoint > nextDepthPoint) | |
| 644 { | |
| 645 // flip signs! It's going up | |
| 646 timeThis = ((float)(actualDepthPoint - nextDepthPoint)) / sim_ascent_rate_meter_per_min_local; | |
| 647 actualDepthPoint = nextDepthPoint; // that is where we are | |
| 648 } | |
| 649 timeSummary += timeThis; | |
| 650 outputSummary->timeToFirstStop = (uint16_t)timeSummary; | |
| 651 outputSummary->depthMeterFirstStop = actualDepthPoint; | |
| 652 | |
| 653 //ascent | |
| 654 nextDepthPoint = 0; | |
| 655 timeThis = 0; | |
| 656 if(actualDepthPoint > nextDepthPoint) // only if deco | |
| 657 { | |
| 658 // ascent time | |
| 659 timeThis = ((float)(actualDepthPoint - nextDepthPoint)) / sim_ascent_rate_meter_per_min_local; | |
| 660 | |
| 661 // deco stop time | |
| 662 for(ptrDecoInfo=0;ptrDecoInfo < DECOINFO_STRUCT_MAX_STOPS; ptrDecoInfo++) | |
| 663 { | |
| 664 timeThis += decoInfoInput->output_stop_length_seconds[ptrDecoInfo] / 60; | |
| 665 if(!decoInfoInput->output_stop_length_seconds[ptrDecoInfo]) break; | |
| 666 } | |
| 667 } | |
| 668 timeSummary += timeThis; | |
| 669 outputSummary->timeToSurface = (uint16_t)timeSummary; | |
| 670 | |
| 671 } | |
| 672 | |
| 673 | |
| 674 /** | |
| 675 ****************************************************************************** | |
| 676 * @brief simulation_gas_consumption | |
| 677 ****************************************************************************** | |
| 678 * @note called by openEdit_PlanResult() in tMenuEditPlanner.c | |
| 679 * @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 | |
| 680 * @param outputConsumptionList list from 1 to 5 for gas 1 to 5 | |
| 681 * @param depth_meter for descend | |
| 682 * @param dive_time_minutes for descend and bottom time | |
| 683 * @param the calculated deco list | |
| 684 * @param gasConsumTravelInput: how many l/min for all but deco stops | |
| 685 * @param gasConsumDecoInput: how many l/min for deco stops only | |
| 686 * @return void | |
| 687 */ | |
| 688 | |
| 689 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) | |
| 690 { | |
| 691 uint8_t ptrDecoInfo = 0; | |
| 692 uint8_t ptrChangeList = 0; | |
| 693 uint8_t actualConsumGasId = 0; | |
| 694 uint8_t nextGasChangeMeter = 0; | |
| 695 uint16_t actualDepthPoint = 0; | |
| 696 uint16_t nextDepthPoint = 0; | |
| 697 uint16_t inBetweenDepthPoint = 0; | |
| 698 float timeThis = 0; | |
| 699 float consumThis = 0; | |
| 700 float timeSummary = 0; | |
| 701 float outputConsumptionTempFloat[6]; | |
| 702 float sim_descent_rate_meter_per_min_local = 10; | |
| 703 float sim_ascent_rate_meter_per_min_local = 10; | |
| 704 | |
| 705 SDiveState * pDiveState = &stateSim; | |
| 706 | |
|
51
8f8ea3a32e82
Resolved warnings pointing to possible invalid memory access
Ideenmodellierer
parents:
38
diff
changeset
|
707 uint8_t depthDecoNext = 0; |
|
8f8ea3a32e82
Resolved warnings pointing to possible invalid memory access
Ideenmodellierer
parents:
38
diff
changeset
|
708 uint8_t depthLast = 0; |
|
8f8ea3a32e82
Resolved warnings pointing to possible invalid memory access
Ideenmodellierer
parents:
38
diff
changeset
|
709 uint8_t depthSecond = 0; |
|
8f8ea3a32e82
Resolved warnings pointing to possible invalid memory access
Ideenmodellierer
parents:
38
diff
changeset
|
710 uint8_t depthInc = 0; |
| 38 | 711 |
| 712 for(int i = 1; i < 6; i++) | |
| 713 outputConsumptionTempFloat[i] = 0; | |
| 714 | |
| 715 if(gasChangeListDepthGas20x2) | |
| 716 { | |
| 717 nextGasChangeMeter = gasChangeListDepthGas20x2[ptrChangeList++]; | |
| 718 actualConsumGasId = gasChangeListDepthGas20x2[ptrChangeList++]; | |
| 719 nextGasChangeMeter = gasChangeListDepthGas20x2[ptrChangeList++]; | |
| 720 } | |
| 721 else | |
| 722 { | |
| 723 actualConsumGasId = pDiveState->lifeData.actualGas.GasIdInSettings; | |
| 724 nextGasChangeMeter = 0; | |
| 725 } | |
| 726 | |
| 727 if(pDiveState->diveSettings.deco_type.ub.standard == GF_MODE) | |
| 728 { | |
| 729 sim_descent_rate_meter_per_min_local = sim_descent_rate_meter_per_min; // const float | |
| 730 sim_ascent_rate_meter_per_min_local = pDiveState->diveSettings.ascentRate_meterperminute; | |
| 731 } | |
| 732 else | |
| 733 { | |
| 734 sim_descent_rate_meter_per_min_local = sim_descent_rate_meter_per_min; // const float | |
| 735 sim_ascent_rate_meter_per_min_local = 10;// fix in vpm_calc_deco(); | |
| 736 } | |
| 737 | |
| 738 // while((nextGasChangeMeter < depth_meter) && (actualDepthPoint < depth_meter)) | |
| 739 while(actualDepthPoint < depth_meter) | |
| 740 { | |
| 741 if(nextGasChangeMeter && (nextGasChangeMeter < depth_meter) && (gasChangeListDepthGas20x2[ptrChangeList] != 255)) // list has 255,255 for turn from travel to deco | |
| 742 { | |
| 743 nextDepthPoint = nextGasChangeMeter; | |
| 744 } | |
| 745 else | |
| 746 { | |
| 747 nextDepthPoint = depth_meter; | |
| 748 } | |
| 749 | |
| 750 if(actualConsumGasId > 5) // safety first | |
| 751 actualConsumGasId = 0; | |
| 752 | |
| 753 timeThis = ((float)(nextDepthPoint - actualDepthPoint)) / sim_descent_rate_meter_per_min_local; | |
| 754 if(actualDepthPoint) // not if on surface | |
| 755 { | |
| 756 consumThis = ((float)gasConsumTravelInput) * sGChelper_bar(actualDepthPoint) * timeThis; | |
| 757 } | |
| 758 consumThis += ((float)gasConsumTravelInput) * sGChelper_bar(nextDepthPoint -actualDepthPoint) * timeThis / 2; | |
| 759 outputConsumptionTempFloat[actualConsumGasId] += consumThis; | |
| 760 timeSummary += timeThis; | |
| 761 | |
| 762 actualDepthPoint = nextDepthPoint; | |
| 763 | |
| 764 if(actualDepthPoint != depth_meter) | |
| 765 { | |
| 766 actualConsumGasId = gasChangeListDepthGas20x2[ptrChangeList++]; | |
| 767 nextGasChangeMeter = gasChangeListDepthGas20x2[ptrChangeList++]; | |
| 768 } | |
| 769 } | |
| 770 | |
| 771 // bottom Time | |
| 772 timeThis = ((float)dive_time_minutes) - timeSummary; | |
| 773 | |
| 774 if(timeThis > 0) | |
| 775 { | |
| 776 consumThis = ((float)gasConsumTravelInput) * sGChelper_bar(depth_meter) * timeThis; | |
| 777 outputConsumptionTempFloat[actualConsumGasId] += consumThis; | |
| 778 } | |
| 779 | |
| 780 // ascend with deco stops prepare | |
| 781 if(gasChangeListDepthGas20x2) | |
| 782 { | |
| 783 ptrChangeList++;// gasChangeListDepthGas20x2[ptrChangeList++]; // should be the 255 | |
| 784 nextGasChangeMeter = gasChangeListDepthGas20x2[ptrChangeList++]; | |
| 785 } | |
| 786 else | |
| 787 { | |
| 788 nextGasChangeMeter = 0; | |
| 789 } | |
| 790 | |
| 791 | |
| 792 if(!decoInfoInput->output_stop_length_seconds[0]) // NDL dive | |
| 793 { | |
| 794 depthLast = 0; | |
| 795 ptrDecoInfo = 0; | |
| 796 } | |
| 797 else | |
| 798 { | |
| 799 // prepare deco stop list | |
| 800 depthLast = (uint8_t)(stateUsed->diveSettings.last_stop_depth_bar * 10); | |
| 801 depthSecond = (uint8_t)(stateUsed->diveSettings.input_second_to_last_stop_depth_bar * 10); | |
| 802 depthInc = (uint8_t)(stateUsed->diveSettings.input_next_stop_increment_depth_bar * 10); | |
| 803 | |
| 804 for(ptrDecoInfo=DECOINFO_STRUCT_MAX_STOPS-1; ptrDecoInfo>0; ptrDecoInfo--) | |
| 805 if(decoInfoInput->output_stop_length_seconds[ptrDecoInfo]) break; | |
| 806 } | |
| 807 | |
| 808 actualDepthPoint = depth_meter; // that is where we are | |
| 809 | |
| 810 // ascend with deco stops | |
| 811 while(actualDepthPoint) | |
| 812 { | |
| 813 if(ptrDecoInfo == 0) | |
| 814 { | |
| 815 depthDecoNext = depthLast; | |
| 816 } | |
| 817 else | |
| 818 depthDecoNext = depthSecond + (( ptrDecoInfo - 1 )* depthInc); | |
| 819 | |
| 820 if(nextGasChangeMeter && (nextGasChangeMeter > depthDecoNext)) | |
| 821 { | |
| 822 nextDepthPoint = nextGasChangeMeter; | |
| 823 } | |
| 824 else | |
| 825 { | |
| 826 nextDepthPoint = depthDecoNext; | |
| 827 } | |
| 828 | |
| 829 if(actualConsumGasId > 5) // safety first | |
| 830 actualConsumGasId = 0; | |
| 831 | |
| 832 if(actualDepthPoint > nextDepthPoint) | |
| 833 { | |
| 834 // flip signs! It's going up | |
| 835 timeThis = ((float)(actualDepthPoint - nextDepthPoint)) / sim_ascent_rate_meter_per_min_local; | |
| 836 inBetweenDepthPoint = nextDepthPoint + ((actualDepthPoint - nextDepthPoint)/2); | |
| 837 consumThis = ((float)gasConsumDecoInput) * sGChelper_bar(inBetweenDepthPoint) * timeThis; | |
| 838 /* | |
| 839 if(nextDepthPoint) | |
| 840 { | |
| 841 consumThis = ((float)gasConsumDecoInput) * sGChelper_bar(nextDepthPoint) * timeThis; | |
| 842 } | |
| 843 else | |
| 844 { | |
| 845 consumThis = 0; | |
| 846 } | |
| 847 consumThis += ((float)gasConsumDecoInput) * sGChelper_bar(actualDepthPoint - nextDepthPoint) * timeThis / 2; | |
| 848 */ | |
| 849 outputConsumptionTempFloat[actualConsumGasId] += consumThis; | |
| 850 } | |
| 851 | |
| 852 if(nextGasChangeMeter && (nextDepthPoint == nextGasChangeMeter)) | |
| 853 { | |
| 854 actualConsumGasId = gasChangeListDepthGas20x2[ptrChangeList++]; | |
| 855 nextGasChangeMeter = gasChangeListDepthGas20x2[ptrChangeList++]; | |
| 856 } | |
| 857 | |
| 858 if(actualConsumGasId > 5) // safety first | |
| 859 actualConsumGasId = 0; | |
| 860 | |
| 861 if(nextDepthPoint && (nextDepthPoint == depthDecoNext)) | |
| 862 { | |
| 863 if(decoInfoInput->output_stop_length_seconds[ptrDecoInfo]) | |
| 864 { | |
| 865 timeThis = ((float)(decoInfoInput->output_stop_length_seconds[ptrDecoInfo])) / 60.0f; | |
| 866 consumThis = ((float)gasConsumDecoInput) * sGChelper_bar(nextDepthPoint) * timeThis; | |
| 867 outputConsumptionTempFloat[actualConsumGasId] += consumThis; | |
| 868 } | |
| 869 if(ptrDecoInfo != 0) | |
| 870 { | |
| 871 ptrDecoInfo--; | |
| 872 } | |
| 873 else | |
| 874 { | |
| 875 depthLast = 0; | |
| 876 } | |
| 877 } | |
| 878 actualDepthPoint = nextDepthPoint; | |
| 879 } | |
| 880 | |
| 881 // copy and return | |
| 882 for(int i = 1; i < 6; i++) | |
| 883 outputConsumptionList[i] = (uint16_t)(outputConsumptionTempFloat[i]); | |
| 884 } | |
| 885 | |
| 886 /** | |
| 887 ****************************************************************************** | |
| 888 * @brief Simulator control during simulated dive | |
| 889 ****************************************************************************** | |
| 890 * @note called by user via tHomeDiveMenuControl() | |
| 891 * @param void | |
| 892 * @return void | |
| 893 */ | |
| 894 | |
| 895 | |
| 896 void Sim_Descend (void) | |
| 897 { | |
| 898 stateSimGetPointerWrite()->lifeData.counterSecondsShallowDepth = 0; | |
| 899 if(simulation_get_aim_depth() < 200) | |
| 900 simulation_set_aim_depth(simulation_get_aim_depth() + 1); | |
| 901 } | |
| 902 | |
| 903 | |
| 904 void Sim_Ascend (void) | |
| 905 { | |
| 906 if(simulation_get_aim_depth() > 0) | |
| 907 simulation_set_aim_depth(simulation_get_aim_depth() - 1); | |
| 908 } | |
| 909 | |
| 910 | |
| 911 void Sim_Divetime (void) | |
| 912 { | |
| 913 simulation_add_time(5); | |
| 914 } | |
| 915 | |
| 916 | |
| 917 void Sim_Quit (void) | |
| 918 { | |
| 919 if(stateSimGetPointer()->lifeData.counterSecondsShallowDepth) | |
| 920 { | |
| 921 simulation_exit(); | |
| 922 return; | |
| 923 } | |
| 924 | |
| 925 if(simulation_get_aim_depth() > 0) | |
| 926 { | |
| 927 simulation_set_aim_depth(0); | |
| 928 } | |
| 929 else | |
| 930 { | |
| 931 stateSimGetPointerWrite()->lifeData.depth_meter = 0; | |
| 932 if(stateSimGetPointer()->diveSettings.diveMode == DIVEMODE_Apnea) | |
| 933 { | |
| 934 stateSimGetPointerWrite()->lifeData.counterSecondsShallowDepth = 1; | |
| 935 } | |
| 936 else | |
| 937 { | |
| 938 stateSimGetPointerWrite()->lifeData.counterSecondsShallowDepth = settingsGetPointer()->timeoutDiveReachedZeroDepth - 15; | |
| 939 } | |
| 940 } | |
| 941 } | |
|
760
21949c88da90
Quit simualted dives after the dive time set in the SIM tab.
heinrichsweikamp
parents:
748
diff
changeset
|
942 |
|
629
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
943 void Sim_IncreasePPO(uint8_t sensorIdx) |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
944 { |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
945 if((sensorIdx < NUM_OF_SENSORS) && (simSensmVOffset[sensorIdx] + SIM_PPO2_STEP < 100.0) && ((stateUsed->diveSettings.ppo2sensors_deactivated & (1 << sensorIdx)) == 0)) |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
946 { |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
947 simSensmVOffset[sensorIdx] += SIM_PPO2_STEP; |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
948 } |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
949 } |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
950 void Sim_DecreasePPO(uint8_t sensorIdx) |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
951 { |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
952 if((sensorIdx < NUM_OF_SENSORS) && (simSensmVOffset[sensorIdx] - SIM_PPO2_STEP >= -100.0)) |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
953 { |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
954 simSensmVOffset[sensorIdx] -= SIM_PPO2_STEP; |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
955 } |
|
55a9aa740f13
Added functionality to add ppo2 mV offset:
Ideenmodellierer
parents:
548
diff
changeset
|
956 } |