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