Mercurial > public > hwos_code
annotate src/p2_deco.c @ 650:bc214815deb2
3.19/10.75 release
author | heinrichsweikamp |
---|---|
date | Sun, 28 Aug 2022 13:13:38 +0200 |
parents | 1e695355dfc4 |
children | 75e90cd0c2c3 |
rev | line source |
---|---|
582 | 1 // *************************************************************************** |
650 | 2 // p2_deco.c combined next generation V3.19.4 |
0 | 3 // |
4 // Created on: 12.05.2009 | |
560 | 5 // Author: heinrichs weikamp, contributions by Ralph Lembcke and others |
0 | 6 // |
582 | 7 // *************************************************************************** |
0 | 8 |
9 ////////////////////////////////////////////////////////////////////////////// | |
10 // OSTC - diving computer code | |
604 | 11 // Copyright (C) 2018 HeinrichsWeikamp GmbH |
0 | 12 // |
13 // This program is free software: you can redistribute it and/or modify | |
14 // it under the terms of the GNU General Public License as published by | |
623 | 15 // the Free Software Foundation, either version 3 of the License, or |
0 | 16 // (at your option) any later version. |
17 // | |
18 // This program is distributed in the hope that it will be useful, | |
19 // but WITHOUT ANY WARRANTY; without even the implied warranty of | |
623 | 20 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
0 | 21 // GNU General Public License for more details. |
22 // | |
23 // You should have received a copy of the GNU General Public License | |
623 | 24 // along with this program. If not, see <http://www.gnu.org/licenses/>. |
0 | 25 // |
26 ////////////////////////////////////////////////////////////////////////////// | |
27 | |
623 | 28 // History: |
0 | 29 // 01/03/08 v100: first release candidate |
30 // 03/13/08 v101: start of programming ppO2 code | |
560 | 31 // 03/13/25 v101a: backup of interim version with ppO2 calculation |
0 | 32 // 03/13/25 v101: open circuit gas change during deco |
623 | 33 // 03/13/25 v101: CNS_fraction_real calculation |
0 | 34 // 03/13/26 v101: optimization of tissue calc routines |
623 | 35 // 07/xx/2008 v102a: debug of bottom time routine |
36 // 09/xx/2008 v102d: Gradient Factor Model implementation | |
37 // 10/10/2008 v104: renamed to build v103 for v118 stable | |
631 | 38 // 10/14/2008 v104: integration of char_I_last_stop_depth for Gradient Model |
623 | 39 // 03/31/2009 v107: integration of FONT Incon24 |
40 // 05/23/2010 v109: 5 gas changes & 1 min timer | |
41 // 07/13/2010 v110: cns vault added | |
42 // 12/25/2010 v110: split in three files (deco.c, main.c, definitions.h) | |
0 | 43 // 2011/01/20: [jDG] Create a common file included in ASM and C code. |
623 | 44 // 2011/01/24: [jDG] Make ascent time an short. No more overflow! |
0 | 45 // 2011/01/25: [jDG] Fusion deco array for both models. |
46 // 2011/01/25: [jDG] Use CF(54) to reverse deco order. | |
47 // 2011/02/11: [jDG] Reworked gradient-factor implementation. | |
48 // 2011/02/15: [jDG] Fixed inconsistencies introduced by gas switch delays. | |
49 // 2011/03/21: [jDG] Added gas consumption (CF56 & CF57) evaluation for OCR mode. | |
631 | 50 // 2011/04/15: [jDG] Store GF_depth in 32 bits (w/o rounding), for a better stability. |
560 | 51 // 2011/04/25: [jDG] Added 1mn mode for CNS calculation, to allow it for deco planning. |
0 | 52 // 2011/04/27: [jDG] Fixed char_O_gradient_factor calculation when model uses gradient-factor. |
53 // 2011/05/02: [jDG] Added "Future TTS" function (CF58). | |
54 // 2011/05/17: [jDG] Various cleanups. | |
55 // 2011/08/08: [jDG] Computes CNS during deco planning ascent. | |
56 // 2011/11/24: [jDG] Slightly faster and better NDL computation. | |
57 // 2011/12/17: [mH] Remove of the useless debug stuff | |
58 // 2012/02/24: [jDG] Remove missed stop bug. | |
59 // 2012/02/25: [jDG] Looking for a more stable LOW grad factor reference. | |
60 // 2012/09/10: [mH] Fill char_O_deco_time_for_log for logbook write | |
623 | 61 // 2012/10/05: [jDG] Better calc_gas_needs_ascent accuracy (average depth, switch between stop). |
631 | 62 // 2013/03/05: [jDG] Should vault GF_depth too. |
0 | 63 // 2013/03/05: [jDG] Wrobell remark: ascent_to_first_stop works better with finer steps (2sec). |
33
5d4a4fb0e8a6
Bugfix: NOAA tables for CNS are in ATA, not bar
heinrichsweikamp
parents:
0
diff
changeset
|
64 // 2013/05/08: [jDG] A. Salm remark: NOAA tables for CNS are in ATA, not bar. |
560 | 65 // 2013/12/21: [jDG] Fix CNS calculation in deco plan w/o marked gas switch |
66 // 2014/06/16: [jDG] Fix Helium diluent. Fix volumes with many travel mix. | |
324
0e9dcdcf03c1
FIX NDL prediction error with Buhlmann model: might be desaturating too fast.
jdg@air
parents:
323
diff
changeset
|
67 // 2014/06/29: [mH] Compute int_O_ceiling |
0e9dcdcf03c1
FIX NDL prediction error with Buhlmann model: might be desaturating too fast.
jdg@air
parents:
323
diff
changeset
|
68 // 2015/06/12: [jDG] Fix NDL prediction while desaturating with the Buhlmann model. |
560 | 69 // 2017/08/04: [mH] Switch to absolute GF everywhere and apply safety margin parameters to both models (GF and non-GF), fixes from Ralph Lembcke |
70 // 2017/10/31: [rl] enhancements for pSCR mode and introduction of 2nd deco plan computation | |
71 // 2017/12/31: [rl] completion of 2nd deco plan computation and various up-fixes | |
584 | 72 // 2018/02/17: [rl] switch-over to new ceiling rounding (V2.98a) |
0 | 73 // |
74 // | |
75 // Literature: | |
313 | 76 // Buhlmann, Albert: Tauchmedizin; 4. Auflage [2002]; |
604 | 77 // Schroeder, Kai & Reith, Steffen; 2000; Saettigungsvorgaenge beim Tauchen, das Modell ZH-L16, Funktionsweise von Tauchcomputern; http://www.achim-und-kai.de/kai/tausim/saett_faq |
0 | 78 // Morrison, Stuart; 2000; DIY DECOMPRESSION; http://www.lizardland.co.uk/DIYDeco.html |
79 // Balthasar, Steffen; Dekompressionstheorie I: Neo Haldane Modelle; http://www.txfreak.de/dekompressionstheorie_1.pdf | |
80 // Baker, Erik C.; Clearing Up The Confusion About "Deep Stops" | |
81 // Baker, Erik C.; Understanding M-values; http://www.txfreak.de/understanding_m-values.pdf | |
604 | 82 |
83 | |
84 // ********************************************************************************************************************************* | |
0 | 85 // |
604 | 86 // I N C L U D E S |
87 // | |
88 // ********************************************************************************************************************************* | |
89 | |
623 | 90 |
604 | 91 #include <math.h> |
650 | 92 #include <string.h> |
582 | 93 #include "p2_definitions.h" |
94 #define TEST_MAIN | |
95 #include "shared_definitions.h" | |
623 | 96 #include "configuration.inc" |
0 | 97 |
560 | 98 |
650 | 99 // work-around for a C18 compiler bug (to avoid a warning been thrown for valid code) |
100 #define memcpy(a,b,c) memcpy((a),(const void*)(b),(c)) | |
101 | |
102 | |
604 | 103 // ********************************************************************************************************************************* |
104 // | |
105 // C O N S T A N T S D E F I N I T I O N S | |
106 // | |
107 // ********************************************************************************************************************************* | |
108 | |
623 | 109 |
110 // deco engine scheduling | |
111 #define INVOKES_PER_SECOND 2 // number of invocations of the deco engine per second (use powers of 2 only: 1, 2, 4, ...) | |
628 | 112 |
113 #ifdef _hwos_sport | |
114 #define BUDGET_PER_SECOND 320 // [ms] total time budget per second for the deco engine, each invocation will preempt after BUDGET_PER_SECOND / INVOKES_PER_SECOND | |
115 #else | |
623 | 116 #define BUDGET_PER_SECOND 640 // [ms] total time budget per second for the deco engine, each invocation will preempt after BUDGET_PER_SECOND / INVOKES_PER_SECOND |
628 | 117 #endif |
604 | 118 |
560 | 119 // ambient pressure at different mountain heights |
120 #define P_ambient_1000m 0.880 // [bar] based on 990 hPa and 20°C at sea level, 15°C at altitude | |
121 #define P_ambient_2000m 0.782 // [bar] | |
122 #define P_ambient_3000m 0.695 // [bar] | |
123 | |
124 // ambient pressure in aircraft cabin during flying - worst case according to Buhlmann | |
125 #define P_ambient_fly 0.600 // [bar], 0.600 bar is the value used by Buhlmann for his flying-after-diving calculations | |
582 | 126 // 0.735 bar is a typical cabin pressure for nowadays commercial jet aircrafts |
560 | 127 // ----- |
128 // 0.135 bar safety margin | |
129 | |
130 // constants and factors | |
631 | 131 #define ppWater 0.06270 // water vapor partial pressure in the lungs |
132 #define METER_TO_BAR 0.09807 // conversion factor (1 m water column = 0.09807 bar) | |
133 #define BAR_TO_METER 10.19716 // conversion factor (1 bar = 10.19716 m ) | |
134 #define SURFACE_DESAT_FACTOR 0.70420 // surface desaturation safety factor | |
135 #define HYST 1.0E-06 // threshold for tissue graphics on-gassing / off-gassing visualization | |
643 | 136 #define GAS_DENSITY_He_FACTOR 17.64 // in multiples of 0.01 grams per liter |
137 #define GAS_DENSITY_N2_FACTOR 123.46 // in multiples of 0.01 grams per liter | |
138 #define GAS_DENSITY_O2_FACTOR 141.02 // in multiples of 0.01 grams per liter | |
560 | 139 |
140 // thresholds | |
628 | 141 #define CNS_LIMIT_WARNING 100 // threshold for CNS warning |
142 #define CNS_LIMIT_ATTENTION 70 // threshold for CNS attention | |
604 | 143 #define PRESSURE_LIMIT_WARNING 200 // threshold for pressure reading warning : 20.0 bar |
144 #define PRESSURE_LIMIT_ATTENTION 500 // threshold for pressure reading attention: 50.0 bar | |
631 | 145 #define GAS_NEEDS_ATTENTION 0.7 // threshold for gas needs attention [1 = 100%] |
604 | 146 #define O2_CONSUMPTION_LIMIT_ATTENTION 20 // threshold for O2 "SAC" attention: 2.0 l/min |
643 | 147 #define ppO2_GAP_TO_SETPOINT 20 // gap between setpoint and max. ppO2 of the pure diluent [cbar] |
623 | 148 #define ppO2_MARGIN_ON_MAX 3 // [cbar] margin on ppO2 max to compensate for surface pressures > 1.000 mbar |
631 | 149 #define STOP_CHAINING_LIMIT 3 // max. number of chained stop table entries before deco calculation is aborted |
628 | 150 |
623 | 151 |
643 | 152 |
623 | 153 // deco engine states and modes - (char_O_)main_status: controls current tissue and deco status calculation (as-is situation) |
154 #define CALC_VOLUME 0x01 // =1: calculate gas needs | |
155 #define CALCULATE_BOTTOM 0x02 // =1: calculate gas needs in deco calculator mode, =0: in dive mode | |
631 | 156 #define CAVE_MODE 0x04 // =1: calculate return path and gas needs using backtracking data |
157 #define GAS_CONTINGENCY 0x08 // =1: use a second best gas if best gas is all used up | |
623 | 158 #define TR_FUNCTIONS 0x10 // =1: calculate TR functions (pressure reading) processing |
159 #define EXTENDED_STOPS 0x20 // =1: allow placement of gas switches below the depth of the 1st stop | |
160 | |
161 #define MODE_MASK 0xC0 // mask for real tissues mode selection | |
162 #define MODE_LOOP 0x40 // =1: CCR (MODE_PSCR needs to be cleared) or pSCR mode | |
163 #define MODE_CCR 0x40 // to be used with == operator in combination with MODE_MASK only! | |
164 #define MODE_PSCR 0x80 // =1: pSCR mode (MODE_LOOP needs to be set, too) | |
165 | |
166 // deco engine states and modes - (char_O_)deco_status: controls deco plan calculation (to-be scenario) | |
167 #define PLAN_MASK 0x03 // bit mask covering normal & alternative plan flag | |
168 #define COMMAND_MASK 0x07 // bit mask covering all command flags | |
169 #define CALCULATING 0x00 // calculations are ongoing | |
170 #define START_NORM 0x01 // input: start calculation of a normal deco plan | |
171 #define CALC_NORM 0x01 // internal: calculating a normal deco plan | |
172 #define COMPLETED_NORM 0x01 // output: calculation of a normal deco plan has completed | |
173 #define START_ALT 0x02 // input: start calculation of an alternative deco plan | |
174 #define CALC_ALT 0x02 // internal: calculating an alternative deco plan | |
175 #define COMPLETED_ALT 0x02 // output: calculation of an alternative deco plan has completed | |
176 #define INITIALIZE 0x04 // input: initialize deco engine | |
631 | 177 #define INITIALIZE_START_NORM 0x05 // input: initialize deco engine and start calculation of a normal deco plan |
623 | 178 #define INITIALIZE_START_ALT 0x06 // input: initialize deco engine and start calculation of an alternative deco plan |
628 | 179 #define DECO_CALCULATOR_MODE 0x08 // input: deco engine is run from deco calculator |
623 | 180 |
181 #define BAILOUT_MODE 0x10 // =1: allow gas switches before first deco stop | |
631 | 182 #define DELAYED_ASCENT 0x20 // =1: figure in a delayed ascent / delayed turn of the dive (fTTS) |
623 | 183 |
184 // MODE_MASK 0xC0 // mask for simulated tissues mode selection | |
185 // MODE_LOOP 0x40 // =1: CCR (MODE_PSCR needs to be cleared) or pSCR mode | |
186 // MODE_CCR 0x40 // to be used with == operator in combination with MODE_MASK only! | |
187 // MODE_PSCR 0x80 // =1: pSCR mode (MODE_LOOP needs to be set, too) | |
188 | |
189 | |
190 // deco engine warnings - (char_O_)deco_warnings | |
604 | 191 #define DECO_WARNING_IBCD 0x01 // IBCD occurring now |
192 #define DECO_WARNING_IBCD_lock 0x02 // IBCD has occurred during the dive | |
193 #define DECO_WARNING_MBUBBLES 0x04 // micro bubbles likely to develop now | |
194 #define DECO_WARNING_MBUBBLES_lock 0x08 // ditto, but sometime during the dive | |
195 #define DECO_WARNING_OUTSIDE 0x10 // tissue pressures outside the Buhlmann model now | |
196 #define DECO_WARNING_OUTSIDE_lock 0x20 // tissue pressures outside the model sometime during the dive | |
197 #define DECO_ATTENTION_OUTSIDE 0x40 // tissue pressures are very close to the Buhlmann limit | |
631 | 198 #define DECO_WARNING_INCOMPLETE 0x80 // deco calculation incomplete due to too long compute time |
604 | 199 |
623 | 200 // deco engine status (char_O_)deco_info |
628 | 201 #define DECO_MODE 0x01 // =1: deco ppO2 levels are permitted |
604 | 202 #define IND_DOUBLE_SWITCH_FLAG 0x02 // =1: switch to other tank advice active |
631 | 203 #define GAS_NEEDS_fTTS 0x04 // =1: gas needs are calculated in fTTS mode |
623 | 204 #define DECO_ZONE 0x08 // =1: fTTS < TTS (not updated when in bailout mode) |
631 | 205 #define DECO_CEILING 0x10 // =1: deco obligation (ceiling > 0) |
206 #define DECO_STOPS_NORM 0x20 // =1: deco stops found in normal plan | |
207 #define DECO_STOPS_ALT 0x40 // =1: deco stops found in alternative plan | |
208 #define GAS_NEEDS_CAVE 0x80 // =1: indicated gas needs are calculated in cave mode | |
623 | 209 |
604 | 210 |
211 // deco engine control - tissue_increment | |
631 | 212 #define TIME_MASK 0x7F // =0: time increment is 2 or 6 seconds, 1..127: time increments is 1..127 minutes |
213 #define TISSUE_SELECTOR 0x80 // =0: calculate on simulated tissues, 1 : calculate on real tissues | |
623 | 214 |
215 | |
216 // deco engine control - next_planning_phase | |
217 #define PHASE_00_DONE 0x00 // calculation cycle finished | |
218 #define PHASE_10_DIVE_INIT 0x10 // once-per-dive initialization of the deco engine | |
628 | 219 #define PHASE_20_CYCLIC_INIT 0x20 // once-every-cycle initialization of the deco engine |
220 #define PHASE_30_EXTENDED_BOTTOM_TIME 0x30 // calculate extended bottom time | |
221 #define PHASE_40_BOTTOM_GAS_NEED 0x40 // calculate gas needs for bottom segment | |
222 #define PHASE_50_NDL_TIME 0x50 // calculate NDL time | |
631 | 223 #define PHASE_70_ASCENT_OR_RETURN 0x70 // calculate open water ascent or cave return |
650 | 224 #define PHASE_80_RESULTS 0x80 // results - NDL, TTS, TST |
225 #define PHASE_81_GAS_NEEDS_PRESSURES 0x81 // results - convert gas needs from volumes to pressures | |
623 | 226 #define PHASE_90_FINISH 0x90 // finish calculation cycle |
227 | |
228 | |
631 | 229 // gas & diluent - type and availability state |
230 // 0x01 // | 0: disabled, 1: first, 2: normal/work, 3: deco | |
231 // 0x02 // | | |
232 #define GAS_TYPE_MASK 0x03 // bit mask covering the type enumerator | |
233 #define GAS_AVAIL_LOST 0x04 // =1: gas/diluent lost flag (permanently unavailable) | |
234 #define GAS_AVAIL_STAGED 0x08 // =1: gas/diluent staged flag (temporary unavailable) | |
235 #define GAS_AVAIL_MASK 0x0C // bit mask covering the availability flags | |
236 #define GAS_NEED_ATTENTION 0x10 // =1: gas need >= attention threshold | |
237 #define GAS_NEED_WARNING 0x20 // =1: gas need >= warning threshold | |
238 #define GAS_NEED_MASK 0x30 // bit mask covering the need flags | |
239 #define GAS_NEARLY_USED_UP 0x40 // =1: the gas is nearly used up (= at attention threshold) | |
240 #define GAS_FULLY_USED_UP 0x80 // =1: the gas is fully used up (= at warning threshold) | |
241 | |
242 | |
560 | 243 // flags used with integer numbers |
604 | 244 #define INT_FLAG_INVALID 0x0400 // =1: value not valid |
623 | 245 #define INT_FLAG_NOT_COMPUTED_YET 0x0800 // =1: value not computed yet |
604 | 246 #define INT_FLAG_ZERO 0x0800 // =1: value is zero |
247 #define INT_FLAG_LOW 0x1000 // =1: value is below a lower warning threshold | |
248 #define INT_FLAG_NOT_AVAIL 0x1000 // =1: value is not available (not computed) | |
249 #define INT_FLAG_HIGH 0x2000 // =1: value is above an upper warning threshold | |
250 #define INT_FLAG_OUTDATED 0x2000 // =1: value has not been updated for too long | |
251 #define INT_FLAG_ATTENTION 0x4000 // =1: value exceeds the attention threshold | |
252 #define INT_FLAG_WARNING 0x8000 // =1: value exceeds the warning threshold | |
253 #define INT_FLAG_OUT_OF_RANGE 0x8000 // =1: value exceeds presentable range | |
254 | |
255 | |
256 | |
257 // ********************************************************************************************************************************* | |
258 // | |
259 // ** P R O T O T Y P E S ** | |
260 // | |
261 // The Functions are listed in sequence of intended usage / application. | |
262 // | |
263 // ********************************************************************************************************************************* | |
264 | |
623 | 265 // Functions used in Surface Mode |
604 | 266 static void calc_interval(PARAMETER unsigned char time_increment); |
267 // Calculates the tissue off-gassing under surface conditions. | |
268 static void calc_desaturation_time(void); // Calculates the desaturation and no-fly times. | |
269 static void clear_tissue(void); // Resets all tissues to surface pressure equilibrium state. | |
623 | 270 static void init_output_vars(void); // Initializes all deco engine output variables to defaults |
271 | |
272 // Main entry point in Dive Mode | |
604 | 273 static void calc_hauptroutine(void); // Sequences all calculations for the real tissues and the deco calculation. |
274 | |
623 | 275 // Functions dedicated to the real Tissues |
604 | 276 static void calc_hauptroutine_data_input(void);// Initializes environment data and sets gas ratios for the real tissues. |
277 | |
623 | 278 // Functions combined for real Tissues & Deco Calculations |
604 | 279 static void calc_alveolar_pressures(void); // Computes the partial pressures from the gas ratios and many more parameters, |
280 // needs either calc_hauptroutine_data_input() be called beforehand or | |
628 | 281 // gas_take_current() or gas_find_best()/gas_take_best() and gas_set_ratios(). |
604 | 282 static void calc_tissues(void); // Updates the tissues dependent on the partial pressures of N2 and He. |
283 static void calc_CNS(void); // Updates the CNS value dependent on the partial pressure of the O2. | |
650 | 284 static void calc_limit(PARAMETER float GF_parameter); |
631 | 285 // Calculates ceiling, current supersaturation factor and some more data. |
604 | 286 |
623 | 287 // Functions for TR |
288 #ifdef _rx_functions | |
289 static void calc_TR_functions(void); // Calculates SAC etc. | |
290 #endif | |
291 | |
631 | 292 // Functions for Cave Mode |
293 #ifdef _cave_mode | |
294 static void read_backtrack_data(void); // Gets the data of the next backtracking data set | |
295 #endif | |
296 | |
623 | 297 // Functions dedicated to Deco Calculations |
604 | 298 static void clear_deco_table(void); // Clears the deco stops table, invoked at the start of each calculation cycle. |
631 | 299 static void gas_take_current(void); // Take the actual currently used gas for ascent & deco calculation |
628 | 300 static unsigned char gas_find_best(void); // Searches for the best gas available. |
301 static void gas_take_best(void); // Switches to the best gas that has been found found before by gas_find_best(). | |
604 | 302 static void gas_set_ratios(void); // Sets the gas ratios for use in deco calculation (simulated tissues), |
628 | 303 // needs to be called after each gas change (gas_take_current/_better). |
623 | 304 static void calc_NDL_time_tissue(void); // Calculates the remaining NDL time for a given tissue. |
305 static unsigned char find_next_stop(void); // Finds the next stop when in a deco ascent. | |
631 | 306 static void update_deco_table(PARAMETER unsigned char time_increment); |
604 | 307 // Enters a new stop or extends an existing stop in the deco stops table. |
631 | 308 static void calc_required_volume(void); // Calculates gas volume required for a given depth, time and usage (SAC rate). |
650 | 309 static void convert_volume_to_pressure(PARAMETER unsigned char index); |
310 // Converts gas volumes into pressures and sets respective flags. | |
623 | 311 |
312 // Functions for Results Reporting | |
604 | 313 static void publish_deco_table(void); // Copies the internal deco stops table to the export interface. |
623 | 314 static void convert_cur_CNS_for_display(void); // Converts the current CNS value from float to integer. |
604 | 315 static void convert_sim_CNS_for_display(void); // Converts the end-of-dive CNS value from float to integer. |
623 | 316 static void convert_sat_for_display(void); // Converts leading tissue saturation value from float to integer, 1.0 = 100%. |
604 | 317 static void convert_ceiling_for_display(void); // Converts ceiling from float to integer in mbar relative pressure. |
318 | |
319 | |
623 | 320 // internal helper Functions |
321 static void load_tmr5(void); // Loads a hardware timer which is used for preemptive scheduling. | |
322 static void read_tmr5(void); // Reads a hardware timer which is used for preemptive scheduling. | |
323 static void read_CNS_ab_coefficient(void); // Reads the CNS a and b coefficients from a ROM table. | |
324 static void read_CNS_c_coefficient(void); // Reads the CNS c coefficient from a ROM table. | |
325 static void read_Buhlmann_coefficients(void); // Reads the Buhlmann a and b coefficients from a ROM table. | |
650 | 326 static void read_Buhlmann_times(PARAMETER unsigned char period); |
604 | 327 // Reads pre-computed tissue increment factors from a ROM table. |
328 static void read_Buhlmann_ht(void); // Reads the half-times from a ROM table. | |
329 static void adopt_Buhlmann_coefficients(void); // Computes average a and b coefficient by the N2/He tissue ratio. | |
330 static void push_tissues_to_vault(void); // Stores the state of the real tissues during simulator runs. | |
331 static void pull_tissues_from_vault(void); // Restores the state of the real tissues after a simulator run. | |
628 | 332 static void calc_N2_equilibrium(void); // Calculate partial pressure of N2 in respired air at surface pressure. |
333 static void get_saturation_factors(void); // Get, safeguard and convert the saturation and desaturation factors. | |
334 static void apply_saturation_factors(void); // Applies saturation and desaturation factors. | |
604 | 335 |
336 | |
337 // ********************************************************************************************************************************* | |
338 // | |
339 // V A R I A B L E S D E F I N I T I O N S | |
340 // | |
341 // ********************************************************************************************************************************* | |
0 | 342 |
650 | 343 |
344 //---- Bank 13 parameters ----------------------------------------------------- | |
345 #ifndef UNIX | |
346 # pragma udata overlay bank13=0xd00 | |
347 static char C_STACK[256]; // C-code data stack | |
348 # define C_STACK_ADDR C_STACK | |
349 #endif | |
350 | |
351 // 256 byte used, bank is full | |
352 | |
353 | |
354 //---- Bank 7 parameters ----------------------------------------------------- | |
355 #ifndef UNIX | |
356 # pragma udata bank7=0x700 | |
357 #endif | |
358 | |
359 // tissue pressures for the real tissues (128 byte) | |
360 | |
361 static float real_pres_tissue_N2[NUM_COMP]; // 16 floats = 64 bytes || keep order and position of these variables as | |
362 static float real_pres_tissue_He[NUM_COMP]; // 16 floats = 64 bytes || they are backed-up to & restored from EEPROM! | |
363 | |
364 // delta-pressures for the real tissue pressures (128 byte) | |
365 | |
366 static float real_pres_delta_N2[NUM_COMP]; // 16 floats = 64 bytes | |
367 static float real_pres_delta_He[NUM_COMP]; // 16 floats = 64 bytes | |
368 | |
369 // 256 byte used, bank is full | |
370 | |
371 | |
372 //---- Bank 8 parameters ----------------------------------------------------- | |
373 #ifndef UNIX | |
374 # pragma udata bank8=0x800 | |
375 #endif | |
376 | |
377 // tissue pressures for the simulated tissues (128 byte) | |
378 | |
379 static float sim_pres_tissue_N2[NUM_COMP]; // 16 floats = 64 bytes | |
380 static float sim_pres_tissue_He[NUM_COMP]; // 16 floats = 64 bytes | |
381 | |
382 // delta-pressures for the simulated tissues (128 byte) | |
383 | |
384 static float sim_pres_delta_N2[NUM_COMP]; // 16 floats = 64 bytes | |
385 static float sim_pres_delta_He[NUM_COMP]; // 16 floats = 64 bytes | |
386 | |
387 // 256 byte used, bank is full | |
388 | |
389 | |
390 //---- Bank 12 parameters ----------------------------------------------------- | |
391 | |
392 #ifndef UNIX | |
393 # pragma udata bank12=0xc00 | |
394 #endif | |
395 | |
396 // vault for backing up real tissue pressures (128 byte) | |
397 | |
398 static float vault_pres_tissue_N2[NUM_COMP]; // 16 floats = 64 bytes | |
399 static float vault_pres_tissue_He[NUM_COMP]; // 16 floats = 64 bytes | |
400 | |
401 // vault for backing up real delta-pressures (128 byte) | |
402 | |
403 static float vault_pres_delta_N2[NUM_COMP]; // 16 floats = 64 bytes | |
404 static float vault_pres_delta_He[NUM_COMP]; // 16 floats = 64 bytes | |
405 | |
406 // 256 byte used, bank is full | |
407 | |
408 | |
0 | 409 //---- Bank 5 parameters ----------------------------------------------------- |
410 #ifndef UNIX | |
411 # pragma udata bank5=0x500 | |
412 #endif | |
413 | |
650 | 414 // Timer5 Interface (3 byte) - Attention: keep order and keep at beginning of bank 5, i.e. at address 0x500 ! |
415 | |
416 static volatile unsigned short tmr5_value; // | timer 5 value buffer MUST be at address 0x500 | |
417 static volatile unsigned char tmr5_overflow; // | timer 5 overflow flag MUST be at address 0x502 | |
631 | 418 |
419 | |
420 // Environmental and Gas Data (51 byte) | |
560 | 421 |
582 | 422 static float pres_surface; // absolute pressure at the surface |
560 | 423 |
628 | 424 static float float_depth_real; // current real depth in meters, float |
425 static unsigned char char_depth_real; // current real depth in meters, integer | |
631 | 426 static unsigned char char_depth_start; // start value of simulated depth in meters, integer |
628 | 427 static unsigned char char_depth_sim; // current value of simulated depth in meters, integer |
604 | 428 |
429 static float real_pres_respiration; // current real depth in absolute pressure | |
430 static float real_O2_ratio; // real breathed gas oxygen ratio | |
431 static float real_N2_ratio; // real breathed gas nitrogen ratio | |
432 static float real_He_ratio; // real breathed gas helium ratio | |
433 static float real_pSCR_drop; // real ppO2 drop in pSCR loop | |
582 | 434 |
435 static float sim_pres_respiration; // simulated current depth in abs.pressure, used for deco calculations | |
436 static float sim_O2_ratio; // simulated breathed gas oxygen ratio | |
437 static float sim_N2_ratio; // simulated breathed gas nitrogen ratio | |
438 static float sim_He_ratio; // simulated breathed gas helium ratio | |
439 static float sim_pSCR_drop; // simulated ppO2 drop in pSCR loop | |
560 | 440 |
604 | 441 |
631 | 442 // general Deco Parameters (64 byte) |
623 | 443 |
444 static float GF_low; // gradient factor to determine 1st stop | |
445 static float GF_high; // gradient factor to determine surfacing | |
446 | |
631 | 447 static unsigned char GF_low_last; // last GF low, used to detect a GF change |
448 static unsigned char GF_high_last; // last GF high, used to detect a GF change | |
449 | |
450 static unsigned char GF_depth; // GF low reference depth in current calculation cycle | |
451 static unsigned char GF_depth_norm; // GF low reference depth in normal plan | |
452 static unsigned char GF_depth_alt; // GF low reference depth in alternative plan | |
453 | |
454 static float GF_slope; // (GF_high - GF_low) / GF_depth in current calculation cycle | |
455 static float GF_slope_norm; // (GF_high - GF_low) / GF_depth_norm in normal plan | |
456 static float GF_slope_alt; // (GF_high - GF_low) / GF_depth_alt in alternative plan | |
457 | |
623 | 458 static float float_saturation_multiplier; // safety factor for on-gassing rates |
459 static float float_desaturation_multiplier; // safety factor for off-gassing rates | |
460 | |
461 static unsigned char split_N2_He[NUM_COMP]; // used for calculating the desaturation time | |
631 | 462 static unsigned char deco_gas_type[NUM_GAS]; // type and state of the deco gases |
463 static unsigned char peer_tank[NUM_GAS]; // bit flag vector indicating peer tanks holding same gas | |
464 | |
465 | |
650 | 466 // real Context: what we are doing now (16 byte) |
467 | |
468 static float CNS_fraction_real; // current real CNS (1.00 = 100%) | |
623 | 469 static unsigned short IBCD_tissue_vector; // 16 bit vector to memorize all tissues that experience IBCD |
470 | |
471 static float pres_respiration_sac; // used in SAC calculation: current depth in absolute pressure | |
472 static float float_sac; // used in SAC calculation: SAC value in float | |
473 static unsigned short max_sac_rate; // used in SAC calculation: threshold for SAC rate attention | |
474 | |
475 | |
476 // simulated Context: used to calculate Ascent (11 byte) | |
477 | |
478 static float CNS_fraction_sim; // CNS after predicted ascent, 0.01 = 1%, as float | |
479 static unsigned short int_sim_CNS_fraction; // CNS after predicted ascent, 1 = 1%, as integer | |
480 static unsigned char NDL_tissue_start_norm; // tissue to start with when calculating the normal NDL time | |
481 static unsigned char NDL_tissue_start_alt; // tissue to start with when calculating the alternative NDL time | |
482 static unsigned char NDL_tissue_start; // tissue to start with in current cycle | |
483 static unsigned char NDL_tissue_lead; // tissue with the shortest NDL time found in current cycle | |
484 static unsigned char NDL_tissue; // tissue for which the NDL is calculated right now | |
485 | |
628 | 486 |
623 | 487 // Result Values from Calculation Functions (9 byte) |
488 | |
489 static float ceiling; // minimum tolerated relative pressure (i.e. without surface pressure) | |
490 static float lead_supersat; // supersaturation of the leading tissue, 1.0 = 100% | |
631 | 491 static unsigned char lead_tissue; // number of the leading tissue (0-15) |
623 | 492 |
493 | |
494 // Transfer Variables between calc_desaturation_time() and calc_desaturation_time_helper() (18 byte) | |
495 | |
496 static float desat_factor; // used to cache a pre-computed factor | |
631 | 497 static float var_ht; // half-time factor for the compartment |
498 static float pres_target; // target pressure for the compartment | |
499 static float pres_actual; // current pressure of the compartment | |
623 | 500 static unsigned short int_time; // time it takes for the compartment to reach the target pressure |
501 | |
502 | |
650 | 503 // Gas in Use and Gas Needs (66 byte) |
631 | 504 |
505 static unsigned char start_gas_num; // number of the gas/dil to start with | |
628 | 506 |
507 static unsigned char sim_gas_last_num; // number of the last used gas | |
623 | 508 static unsigned char sim_gas_current_num; // number of the currently used gas |
509 static unsigned char sim_gas_current_depth; // change depth of the currently used gas | |
510 | |
631 | 511 static unsigned char sim_gas_best_num; // number of the best gas available |
512 static unsigned char sim_gas_best_depth; // change depth of the best gas available | |
628 | 513 |
631 | 514 static float gas_volume_need[NUM_GAS]; // gas volumes required for ascent / cave return in liters |
515 static float gas_volume_avail[NUM_GAS]; // gas volumes available for ascent / cave return in liters | |
516 static float gas_volume_atten[NUM_GAS]; // attention threshold for gas volumes available | |
517 | |
518 | |
519 // Transfer Variables for calc_required_volume() (7 byte) | |
628 | 520 |
521 static unsigned char gas_needs_depth; // depth of the stop or half-way point | |
631 | 522 static unsigned char gas_needs_time; // duration of the stop, ascent or travel phase |
628 | 523 static unsigned char gas_needs_usage_rate; // gas usage in l/min |
631 | 524 static float gas_needs_volume_due; // computed amount of required gas volume |
525 | |
526 | |
650 | 527 // Transfer Values for convert_float_to_int() (6 byte) |
528 | |
529 static float float_value; // input value, float | |
530 static unsigned short int_value; // output value, 16 bit | |
531 | |
532 | |
533 // 251 byte used, 5 byte left in this bank (4 bytes per float, 2 bytes per short, 1 byte per char) | |
631 | 534 |
535 | |
536 //---- Bank 6 parameters ----------------------------------------------------- | |
537 #ifndef UNIX | |
538 # pragma udata bank6=0x600 | |
539 #endif | |
540 | |
650 | 541 // Modes, Sequencing and Indexing (17 byte) |
631 | 542 |
543 static unsigned char main_status; // shadow register for char_O_main_status | |
544 static unsigned char deco_status; // shadow register for char_O_deco_status | |
545 static unsigned char deco_info; // shadow register for char_O_deco_info | |
546 static unsigned char deco_warnings; // shadow register for char_O_deco_warnings | |
547 static unsigned char next_planning_phase; // next calculation phase to be executed | |
548 static unsigned char tissue_increment; // selector for real/simulated tissues and time increment | |
549 static unsigned char sequence_timer; // timer to sequence deco engine tasks | |
550 static unsigned char ci; // index to the Buhlmann tables (compartment index) | |
551 static unsigned char cns_i; // index to the CNS tables (ppO2 range index) | |
552 static unsigned char i; // general purpose loop counter and index | |
553 static unsigned char j; // general purpose loop counter and index | |
554 static unsigned char stop_index; // current stop table position | |
555 static unsigned char chained_stops; // counter for chained stop entries | |
556 static unsigned char backtrack_index; // index into the depth backtracking array char_I_backtrack_storage | |
557 static unsigned char backtrack_target_depth; // current backtracking target depth | |
558 static unsigned char backtrack_step_counter; // counter for number of 1/10 minute steps done | |
650 | 559 static unsigned char spare; // UNUSED YET, placed here for alignment purpose |
560 | |
561 | |
562 // Result Values from Calculation Functions (30 byte) | |
631 | 563 |
564 static float ppO2_O2; // ppO2 calculated for breathing pure oxygen in OC mode | |
565 static float ppO2_OC; // ppO2 calculated for breathing current gas in OC mode | |
566 static float ppO2_pSCR; // ppO2 calculated for breathing current gas in pSCR mode | |
567 | |
568 static float ppO2; // partial pressure of breathed oxygen | |
569 static float ppN2; // partial pressure of breathed nitrogen | |
570 static float ppHe; // partial pressure of breathed helium | |
571 | |
572 static unsigned char char_ppO2; // partial pressure of breathed oxygen, 100 = 1.00 bar | |
573 static unsigned char NDL_time; // time in full minutes until reaching no-deco limit (NDL) | |
574 static unsigned short TTS_time; // time in 1/10 minutes until finishing ascent / cave return | |
575 static unsigned short TST_time; // time in full minutes of all stops in ascent / cave return | |
576 | |
577 | |
578 // Buhlmann Model Parameters (40 byte) | |
579 | |
580 static float var_N2_a; // Buhlmann a for current N2 tissue | |
581 static float var_N2_b; // Buhlmann b for current N2 tissue | |
582 static float var_He_a; // Buhlmann a for current He tissue | |
583 static float var_He_b; // Buhlmann b for current He tissue | |
584 static float var_a; // Buhlmann a adopted to current N2/He ratio | |
585 static float var_b; // Buhlmann b adopted to current N2/He ratio | |
586 static float var_N2_e; // exposition for current N2 tissue | |
587 static float var_He_e; // exposition for current He tissue | |
588 static float var_N2_ht; // half-time for current N2 tissue | |
589 static float var_He_ht; // half-time for current He tissue | |
590 | |
591 | |
623 | 592 // Auxiliary Variables for Data Buffering (28 byte) |
593 | |
594 static float N2_equilibrium; // used for N2 tissue graphics scaling | |
595 static float temp_tissue; // auxiliary variable to buffer tissue pressures | |
596 static float float_pSCR_factor; // pre-computed factor for pSCR ppO2 drop calculation | |
597 static float calc_pres_tissue_N2; // auxiliary variable to buffer tissue N2 pressure | |
598 static float calc_pres_tissue_He; // auxiliary variable to buffer tissue He pressure | |
650 | 599 static float calc_pres_tissue; // auxiliary variable to buffer total tissue pressure |
623 | 600 static float old_pres_respiration; // auxiliary variable to buffer sim_pres_respiration |
601 | |
602 | |
650 | 603 // CNS Coefficients (10 byte) |
604 | |
605 static float var_cns_gain; // two coefficients approximation, gain | |
606 static float var_cns_offset; // two coefficients approximation, offset | |
607 static unsigned short var_cns_value; // one coefficient approximation, value | |
608 | |
609 | |
610 // Vault to back-up & restore Tissue related Data (6 byte) | |
611 | |
612 static float vault_CNS_fraction_real; // stores CNS percentage (1.0 = 100%) | |
613 static unsigned char vault_deco_warnings; // stores warnings status | |
614 static unsigned char vault_deco_info; // stores info status | |
615 | |
616 | |
617 // stops table (96 byte) | |
618 | |
619 static unsigned char internal_deco_depth[NUM_STOPS]; // depths of the stops in meters | |
620 static unsigned char internal_deco_time[NUM_STOPS]; // durations of the stops in minutes | |
621 static unsigned char internal_deco_gas[NUM_STOPS]; // gases used on the stops (0 / 1-5) | |
628 | 622 |
623 | |
624 // Performance Profiling (4 byte) | |
625 | |
626 static unsigned short profiling_runtime; // performance measurement: runtime of current invocation | |
627 static unsigned char profiling_runs; // performance measurement: invocations per deco calculation cycle | |
628 static unsigned char profiling_phase; // performance measurement: current calculation phase | |
629 | |
630 | |
650 | 631 // Function Parameters placed by the C Compiler (7 byte) |
632 /* | |
633 static unsigned char period | |
634 static float parameter | |
635 static unsigned char time_increment | |
636 static unsigned char time_interval | |
637 */ | |
638 | |
639 | |
640 // 238 byte used, 18 byte left in this bank (4 bytes per float, 2 bytes per short, 1 byte per char) | |
641 | |
0 | 642 |
582 | 643 |
604 | 644 // ********************************************************************************************************************************* |
645 // | |
646 // L O O K - U P T A B L E S | |
647 // | |
648 // ********************************************************************************************************************************* | |
582 | 649 |
0 | 650 #ifndef UNIX |
631 | 651 # pragma romdata Buhlmann_ht = 0x1DC00 // needs to be in the UPPER bank |
652 #endif | |
653 | |
654 rom const float Buhlmann_ht[2*16] = { | |
655 // Compartment half-times, in minutes | |
656 //--- N2 ---- He ---------------------- | |
657 4.0, 1.51, | |
658 8.0, 3.02, | |
659 12.5, 4.72, | |
660 18.5, 6.99, | |
661 27.0, 10.21, | |
662 38.3, 14.48, | |
663 54.3, 20.53, | |
664 77.0, 29.11, | |
665 109.0, 41.20, | |
666 146.0, 55.19, | |
667 187.0, 70.69, | |
668 239.0, 90.34, | |
669 305.0, 115.29, | |
670 390.0, 147.42, | |
671 498.0, 188.24, | |
672 635.0, 240.03 | |
673 }; | |
674 | |
675 | |
676 #ifndef UNIX | |
623 | 677 # pragma romdata CNS_tables = 0x1DC80 // needs to be in the UPPER bank |
678 #endif | |
679 | |
631 | 680 rom const float CNS_2_approx[2*11] = { |
681 // 2 coefficient approximation for ppO2 = 51 ... 160 cbar | |
682 // CNS increment per 2 sec = 1 / (gain*ppO2 + offset) with ppO2 in [cbar] | |
683 // gain offset for ppO2 cbar range | |
623 | 684 -533.07, 54000, // 51 - 60 (index 0) |
685 -444.22, 48600, // 61 - 70 (index 1) | |
686 -355.38, 42300, // 71 - 80 (index 2) | |
687 -266.53, 35100, // 81 - 90 (index 3) | |
688 -177.69, 27000, // 91 - 100 (index 4) | |
689 -177.69, 27000, // 101 - 110 (index 5) | |
690 -88.84, 17100, // 111 - 120 (index 6) | |
691 -88.84, 17100, // 121 - 130 (index 7) | |
692 -88.84, 17100, // 131 - 140 (index 8) | |
693 -88.84, 17100, // 141 - 150 (index 9) | |
694 -222.11, 37350 // 151 - 160 (index 10) | |
695 }; | |
696 | |
631 | 697 rom const unsigned short CNS_1_approx[1*18] = { |
698 // 1 coefficient approximation for ppO2 = 161 ... 250 cbar | |
699 // CNS increment per 2 sec = c / 100000.0 | |
700 // value in [1/100000] for ppO2 cbar range | |
623 | 701 75, // 161 - 165 (index 0) |
702 102, // 166 - 170 (index 1) | |
703 136, // 171 - 175 (index 2) | |
704 180, // 176 - 180 (index 3) | |
705 237, // 181 - 185 (index 4) | |
706 310, // 186 - 190 (index 5) | |
707 401, // 191 - 195 (index 6) | |
708 517, // 196 - 200 (index 7) | |
709 760, // 201 - 205 (index 8) | |
710 1100, // 206 - 210 (index 9) | |
711 1500, // 211 - 215 (index 10) | |
712 2090, // 216 - 220 (index 11) | |
713 2900, // 221 - 225 (index 12) | |
714 3900, // 226 - 230 (index 13) | |
715 4820, // 231 - 235 (index 14) | |
716 4820, // 236 - 240 (index 15) | |
717 4820, // 241 - 245 (index 16) | |
628 | 718 4820 // 246 - 250 (index 17) |
623 | 719 }; |
720 | |
721 | |
722 #ifndef UNIX | |
631 | 723 # pragma romdata Buhlmann_ab = 0x1DD00 // needs to be in the UPPER bank |
0 | 724 #endif |
725 | |
560 | 726 rom const float Buhlmann_ab[4*16] = { |
631 | 727 // Compartment a and b factors |
521
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
728 // Data ZH-L16C, from Bühlmann Tauchmedizin 2002, option 1a (4mn) |
631 | 729 // a for N2 b for N2 a for He b for He |
521
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
730 1.2599, 0.5050, 1.7424, 0.4245, |
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
731 1.0000, 0.6514, 1.3830, 0.5747, |
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
732 0.8618, 0.7222, 1.1919, 0.6527, |
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
733 0.7562, 0.7825, 1.0458, 0.7223, |
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
734 0.6200, 0.8126, 0.9220, 0.7582, |
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
735 0.5043, 0.8434, 0.8205, 0.7957, |
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
736 0.4410, 0.8693, 0.7305, 0.8279, |
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
737 0.4000, 0.8910, 0.6502, 0.8553, |
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
738 0.3750, 0.9092, 0.5950, 0.8757, |
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
739 0.3500, 0.9222, 0.5545, 0.8903, |
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
740 0.3295, 0.9319, 0.5333, 0.8997, |
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
741 0.3065, 0.9403, 0.5189, 0.9073, |
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
742 0.2835, 0.9477, 0.5181, 0.9122, |
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
743 0.2610, 0.9544, 0.5176, 0.9171, |
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
744 0.2480, 0.9602, 0.5172, 0.9217, |
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
745 0.2327, 0.9653, 0.5119, 0.9267 |
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
746 }; |
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
747 |
631 | 748 |
749 #ifndef UNIX | |
750 # pragma romdata e_tables = 0x1DE00 // needs to be in the UPPER bank | |
751 #endif | |
752 | |
753 rom const float e2sec[2*16] = { | |
754 // Integration constants for 2 seconds, | |
755 // result of 1 - 2^(-(2sec/60sec / HT)) | |
521
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
756 //---- N2 ------------- He ------------ |
623 | 757 5.75958E-03, 1.51848E-02, |
521
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
758 2.88395E-03, 7.62144E-03, |
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
759 1.84669E-03, 4.88315E-03, |
582 | 760 1.24813E-03, 3.29997E-03, |
761 8.55371E-04, 2.26041E-03, | |
762 6.03079E-04, 1.59437E-03, | |
763 4.25414E-04, 1.12479E-03, | |
764 3.00019E-04, 7.93395E-04, | |
765 2.11949E-04, 5.60641E-04, | |
766 1.58240E-04, 4.18555E-04, | |
767 1.23548E-04, 3.26795E-04, | |
768 9.66686E-05, 2.55722E-04, | |
769 7.57509E-05, 2.00387E-04, | |
770 5.92416E-05, 1.56716E-04, | |
771 4.63943E-05, 1.22734E-04, | |
772 3.63850E-05, 9.62538E-05 | |
521
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
773 //------------------------------------- |
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
774 }; |
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
775 |
631 | 776 rom const float e6sec[2*16] = { |
777 // Integration constants for 6 seconds, | |
778 // result of 1 - 2^(-(6sec/60sec / HT)) | |
779 //---- N2 ------------- He ------------ | |
780 1.71794E-02, 4.48661E-02, | |
781 8.62691E-03, 2.26905E-02, | |
782 5.52983E-03, 1.45780E-02, | |
783 3.73973E-03, 9.86726E-03, | |
784 2.56392E-03, 6.76591E-03, | |
785 1.80815E-03, 4.77549E-03, | |
786 1.27570E-03, 3.37057E-03, | |
787 8.99786E-04, 2.37830E-03, | |
788 6.35713E-04, 1.68098E-03, | |
789 4.74646E-04, 1.25514E-03, | |
790 3.70598E-04, 9.80064E-04, | |
791 2.89978E-04, 7.66971E-04, | |
792 2.27236E-04, 6.01040E-04, | |
793 1.77714E-04, 4.70075E-04, | |
794 1.39176E-04, 3.68157E-04, | |
795 1.09151E-04, 2.88734E-04 | |
796 //------------------------------------- | |
797 }; | |
798 | |
521
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
799 rom const float e1min[2*16] = { |
631 | 800 // Integration constants for 1 minute, |
801 // result of 1 - 2^(-(1min / HT)) | |
521
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
802 //----- N2 --------- e 1min He -------- |
582 | 803 1.59104E-01, 3.68109E-01, |
804 8.29960E-02, 2.05084E-01, | |
805 5.39424E-02, 1.36579E-01, | |
806 3.67742E-02, 9.44046E-02, | |
807 2.53454E-02, 6.56359E-02, | |
808 1.79351E-02, 4.67416E-02, | |
809 1.26840E-02, 3.31991E-02, | |
810 8.96152E-03, 2.35301E-02, | |
811 6.33897E-03, 1.66832E-02, | |
812 4.73633E-03, 1.24808E-02, | |
813 3.69981E-03, 9.75753E-03, | |
814 2.89600E-03, 7.64329E-03, | |
815 2.27003E-03, 5.99417E-03, | |
816 1.77572E-03, 4.69082E-03, | |
817 1.39089E-03, 3.67548E-03, | |
818 1.09097E-03, 2.88359E-03 | |
521
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
819 //------------------------------------- |
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
820 }; |
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
821 |
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
822 rom const float e10min[2*16] = { |
631 | 823 // Integration constants for 10 minutes, |
824 // result of 1 - 2^(-(10min / HT)) | |
521
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
825 //---- N2 -------------- He ----------- |
582 | 826 8.23223E-01, 9.89851E-01, |
827 5.79552E-01, 8.99258E-01, | |
828 4.25651E-01, 7.69737E-01, | |
829 3.12487E-01, 6.29027E-01, | |
830 2.26416E-01, 4.92821E-01, | |
831 1.65547E-01, 3.80407E-01, | |
832 1.19840E-01, 2.86538E-01, | |
833 8.60863E-02, 2.11886E-01, | |
834 6.16117E-02, 1.54849E-01, | |
835 4.63665E-02, 1.18026E-01, | |
836 3.63881E-02, 9.34005E-02, | |
837 2.85855E-02, 7.38569E-02, | |
838 2.24698E-02, 5.83504E-02, | |
839 1.76160E-02, 4.59303E-02, | |
840 1.38222E-02, 3.61528E-02, | |
841 1.08563E-02, 2.84646E-02 | |
521
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
842 //------------------------------------- |
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
843 }; |
0 | 844 |
604 | 845 |
846 // ********************************************************************************************************************************* | |
0 | 847 // |
604 | 848 // H E L P E R F U N C T I O N S |
849 // | |
850 // ********************************************************************************************************************************* | |
851 | |
852 | |
628 | 853 // p2deco code moved from 0x0D000 to 0x0C000 in v.108 |
634 | 854 // moved from 0x0C000 to 0x0B000 in v3.09 |
0 | 855 #ifndef UNIX |
634 | 856 # pragma code p2_deco = 0x0B000 |
0 | 857 #endif |
858 | |
859 | |
860 ////////////////////////////////////////////////////////////////////////////// | |
861 // Bump to blue-screen when an assert is wrong | |
623 | 862 #ifdef _DEBUG |
0 | 863 void assert_failed(PARAMETER short int line) |
864 { | |
865 } | |
866 #endif | |
867 | |
604 | 868 |
0 | 869 ////////////////////////////////////////////////////////////////////////////// |
628 | 870 // When calling C code from ASM context, the C data stack pointer need to be |
871 // reset. The C stack is located in bank 8. | |
0 | 872 |
873 #ifdef CROSS_COMPILE | |
584 | 874 # define RESET_C_STACK |
0 | 875 #else |
623 | 876 # ifdef _DEBUG |
584 | 877 # define RESET_C_STACK fillDataStack(); |
878 void fillDataStack(void) | |
879 { | |
880 _asm | |
650 | 881 LFSR 1,C_STACK_ADDR |
604 | 882 MOVLW 0xCC |
883 loop: MOVWF POSTINC1,0 | |
884 TSTFSZ FSR1L,0 | |
885 BRA loop | |
886 | |
650 | 887 LFSR 1,C_STACK_ADDR |
888 LFSR 2,C_STACK_ADDR | |
584 | 889 _endasm |
890 } | |
891 # else | |
650 | 892 # define RESET_C_STACK \ |
893 _asm \ | |
894 LFSR 1,C_STACK_ADDR \ | |
895 LFSR 2,C_STACK_ADDR \ | |
584 | 896 _endasm |
897 # endif | |
0 | 898 #endif |
899 | |
604 | 900 |
0 | 901 ////////////////////////////////////////////////////////////////////////////// |
623 | 902 // Reset timer 5 |
903 // | |
904 // Note: TMR5 is configured in 16 bit mode: a value written to TMR5H is buffered | |
905 // and will be written to TMR5 together with a successive write to TMR5L. | |
906 // As we don't know in which bank the code will be executed, we use either | |
907 // the bank-save "movff" command, or address mapping via access bank (",0"). | |
908 // | |
909 static void load_tmr5(void) | |
0 | 910 { |
911 #ifndef CROSS_COMPILE | |
584 | 912 _asm |
650 | 913 movff 0x501,0xF7D // bank-safe load TMR5H from C variable tmr5_value first |
914 movff 0x500,0xF7C // bank-safe load TMR5L from C variable tmr5_value thereafter | |
623 | 915 bcf 0xFBA,1,0 // clear timer 5 overrun flag (0xFBA = PIR5, bit 1 = TMR5IF) |
916 _endasm | |
0 | 917 #else |
623 | 918 return; |
919 #endif | |
920 } | |
921 | |
922 | |
923 ////////////////////////////////////////////////////////////////////////////// | |
924 // Read timer 5 | |
925 // | |
926 // Note: TMR5 reads in multiples of 1/32 ms, 30.51757813 us/bit to be precise. | |
927 // TMR5 is configured in 16 bit mode: on reading of TMR5L the contents of | |
928 // TMR5H is latched and can be read afterwards without potential rollover. | |
929 // As we don't know in which bank the code will be executed, we use either | |
930 // the bank-save "movff" command, or address mapping via access bank (",0"). | |
931 // | |
932 static void read_tmr5(void) | |
933 { | |
934 #ifndef CROSS_COMPILE | |
935 _asm | |
650 | 936 movff 0xF7C,0x500 // copy TMR5L to C variable tmr5_value, low byte first |
937 movff 0xF7D,0x501 // copy TMR5H to C variable tmr5_value, high byte thereafter | |
623 | 938 clrf WREG,0 // clear WREG to 0x00 = no overrun by default |
939 btfsc 0xFBA,1,0 // did timer 5 overrun? (0xFBA = PIR5, bit 1 = TMR5IF) | |
940 setf WREG,0 // YES - set WREG to 0xff = overrun detected | |
650 | 941 movff WREG,0x502 // copy WREG to C variable tmr5_overflow |
623 | 942 _endasm |
943 #else | |
944 return; | |
0 | 945 #endif |
946 } | |
947 | |
604 | 948 |
0 | 949 ////////////////////////////////////////////////////////////////////////////// |
631 | 950 // Read CNS coefficients gain and offset |
623 | 951 // |
952 static void read_CNS_ab_coefficient(void) | |
953 { | |
954 #ifndef CROSS_COMPILE | |
955 // Note: We don't use far ROM pointer, because handling | |
956 // 24 bit is to complex, hence we have to set the | |
957 // UPPER page ourself... | |
958 // -> set to zero if tables are moved to lower pages! | |
959 _asm | |
960 movlw 1 | |
961 movwf TBLPTRU,0 | |
962 _endasm | |
963 #endif | |
964 | |
965 { | |
631 | 966 overlay rom const float* ptr = &CNS_2_approx[2*cns_i]; |
967 var_cns_gain = *ptr++; | |
968 var_cns_offset = *ptr++; | |
623 | 969 } |
970 } | |
971 | |
972 | |
973 ////////////////////////////////////////////////////////////////////////////// | |
974 // Read CNS coefficient c | |
975 // | |
976 static void read_CNS_c_coefficient(void) | |
977 { | |
978 #ifndef CROSS_COMPILE | |
979 // Note: We don't use far ROM pointer, because handling | |
980 // 24 bit is to complex, hence we have to set the | |
981 // UPPER page ourself... | |
982 // -> set to zero if tables are moved to lower pages! | |
983 _asm | |
984 movlw 1 | |
985 movwf TBLPTRU,0 | |
986 _endasm | |
987 #endif | |
988 | |
989 { | |
631 | 990 overlay rom const unsigned short* ptr = &CNS_1_approx[cns_i]; |
991 var_cns_value = *ptr++; | |
623 | 992 } |
993 } | |
994 | |
995 ////////////////////////////////////////////////////////////////////////////// | |
996 // Read Buhlmann coefficients a and b for compartment ci | |
0 | 997 // |
560 | 998 static void read_Buhlmann_coefficients(void) |
0 | 999 { |
1000 #ifndef CROSS_COMPILE | |
604 | 1001 // Note: We don't use far ROM pointer, because handling |
1002 // 24 bit is too complex, hence we have to set the | |
1003 // UPPER page ourself... | |
628 | 1004 // -> set to zero if tables are moved to lower pages! |
584 | 1005 _asm |
604 | 1006 movlw 1 |
1007 movwf TBLPTRU,0 | |
584 | 1008 _endasm |
0 | 1009 #endif |
1010 | |
584 | 1011 assert( ci < NUM_COMP ); |
1012 | |
604 | 1013 // use an interleaved array (AoS) to access coefficients with a single addressing |
584 | 1014 { |
1015 overlay rom const float* ptr = &Buhlmann_ab[4*ci]; | |
1016 var_N2_a = *ptr++; | |
1017 var_N2_b = *ptr++; | |
1018 var_He_a = *ptr++; | |
1019 var_He_b = *ptr++; | |
1020 } | |
0 | 1021 } |
1022 | |
604 | 1023 |
0 | 1024 ////////////////////////////////////////////////////////////////////////////// |
623 | 1025 // Read Buhlmann increments for compartment ci |
604 | 1026 // If period == 0 : 2 sec interval |
1027 // 1 : 1 min interval | |
1028 // 2 : 10 min interval | |
650 | 1029 static void read_Buhlmann_times(PARAMETER unsigned char period) |
0 | 1030 { |
1031 #ifndef CROSS_COMPILE | |
604 | 1032 // Note: We don't use far ROM pointer, because handling |
1033 // 24 bit is to complex, hence we have to set the | |
631 | 1034 // UPPER page by hand... |
604 | 1035 // -> set to zero if tables are moved to lower pages! |
584 | 1036 _asm |
604 | 1037 movlw 1 |
1038 movwf TBLPTRU,0 | |
584 | 1039 _endasm |
0 | 1040 #endif |
1041 | |
584 | 1042 assert( ci < NUM_COMP ); |
1043 | |
623 | 1044 // Integration Intervals |
584 | 1045 switch(period) |
1046 { | |
631 | 1047 case 0: //---- 2 or 6 seconds -------------------------------------------- |
584 | 1048 { |
631 | 1049 // check which tissues are selected |
1050 if(tissue_increment & TISSUE_SELECTOR) | |
1051 { | |
1052 // real tissues - 2 seconds | |
1053 overlay rom const float* ptr = &e2sec[2*ci]; | |
1054 var_N2_e = *ptr++; | |
1055 var_He_e = *ptr++; | |
1056 } | |
1057 else | |
1058 { | |
1059 // simulated tissues - 6 seconds | |
1060 overlay rom const float* ptr = &e6sec[2*ci]; | |
1061 var_N2_e = *ptr++; | |
1062 var_He_e = *ptr++; | |
1063 } | |
584 | 1064 } |
1065 break; | |
1066 | |
631 | 1067 case 1: //---- 1 minutes ------------------------------------------------- |
584 | 1068 { |
1069 overlay rom const float* ptr = &e1min[2*ci]; | |
1070 var_N2_e = *ptr++; | |
1071 var_He_e = *ptr++; | |
1072 } | |
1073 break; | |
1074 | |
631 | 1075 case 2: //---- 10 minutes ------------------------------------------------ |
584 | 1076 { |
1077 overlay rom const float* ptr = &e10min[2*ci]; | |
1078 var_N2_e = *ptr++; | |
1079 var_He_e = *ptr++; | |
1080 } | |
623 | 1081 break; |
584 | 1082 |
1083 default: | |
623 | 1084 assert(0); // code execution shall never pass along here! |
584 | 1085 } |
0 | 1086 } |
1087 | |
604 | 1088 |
0 | 1089 ////////////////////////////////////////////////////////////////////////////// |
623 | 1090 // Read Buhlmann half-times for compartment ci |
0 | 1091 // |
560 | 1092 static void read_Buhlmann_ht(void) |
0 | 1093 { |
1094 | |
1095 #ifndef CROSS_COMPILE | |
604 | 1096 // Note: We don't use far ROM pointer, because handling |
1097 // 24 bit is to complex, hence we have to set the | |
1098 // UPPER page ourself... | |
1099 // -> Set to zero if tables are moved to lower pages! | |
584 | 1100 _asm |
604 | 1101 movlw 1 |
1102 movwf TBLPTRU,0 | |
584 | 1103 _endasm |
0 | 1104 #endif |
1105 | |
584 | 1106 assert( ci < NUM_COMP ); |
1107 { | |
1108 overlay rom const float* ptr = &Buhlmann_ht[2*ci]; | |
1109 var_N2_ht = *ptr++; | |
1110 var_He_ht = *ptr++; | |
1111 } | |
1112 | |
604 | 1113 assert( 4.0 <= var_N2_ht && var_N2_ht <= 635.0 ); |
584 | 1114 assert( 1.5099 <= var_He_ht && var_He_ht <= 240.03 ); |
0 | 1115 } |
1116 | |
604 | 1117 |
0 | 1118 ////////////////////////////////////////////////////////////////////////////// |
623 | 1119 // Calculate adopted Buhlmann coefficients |
1120 // | |
1121 // Input: var_N2_a, var_N2_b coefficients for N2 | |
1122 // var_He_a, var_He_b coefficients for He | |
1123 // calc_pres_tissue_N2 partial pressure of N2 in tissue | |
1124 // calc_pres_tissue_He partial pressure of He in tissue | |
650 | 1125 // calc_pres_tissue total pressure in tissue |
623 | 1126 // |
1127 // Output: var_a, var_b coefficients adopted by N2/He ratio | |
604 | 1128 // |
1129 static void adopt_Buhlmann_coefficients(void) | |
1130 { | |
1131 // adopt a and b coefficients to current N2/He ratio inside the tissue | |
623 | 1132 |
1133 #ifdef _helium | |
1134 | |
650 | 1135 var_a = (var_N2_a * calc_pres_tissue_N2 + var_He_a * calc_pres_tissue_He) / calc_pres_tissue; |
1136 var_b = (var_N2_b * calc_pres_tissue_N2 + var_He_b * calc_pres_tissue_He) / calc_pres_tissue; | |
623 | 1137 |
1138 #else | |
1139 | |
1140 var_a = var_N2_a; | |
1141 var_b = var_N2_b; | |
1142 | |
1143 #endif | |
1144 | |
1145 } | |
1146 | |
1147 | |
1148 ////////////////////////////////////////////////////////////////////////////// | |
1149 // Calculate partial pressure of N2 in respired air at surface pressure | |
1150 // | |
1151 // Input: pres_surface surface pressure | |
1152 // | |
1153 // Output: N2_equilibrium partial pressure of N2 in surface air | |
1154 // | |
1155 static void calc_N2_equilibrium(void) | |
1156 { | |
1157 N2_equilibrium = 0.7902 * (pres_surface - ppWater); | |
1158 } | |
1159 | |
1160 | |
1161 ////////////////////////////////////////////////////////////////////////////// | |
1162 // Get, safeguard and convert the saturation and desaturation factors | |
1163 // | |
1164 // Input: char_I_saturation_multiplier saturation factor (integer) | |
1165 // char_I_desaturation_multiplier desaturation factor (integer) | |
1166 // | |
1167 // Output: float_saturation_multiplier saturation factor (float) | |
1168 // float_desaturation_multiplier desaturation factor (float) | |
1169 // | |
1170 static void get_saturation_factors(void) | |
1171 { | |
1172 // safeguard input parameters that are constant during the course of the dive | |
1173 if( char_I_saturation_multiplier < 100 ) char_I_saturation_multiplier = 100; | |
1174 if( char_I_saturation_multiplier > 140 ) char_I_saturation_multiplier = 140; | |
1175 | |
1176 if( char_I_desaturation_multiplier < 60 ) char_I_desaturation_multiplier = 60; | |
1177 if( char_I_desaturation_multiplier > 100 ) char_I_desaturation_multiplier = 100; | |
1178 | |
1179 // convert input parameters to float numbers | |
1180 float_saturation_multiplier = 0.01 * char_I_saturation_multiplier; | |
1181 float_desaturation_multiplier = 0.01 * char_I_desaturation_multiplier; | |
1182 } | |
1183 | |
1184 | |
1185 ////////////////////////////////////////////////////////////////////////////// | |
1186 // apply_saturation_factors | |
1187 // | |
1188 // Apply safety factors for both ZH-L16 models. | |
1189 // | |
1190 // Modified: temp_tissue safeguarded tissue increment/decrement | |
1191 // | |
1192 static void apply_saturation_factors(void) | |
1193 { | |
1194 assert( 0.0 < float_desaturation_multiplier && float_desaturation_multiplier <= 1.0 ); | |
1195 assert( 1.0 <= float_saturation_multiplier && float_saturation_multiplier <= 2.0 ); | |
1196 | |
1197 if ( temp_tissue < 0.0 ) temp_tissue *= float_desaturation_multiplier; | |
1198 else temp_tissue *= float_saturation_multiplier; | |
1199 } | |
1200 | |
1201 | |
1202 ////////////////////////////////////////////////////////////////////////////// | |
1203 // convert_float_to_int | |
1204 // | |
1205 // Converts a float within range 0.0 - 9.99 into 16 bit integer scaled in 1/100. | |
1206 // | |
1207 static void convert_float_to_int(void) | |
1208 { | |
1209 if ( float_value < 0.005 ) int_value = 0; | |
1210 else if ( float_value >= 9.985 ) int_value = 999; | |
1211 else int_value = (unsigned short)(100 * float_value + 0.5); | |
1212 } | |
1213 | |
1214 | |
604 | 1215 |
1216 // ********************************************************************************************************************************* | |
1217 // | |
1218 // J U M P I N F U N C T I O N S | |
1219 // | |
1220 // ********************************************************************************************************************************* | |
1221 | |
582 | 1222 |
1223 ////////////////////////////////////////////////////////////////////////////// | |
1224 // deco_calc_hauptroutine | |
1225 // | |
1226 // called from: divemode.asm | |
1227 // | |
628 | 1228 // Called two times per second during diving, updates the |
1229 // tissues every second (i.e. on every second invocation). | |
582 | 1230 // |
628 | 1231 // On each computation cycle: |
582 | 1232 // - Updates deco table (char_O_deco_time/depth) with new values, |
1233 // - updates ascent time, and | |
628 | 1234 // - sets status to zero (so we can check a cycle has finished). |
582 | 1235 // |
1236 void deco_calc_hauptroutine(void) | |
1237 { | |
1238 RESET_C_STACK | |
1239 calc_hauptroutine(); | |
1240 } | |
1241 | |
623 | 1242 |
1243 ////////////////////////////////////////////////////////////////////////////// | |
1244 // deco_init_output_vars | |
1245 // | |
1246 // called from divemode.asm | |
1247 // | |
1248 // Initializes all output variables to their default values. | |
1249 // | |
1250 void deco_init_output_vars(void) | |
1251 { | |
1252 RESET_C_STACK | |
1253 init_output_vars(); | |
1254 } | |
1255 | |
628 | 1256 |
582 | 1257 ////////////////////////////////////////////////////////////////////////////// |
1258 // deco_clear_tissue | |
1259 // | |
1260 // called from: start.asm | |
1261 // menu_tree.asm | |
1262 // simulator.asm | |
1263 // | |
628 | 1264 // Sets all tissues to equilibrium with air at ambient pressure, |
582 | 1265 // resets all CNS values, any warnings and resets all model output. |
1266 // | |
1267 void deco_clear_tissue(void) | |
1268 { | |
1269 RESET_C_STACK | |
1270 clear_tissue(); | |
1271 } | |
1272 | |
623 | 1273 |
582 | 1274 ////////////////////////////////////////////////////////////////////////////// |
1275 // deco_calc_dive_interval | |
1276 // | |
1277 // called from: simulator.asm | |
1278 // | |
628 | 1279 // Updates tissues and CNS value for char_I_dive_interval minutes on air at |
1280 // ambient pressure and calculates resulting saturation and ceiling for a | |
1281 // GF-high of 100% (ceiling and saturation not used by simulator.asm) | |
582 | 1282 // |
1283 void deco_calc_dive_interval(void) | |
1284 { | |
1285 RESET_C_STACK | |
1286 calc_interval(char_I_dive_interval); | |
1287 } | |
1288 | |
623 | 1289 |
582 | 1290 ////////////////////////////////////////////////////////////////////////////// |
1291 // deco_calc_dive_interval_1min | |
1292 // | |
1293 // called from: start.asm | |
1294 // sleepmode.asm | |
1295 // surfmode.asm | |
1296 // menu_tree.asm | |
1297 // ghostwriter.asm | |
1298 // | |
604 | 1299 // Updates tissues and CNS value for 1 minute on air at ambient pressure and |
628 | 1300 // calculates resulting saturation and ceiling for a GF-high of 100%. |
582 | 1301 // |
1302 void deco_calc_dive_interval_1min(void) | |
1303 { | |
1304 RESET_C_STACK | |
1305 calc_interval(1); | |
1306 } | |
1307 | |
1308 | |
1309 ////////////////////////////////////////////////////////////////////////////// | |
604 | 1310 // deco_calc_dive_interval_10min |
582 | 1311 // |
1312 // called from: sleepmode.asm | |
1313 // | |
604 | 1314 // Updates tissues and CNS value for 10 minutes on air at ambient pressure and |
628 | 1315 // calculates resulting saturation and ceiling for a GF-high of 100%. |
582 | 1316 // |
1317 void deco_calc_dive_interval_10min(void) | |
1318 { | |
1319 RESET_C_STACK | |
1320 calc_interval(10); | |
1321 } | |
1322 | |
1323 | |
1324 ////////////////////////////////////////////////////////////////////////////// | |
1325 // deco_calc_desaturation_time | |
1326 // | |
1327 // called from: start.asm | |
1328 // surfmode.asm | |
1329 // menu_tree.asm | |
1330 // ghostwriter.asm | |
1331 // | |
1332 // Computes desaturation and no-fly times. | |
1333 // | |
1334 void deco_calc_desaturation_time(void) | |
1335 { | |
1336 RESET_C_STACK | |
1337 calc_desaturation_time(); | |
1338 } | |
1339 | |
623 | 1340 |
582 | 1341 ////////////////////////////////////////////////////////////////////////////// |
1342 // deco_push_tissues_to_vault | |
1343 // | |
1344 // called from: simulator.asm | |
1345 // | |
1346 // Makes a backup of the state of the real tissues and the deco engine. | |
1347 // | |
1348 void deco_push_tissues_to_vault(void) | |
1349 { | |
1350 RESET_C_STACK | |
1351 push_tissues_to_vault(); | |
1352 } | |
1353 | |
623 | 1354 |
582 | 1355 ////////////////////////////////////////////////////////////////////////////// |
1356 // deco_pull_tissues_from_vault | |
1357 // | |
1358 // called from: simulator.asm | |
1359 // ghostwriter.asm | |
1360 // | |
1361 // Restores the state of the real tissues and the deco engine from the backup. | |
1362 // | |
1363 void deco_pull_tissues_from_vault(void) | |
1364 { | |
1365 RESET_C_STACK | |
1366 pull_tissues_from_vault(); | |
1367 } | |
1368 | |
604 | 1369 |
1370 // ********************************************************************************************************************************* | |
1371 // | |
1372 // M A I N F U N C T I O N S | |
1373 // | |
1374 // ********************************************************************************************************************************* | |
582 | 1375 |
1376 | |
1377 ////////////////////////////////////////////////////////////////////////////// | |
628 | 1378 // Calculate the next deco stop |
0 | 1379 // |
1380 // INPUT, fixed during dive: | |
623 | 1381 // pres_surface : surface pressure (as absolute pressure) |
631 | 1382 // char_I_last_stop_depth : depth of the last deco stop |
623 | 1383 // |
628 | 1384 // INPUT, may change during dive: |
623 | 1385 // GF_high : GF high factor |
1386 // GF_low : GF low factor | |
631 | 1387 // GF_depth : GF low reference depth |
1388 // GF_slope : GF slope | |
1389 // | |
1390 // MODIFIED | |
623 | 1391 // char_depth_sim : simulated depth in meters |
0 | 1392 // |
1393 // OUTPUT | |
631 | 1394 // GF_depth_norm/_alt : updated GF low depth reference |
1395 // GF_slope_norm/_alt : updated GF slope | |
623 | 1396 // |
1397 // RETURN | |
631 | 1398 // TRUE: a deco stop is required, FALSE: no deco stop required |
623 | 1399 // |
1400 static unsigned char find_next_stop(void) | |
0 | 1401 { |
623 | 1402 overlay unsigned char depth_1min; |
1403 overlay unsigned char depth_limit; | |
628 | 1404 overlay unsigned char stop_depth; |
1405 overlay unsigned char next_stop; | |
631 | 1406 |
1407 | |
1408 // calculate the current deco ceiling (minimum relative pressure) | |
1409 if( char_I_model == 0 ) calc_limit(1.0); // straight Buhlmann | |
1410 else if( NDL_time ) calc_limit(GF_high); // with GF: not in deco | |
1411 else if( char_depth_sim >= GF_depth ) calc_limit(GF_low); // in deco, below or at low depth reference | |
1412 else calc_limit(GF_high - GF_slope * (float)char_depth_sim); // in deco, above low depth reference | |
1413 | |
1414 // convert the deco ceiling from relative pressure to meters, | |
1415 // rounded up (i.e. made deeper) to the next full meter | |
1416 depth_limit = (unsigned char)(ceiling * BAR_TO_METER + 0.99); | |
1417 | |
1418 | |
1419 #ifdef _cave_mode | |
1420 // in cave or open water mode? | |
1421 if( main_status & CAVE_MODE ) | |
623 | 1422 { |
631 | 1423 // cave mode |
1424 | |
1425 // does backtracking require descent or keeping depth? | |
1426 if( backtrack_target_depth >= char_depth_sim ) | |
1427 { | |
1428 // YES - decent to target depth or stay at current depth | |
1429 char_depth_sim = backtrack_target_depth; | |
1430 | |
1431 // - done, no stop required | |
1432 return(0); | |
1433 } | |
1434 else | |
1435 { | |
1436 // NO | |
1437 | |
1438 // target depth requires an ascent - determine ascent limit due to deco obligation | |
1439 stop_depth = depth_limit; | |
1440 | |
1441 // apply correction for the shallowest stop | |
1442 if( stop_depth && (stop_depth < char_I_last_stop_depth) ) stop_depth = char_I_last_stop_depth; | |
1443 } | |
623 | 1444 } |
1445 else | |
631 | 1446 #endif |
623 | 1447 { |
631 | 1448 // open water vertical ascent mode - determine the stop depth |
1449 | |
1450 // stop depth is depth limit rounded up (made deeper) to the next multiple of 3 meters | |
1451 stop_depth = 3 * ( (depth_limit + 2) / 3 ); | |
1452 | |
1453 // apply correction for the shallowest stop | |
1454 if( stop_depth == 3 ) stop_depth = char_I_last_stop_depth; | |
623 | 1455 } |
1456 | |
631 | 1457 // is the stop depth shallower than the current depth (can we ascent)? |
1458 if( stop_depth < char_depth_sim ) | |
623 | 1459 { |
631 | 1460 // YES - ascent by 1 meter |
1461 char_depth_sim--; | |
1462 | |
1463 // done, no stop needed | |
1464 return(0); | |
623 | 1465 } |
1466 | |
1467 // ----------------------------------------------------------------------- | |
631 | 1468 // we need to make a stop because we are not allowed to ascent any further |
623 | 1469 // ----------------------------------------------------------------------- |
1470 | |
631 | 1471 // set depth to stop depth |
628 | 1472 char_depth_sim = stop_depth; |
1473 | |
1474 // Apply correction in case the stop is to be placed deeper than a | |
1475 // previously recorded stop for a gas change. This may happen because | |
1476 // the deco stops are placed at the next deeper multiple of 3 meters | |
1477 // instead of the real stop's depth. Correction is to relocate the | |
1478 // deco stop to the depth of the last gas change. The resulting combined | |
1479 // stop's duration will be the sum of the configured gas change time plus | |
1480 // the duration of the deco stop itself. | |
1481 if( 0 < internal_deco_depth[stop_index] ) | |
1482 if( char_depth_sim > internal_deco_depth[stop_index] ) | |
631 | 1483 char_depth_sim = internal_deco_depth[stop_index]; |
1484 | |
1485 // if using straight Buhlmann: done, stop needed | |
1486 if( char_I_model == 0 ) return(1); | |
623 | 1487 |
1488 // ----------------------------------------------------------------------- | |
628 | 1489 // we need to make or hold a stop and we are using the GF extension |
623 | 1490 // ----------------------------------------------------------------------- |
1491 | |
631 | 1492 // is the stop_depth deeper than the GF low depth reference used up to now? |
1493 if( stop_depth > GF_depth ) | |
623 | 1494 { |
631 | 1495 // YES - update the GF low depth reference |
1496 GF_depth = stop_depth; | |
1497 GF_slope = (GF_high - GF_low) / (float)GF_depth; | |
623 | 1498 |
1499 // store for use in next cycles | |
1500 if( deco_status & CALC_NORM ) | |
560 | 1501 { |
631 | 1502 GF_depth_norm = GF_depth; |
1503 GF_slope_norm = GF_slope; | |
582 | 1504 } |
560 | 1505 else |
1506 { | |
631 | 1507 GF_depth_alt = GF_depth; |
1508 GF_slope_alt = GF_slope; | |
560 | 1509 } |
623 | 1510 } |
1511 | |
631 | 1512 #ifdef _cave_mode |
1513 // if in cave mode: done, stop needed | |
1514 if( main_status & CAVE_MODE ) return(1); | |
1515 #endif | |
1516 | |
1517 // We have a stop depth candidate. But with a steep GF slope, the stop(s) after | |
1518 // this first stop may be allowed to ascent to, too. This is because the gradient | |
623 | 1519 // factor that will be used at the next depth(s) will allow more tissue super- |
631 | 1520 // saturation, maybe so much more that the next stop(s) will be allowed to ascent |
1521 // to. So we have to probe the next stops that are within the reach of 1 minute | |
1522 // of ascent as well. | |
1523 | |
1524 // compute depth in meters that is reachable within 1 minute of ascent at 10 m/min | |
1525 depth_1min = ( char_depth_sim > 10 ) ? char_depth_sim - 10 : 0; | |
623 | 1526 |
628 | 1527 // probe all stop depths that are in reach of 1 minute of ascent |
631 | 1528 next_stop = stop_depth; |
628 | 1529 |
1530 while(next_stop > 0) | |
623 | 1531 { |
631 | 1532 // compute the depth of the next stop to probe |
1533 if ( next_stop <= char_I_last_stop_depth ) next_stop = 0; | |
1534 else if ( next_stop == 6 ) next_stop = char_I_last_stop_depth; | |
628 | 1535 else next_stop -= 3; |
1536 | |
631 | 1537 // done if the next stop would be above the 1 minute limit |
1538 if( next_stop < depth_1min ) return(1); | |
1539 | |
1540 // compute the ceiling for the next stop depth | |
1541 calc_limit(GF_high - GF_slope * (float)next_stop); | |
1542 | |
1543 // done if the next stop would be above the ceiling | |
1544 if( next_stop < (unsigned char)(ceiling * BAR_TO_METER + 0.99) ) return(1); | |
1545 | |
1546 // the next stop depth is allowed, ascent to it and redo trying further stop | |
1547 char_depth_sim = next_stop; | |
582 | 1548 } |
1549 | |
631 | 1550 // reached the surface, done with no further stop |
1551 return(0); | |
0 | 1552 } |
1553 | |
604 | 1554 |
0 | 1555 ////////////////////////////////////////////////////////////////////////////// |
631 | 1556 // Take the actual currently used gas for ascent & deco calculation |
1557 // | |
1558 // Input: start_gas_num number of the gas/dil to start with (1..5 or 6) | |
623 | 1559 // |
1560 // Output: sim_gas_current_num 1..6 or 0 for the manually configured gas/dil | |
1561 // sim_gas_current_depth change depth (MOD) of the gas/dil in meters | |
560 | 1562 // |
628 | 1563 static void gas_take_current(void) |
560 | 1564 { |
631 | 1565 assert( 1 <= start_gas_num && start_gas_num <= 6 ); |
1566 | |
1567 | |
1568 // check origin of the gas/diluent to start with | |
1569 if( start_gas_num <= NUM_GAS ) | |
582 | 1570 { |
631 | 1571 // pre-configured gas/diluent |
1572 | |
1573 // set gas number | |
1574 sim_gas_current_num = sim_gas_last_num = start_gas_num; | |
1575 | |
1576 // set change depth | |
1577 sim_gas_current_depth = char_I_deco_gas_change[start_gas_num-1]; | |
628 | 1578 |
1579 // capture case of non-configured change depth | |
1580 if( sim_gas_current_depth == 0 ) sim_gas_current_depth = 255; | |
582 | 1581 } |
1582 else | |
560 | 1583 { |
631 | 1584 // on-the-fly configured gas/diluent ("gas 6") |
1585 | |
1586 // set gas number | |
1587 sim_gas_current_num = sim_gas_last_num = 0; | |
1588 | |
1589 // set change depth | |
604 | 1590 sim_gas_current_depth = char_I_gas6_depth; |
560 | 1591 } |
1592 } | |
1593 | |
1594 | |
1595 ////////////////////////////////////////////////////////////////////////////// | |
628 | 1596 // Find the gas with the shallowest change depth below or at the current depth |
560 | 1597 // |
623 | 1598 // Input: char_depth_sim simulated depth in meters |
1599 // sim_gas_current_num number of the currently used gas/dil | |
631 | 1600 // deco_gas_type[] types and state of the gases/dils |
1601 // char_I_deco_gas_change[] change depths of the gases/dils | |
623 | 1602 // |
628 | 1603 // Modified: sim_gas_best_num index of the gas (1..5) - only if return value is true |
1604 // sim_gas_best_depth switch depth - only if return value is true | |
623 | 1605 // |
1606 // Return value is TRUE if a better gas is available | |
560 | 1607 // |
628 | 1608 static unsigned char gas_find_best(void) |
560 | 1609 { |
641 | 1610 overlay unsigned char switch_depth = sim_gas_current_depth; |
604 | 1611 overlay unsigned char switch_gas = 0; |
631 | 1612 |
582 | 1613 |
628 | 1614 // loop over all gases to find the shallowest one below or at current depth |
604 | 1615 for( j = 0; j < NUM_GAS; ++j ) |
560 | 1616 { |
631 | 1617 // is this gas available? |
1618 if( ( deco_gas_type[j] & GAS_TYPE_MASK ) // gas enabled (type > 0) ? | |
1619 && !( deco_gas_type[j] & GAS_AVAIL_MASK ) // neither lost nor staged ? | |
1620 ) | |
1621 | |
1622 // is it not a deco gas unless: | |
1623 // extended stops are activated | |
1624 // OR we are on a deco stop | |
1625 // OR we are in bailout but not in cave mode | |
1626 if( ( ( deco_gas_type[j] & GAS_TYPE_MASK ) < 3 ) | |
1627 || ( ( main_status & EXTENDED_STOPS ) ) | |
1628 || ( ( deco_status & CALC_NORM ) && ( deco_info & DECO_STOPS_NORM ) ) | |
1629 || ( ( deco_status & CALC_ALT ) && ( deco_info & DECO_STOPS_ALT ) ) | |
1630 || ( ( deco_status & BAILOUT_MODE ) && !( main_status & CAVE_MODE ) ) | |
1631 ) | |
1632 | |
1633 // is the change depth of the this gas deeper than or | |
604 | 1634 // at least equal to the current depth? |
623 | 1635 if( char_I_deco_gas_change[j] >= char_depth_sim ) |
604 | 1636 |
631 | 1637 // is the change depth of this gas shallower than |
1638 // the change depth of the best gas found so far, | |
1639 // or is it the first better gas found? | |
1640 if( char_I_deco_gas_change[j] < switch_depth ) | |
628 | 1641 |
1642 #ifdef _gas_contingency | |
631 | 1643 // is there still enough of this gas or shall we don't care? |
1644 if( !(deco_gas_type[j] & GAS_FULLY_USED_UP ) | |
1645 || !( main_status & GAS_CONTINGENCY ) | |
1646 || !( main_status & CALC_VOLUME ) | |
1647 ) | |
628 | 1648 #endif |
604 | 1649 |
631 | 1650 // if there is a yes to all these questions, we have a better gas! |
560 | 1651 { |
628 | 1652 // memorize this gas (1..5) and its change depth |
1653 switch_gas = j+1; | |
1654 switch_depth = char_I_deco_gas_change[j]; | |
560 | 1655 } |
631 | 1656 |
560 | 1657 } // continue looping through all gases to eventually find an even better gas |
1658 | |
628 | 1659 // has a best gas been found? |
560 | 1660 if( switch_gas ) |
1661 { | |
628 | 1662 // YES - export the best gas and its change depth |
1663 sim_gas_best_num = switch_gas; | |
1664 sim_gas_best_depth = switch_depth; | |
1665 | |
1666 // is the best gas different from the current gas? | |
1667 if( sim_gas_best_num != sim_gas_current_num ) | |
1668 { | |
1669 // YES - signal advice for a gas change | |
1670 return 1; | |
1671 } | |
560 | 1672 } |
628 | 1673 |
1674 // no best gas found or current gas is the best gas | |
1675 return 0; | |
1676 } | |
1677 | |
1678 | |
1679 ////////////////////////////////////////////////////////////////////////////// | |
1680 // Switch to the best gas | |
1681 // | |
1682 // Input: sim_gas_best_num index of the best gas (1..5) | |
1683 // sim_gas_best_depth switch depth of the best gas | |
1684 // | |
1685 // Modified: sim_gas_current_num index of the new gas (1..5) | |
1686 // sim_gas_current_depth switch depth of the new gas | |
1687 // | |
1688 static void gas_take_best(void) | |
1689 { | |
631 | 1690 // memorize current gas as last gas used |
1691 sim_gas_last_num = sim_gas_current_num; | |
1692 | |
628 | 1693 // set new gas |
1694 sim_gas_current_num = sim_gas_best_num; | |
1695 sim_gas_current_depth = sim_gas_best_depth; | |
0 | 1696 } |
1697 | |
604 | 1698 |
0 | 1699 ////////////////////////////////////////////////////////////////////////////// |
623 | 1700 // Set calc_N2/He/O2_ratios by sim_gas_current_num |
1701 // | |
1702 // Input: sim_gas_current_num index of gas to use | |
1703 // real_O2_ratio, real_He_ratio if gas = 0 (the manually set gas) | |
1704 // char_I_deco_O2/He_ratio[] if gas = 1..5 (the configured gases) | |
1705 // | |
1706 // Output: sim_N2_ratio, sim_He_ratio ratios of the inert gases | |
1707 // sim_pSCR_drop ppO2 drop in pSCR loop | |
0 | 1708 // |
582 | 1709 static void gas_set_ratios(void) |
0 | 1710 { |
582 | 1711 overlay float sim_IG_ratio; |
1712 | |
623 | 1713 assert( 0 <= sim_gas_current_num <= NUM_GAS ); |
1714 | |
1715 | |
1716 #ifdef _helium | |
582 | 1717 // get gas ratios |
623 | 1718 if( sim_gas_current_num == 0 ) |
560 | 1719 { |
604 | 1720 sim_O2_ratio = real_O2_ratio; |
1721 sim_He_ratio = real_He_ratio; | |
560 | 1722 } |
1723 else | |
1724 { | |
623 | 1725 sim_O2_ratio = 0.01 * char_I_deco_O2_ratio[sim_gas_current_num-1]; |
1726 sim_He_ratio = 0.01 * char_I_deco_He_ratio[sim_gas_current_num-1]; | |
560 | 1727 } |
1728 | |
582 | 1729 // inert gas ratio (local helper variable) |
604 | 1730 sim_IG_ratio = 1.00 - sim_O2_ratio; |
582 | 1731 |
1732 // N2 ratio | |
604 | 1733 sim_N2_ratio = sim_IG_ratio - sim_He_ratio; |
623 | 1734 #else |
1735 // get O2 ratio | |
1736 sim_O2_ratio = ( sim_gas_current_num == 0 ) ? real_O2_ratio : 0.01 * char_I_deco_O2_ratio[sim_gas_current_num-1]; | |
1737 | |
1738 // set H2 ratio to zero | |
1739 sim_He_ratio = 0.0; | |
1740 | |
1741 // inert gas ratio (local helper variable) | |
1742 sim_IG_ratio = 1.00 - sim_O2_ratio; | |
1743 | |
1744 // N2 ratio | |
1745 sim_N2_ratio = sim_IG_ratio; | |
1746 #endif | |
1747 | |
1748 #ifdef _ccr_pscr | |
582 | 1749 // ppO2 drop in pSCR loop |
604 | 1750 sim_pSCR_drop = sim_IG_ratio * float_pSCR_factor; |
623 | 1751 #endif |
582 | 1752 |
1753 | |
1754 assert( 0.0 <= sim_N2_ratio && sim_N2_ratio <= 0.95 ); | |
1755 assert( 0.0 <= sim_He_ratio && sim_He_ratio <= 0.95 ); | |
1756 assert( (sim_N2_ratio + sim_He_ratio) <= 0.95 ); | |
0 | 1757 } |
1758 | |
604 | 1759 |
0 | 1760 ////////////////////////////////////////////////////////////////////////////// |
604 | 1761 // Compute respired ppO2, ppN2 and ppHe |
0 | 1762 // |
631 | 1763 // Input: tissue_increment : selector for simulated/real tissues and gases |
623 | 1764 // main_status : breathing mode for real tissues |
1765 // deco_status : breathing mode for simulated tissues | |
604 | 1766 // sim_/real_O2_ratio : (simulated) O2 ratio breathed |
1767 // sim_/real_N2_ratio : (simulated) N2 ratio breathed | |
1768 // sim_/real_He_ratio : (simulated) He ratio breathed | |
1769 // sim_/real_pres_respiration : (simulated) respiration pressure [bar] | |
1770 // sim_/real_pSCR_drop : (simulated) pSCR O2 drop | |
1771 // pres_surface : surface pressure [bar] | |
1772 // char_I_const_ppO2 : ppO2 reported from sensors or setpoint [cbar] | |
1773 // ppWater : water-vapor pressure inside respiratory tract [bar] | |
0 | 1774 // |
604 | 1775 // Output: ppN2 : respired N2 partial pressure |
1776 // ppHe : respired He partial pressure | |
623 | 1777 // char_ppO2 : breathed ppO2 in %, used for CNS calculation |
0 | 1778 // |
582 | 1779 void calc_alveolar_pressures(void) |
0 | 1780 { |
604 | 1781 overlay float calc_pres_respiration; |
582 | 1782 overlay float calc_O2_ratio; |
1783 overlay float calc_N2_ratio; | |
623 | 1784 |
1785 #ifdef _helium | |
582 | 1786 overlay float calc_He_ratio; |
623 | 1787 #endif |
1788 | |
1789 #ifdef _ccr_pscr | |
582 | 1790 overlay float calc_pSCR_drop; |
623 | 1791 #endif |
582 | 1792 |
1793 overlay unsigned char status; | |
1794 | |
1795 | |
623 | 1796 assert( 0.00 <= real_N2_ratio && real_N2_ratio <= 1.00 ); |
1797 assert( 0.00 <= real_He_ratio && real_He_ratio <= 1.00 ); | |
1798 assert( (real_N2_ratio + real_He_ratio) <= 1.00 ); | |
604 | 1799 assert( 0.800 < real_pres_respiration && real_pres_respiration < 14.0 ); |
1800 | |
623 | 1801 assert( 0.00 <= sim_N2_ratio && real_N2_ratio <= 1.00 ); |
1802 assert( 0.00 <= sim_He_ratio && real_He_ratio <= 1.00 ); | |
1803 assert( (sim_N2_ratio + sim_He_ratio) <= 1.00 ); | |
582 | 1804 assert( 0.800 < sim_pres_respiration && sim_pres_respiration < 14.0 ); |
1805 | |
1806 | |
1807 // get input data according to context | |
623 | 1808 if( tissue_increment & TISSUE_SELECTOR ) |
582 | 1809 { |
1810 //---- real tissues ----------------------------------------------------------- | |
604 | 1811 calc_pres_respiration = real_pres_respiration; |
623 | 1812 |
1813 status = main_status; | |
604 | 1814 calc_O2_ratio = real_O2_ratio; |
1815 calc_N2_ratio = real_N2_ratio; | |
623 | 1816 |
1817 #ifdef _helium | |
604 | 1818 calc_He_ratio = real_He_ratio; |
623 | 1819 #endif |
1820 | |
1821 #ifdef _ccr_pscr | |
1822 calc_pSCR_drop = real_pSCR_drop; | |
1823 #endif | |
582 | 1824 } |
1825 else | |
1826 { | |
1827 //---- simulated tissues ------------------------------------------------------ | |
623 | 1828 |
640 | 1829 #ifdef _cave_mode |
1830 // in cave mode? | |
1831 if( !(main_status & CAVE_MODE) ) | |
1832 { | |
1833 #endif | |
1834 | |
1835 // (NO) - correct sim_pres_respiration if shallower than calculated stop depth | |
1836 calc_pres_respiration = ( real_pres_respiration < sim_pres_respiration ) ? real_pres_respiration : sim_pres_respiration; | |
1837 | |
1838 #ifdef _cave_mode | |
1839 } | |
1840 #endif | |
1841 | |
628 | 1842 |
623 | 1843 status = deco_status; |
604 | 1844 calc_O2_ratio = sim_O2_ratio; |
1845 calc_N2_ratio = sim_N2_ratio; | |
623 | 1846 |
1847 #ifdef _helium | |
604 | 1848 calc_He_ratio = sim_He_ratio; |
623 | 1849 #endif |
1850 | |
1851 #ifdef _ccr_pscr | |
1852 calc_pSCR_drop = sim_pSCR_drop; | |
1853 #endif | |
582 | 1854 } |
1855 | |
1856 //---- OC, CCR and Bailout Mode Gas Calculations ----------------------------------- | |
1857 | |
1858 // calculate ppO2 of pure oxygen | |
631 | 1859 ppO2_O2 = calc_pres_respiration - ppWater; |
604 | 1860 |
1861 // capture failure condition in case real_pres_respiration is < ppWater (should never happen...) | |
631 | 1862 if( ppO2_O2 < 0.0 ) ppO2_O2 = 0.0; |
582 | 1863 |
602 | 1864 // calculate ppO2 of the pure gas (OC, diluent) |
631 | 1865 ppO2_OC = ppO2_O2 * calc_O2_ratio; |
582 | 1866 |
623 | 1867 #ifdef _ccr_pscr |
1868 | |
582 | 1869 // calculate pSCR ppO2 |
631 | 1870 ppO2_pSCR = ppO2_OC - calc_pSCR_drop; |
1871 | |
1872 // capture failure condition in case ppO2_pSCR becomes negative | |
1873 if( ppO2_pSCR < 0.0 ) ppO2_pSCR = 0.0; | |
582 | 1874 |
1875 | |
1876 //---- Loop modes : adjust ppN2 and ppHe for change in ppO2 due to setpoint (CCR) or drop (pSCR) --- | |
623 | 1877 if( status & MODE_LOOP ) |
582 | 1878 { |
1879 overlay float const_ppO2; | |
604 | 1880 overlay float max_ppO2; |
582 | 1881 |
1882 // get the current sensor reading (CCR / pSCR if fitted) or the fixed setpoint (CCR) / a zero (pSCR) | |
1883 const_ppO2 = 0.01 * char_I_const_ppO2; | |
1884 | |
1885 // Limit the setpoint to the maximum physically possible ppO2. This prevents for | |
1886 // example calculating with a setpoint of 1.3 bar in only 2 meters of depth. | |
604 | 1887 // Additionally, the ppO2 can be further reduced to account for exhaled inert gases |
623 | 1888 // accumulating in the loop by the user-adjustable setting char_I_CC_max_frac_O2. |
604 | 1889 // (ppWater is neglected here) |
623 | 1890 max_ppO2 = 0.01 * char_I_CC_max_frac_O2 * calc_pres_respiration; |
604 | 1891 |
1892 if( const_ppO2 > max_ppO2 ) const_ppO2 = max_ppO2; | |
582 | 1893 |
1894 // check which kind of loop we are on | |
623 | 1895 if( status & MODE_PSCR ) |
560 | 1896 { |
582 | 1897 //---- pSCR Mode -------------------------------------------------------------------------- |
1898 | |
631 | 1899 // Use the sensor value if available and in real tissue context, else use calculated ppO2. |
1900 ppO2 = ( char_I_const_ppO2 && (tissue_increment & TISSUE_SELECTOR)) ? const_ppO2 : ppO2_pSCR; | |
582 | 1901 } |
560 | 1902 else |
1903 { | |
582 | 1904 //---- CCR Mode --------------------------------------------------------------------------- |
1905 | |
604 | 1906 // derive breathed ppO2 from (char_I_)const_ppO2, which holds sensor reading or selected setpoint |
582 | 1907 ppO2 = const_ppO2; |
560 | 1908 } |
1909 | |
604 | 1910 // adjust overall gas pressure for change in ppO2 due to setpoint (CCR) or drop (pSCR), |
1911 // capture potential failure conditions first: | |
1912 if( ( calc_pres_respiration < ppO2 ) // sensor reading or selected setpoint is higher than ambient pressure | |
623 | 1913 || ( calc_O2_ratio > 0.995 ) ) // diluent is pure O2, i.e. calc_N2_ratio + calc_He_ratio = 0 would give a div/0 |
560 | 1914 { |
604 | 1915 // failure condition present, set predetermined result |
1916 calc_pres_respiration = 0.0; | |
1917 } | |
1918 else | |
1919 { | |
1920 // no failure conditions present, equation can be executed | |
1921 calc_pres_respiration -= ppO2; | |
623 | 1922 #ifdef _helium |
604 | 1923 calc_pres_respiration /= calc_N2_ratio + calc_He_ratio; |
623 | 1924 #else |
1925 calc_pres_respiration /= calc_N2_ratio; | |
1926 #endif | |
560 | 1927 } |
582 | 1928 } |
1929 else | |
623 | 1930 #endif // _ccr_pscr |
604 | 1931 { |
1932 //---- OC mode --------------------------------------------------------------------------------- | |
582 | 1933 |
1934 // breathed ppO2 is ppO2 of pure gas | |
631 | 1935 ppO2 = ppO2_OC; |
560 | 1936 } |
1937 | |
582 | 1938 |
604 | 1939 //---- derive char_ppO2 in [cbar], used for calculating CNS% --------------------------------------- |
1940 | |
582 | 1941 if ( ppO2 < 0.01 ) char_ppO2 = 0; |
1942 else if ( ppO2 >= 2.545 ) char_ppO2 = 255; | |
1943 else char_ppO2 = (unsigned char)(100 * ppO2 + 0.5); | |
1944 | |
1945 | |
1946 //---- calculate ppN2 and ppHe --------------------------------------------------------------------- | |
1947 | |
604 | 1948 // compute ppN2 and ppHe, capture potential failure conditions first: |
1949 if( calc_pres_respiration > ppWater ) | |
582 | 1950 { |
604 | 1951 // subtract water vapor pressure |
1952 calc_pres_respiration -= ppWater; | |
1953 | |
1954 // calculate partial pressures | |
1955 ppN2 = calc_N2_ratio * calc_pres_respiration; | |
623 | 1956 |
1957 #ifdef _helium | |
604 | 1958 ppHe = calc_He_ratio * calc_pres_respiration; |
623 | 1959 #else |
1960 ppHe = 0.0; | |
1961 #endif | |
1962 | |
582 | 1963 } |
1964 else | |
1965 { | |
604 | 1966 // calculated respired pressure is < water vapor pressure, thus set ppN2 and ppHe to 0 |
582 | 1967 ppN2 = 0.0; |
1968 ppHe = 0.0; | |
1969 } | |
628 | 1970 |
634 | 1971 #ifdef _ccr_pscr |
628 | 1972 // calculating real tissues? |
1973 if( tissue_increment & TISSUE_SELECTOR ) | |
1974 { | |
1975 overlay unsigned char temp; | |
1976 | |
1977 // compute gas density of current mix in multiples of 0.01 grams per liter | |
643 | 1978 int_O_gas_density = (unsigned int)( GAS_DENSITY_He_FACTOR * ppHe + GAS_DENSITY_N2_FACTOR * ppN2 + GAS_DENSITY_O2_FACTOR * ppO2 ); |
628 | 1979 |
634 | 1980 // convert gas density into an 8 bit integer, scaling 0.1 grams per liter |
628 | 1981 temp = (unsigned char)( (int_O_gas_density + 9) / 10 ); |
1982 | |
1983 // limit to display max and set warning or attention flag | |
634 | 1984 if( temp > 99 ) int_O_gas_density = 999 | INT_FLAG_WARNING; |
1985 else if( temp >= char_I_gas_density_warn ) int_O_gas_density |= INT_FLAG_WARNING; | |
1986 else if( temp >= char_I_gas_density_att ) int_O_gas_density |= INT_FLAG_ATTENTION; | |
628 | 1987 } |
1988 #endif | |
0 | 1989 } |
1990 | |
604 | 1991 |
0 | 1992 ////////////////////////////////////////////////////////////////////////////// |
623 | 1993 // Initializes all output variables to their default values |
1994 // | |
1995 static void init_output_vars(void) | |
1996 { | |
1997 // clear the internal stops table from remains lasting from the previous dive or deco calculator run | |
1998 clear_deco_table(); | |
1999 | |
2000 // publish the cleared stops table to the display functions | |
2001 publish_deco_table(); | |
2002 | |
2003 // clear the published gas needs in volume and pressure | |
2004 for( i = 0; i < NUM_GAS; ++i ) | |
2005 { | |
2006 int_O_gas_need_vol[i] = 0; | |
2007 int_O_gas_need_pres[i] = 0 + INT_FLAG_ZERO + INT_FLAG_INVALID; | |
2008 } | |
2009 | |
2010 // values initially to be set to zero | |
2011 int_O_ceiling = 0; // ceiling depth in mbar | |
2012 char_O_deco_info = 0; // clear all deco information flags | |
2013 char_O_deco_warnings = 0; // clear all deco warning flags | |
2014 | |
2015 // default desaturation time to 24 hours (it will not be computed during a dive) | |
2016 int_O_desaturation_time = 1440; | |
2017 | |
2018 // initialize CNS values | |
2019 int_O_CNS_norm = 0 + INT_FLAG_INVALID; | |
2020 int_O_CNS_alt = 0 + INT_FLAG_INVALID; | |
2021 | |
2022 // initialize NDL times | |
631 | 2023 int_O_NDL_norm = 240; |
2024 int_O_NDL_alt = 240; | |
2025 | |
2026 // initialize stop times | |
2027 int_O_TST_norm = 0; | |
2028 int_O_TST_alt = 0 + INT_FLAG_INVALID + INT_FLAG_NOT_COMPUTED_YET + INT_FLAG_ZERO; | |
2029 | |
2030 | |
2031 // initialize ascent / return times | |
623 | 2032 int_O_TTS_norm = 0; |
2033 int_O_TTS_alt = 0 + INT_FLAG_INVALID + INT_FLAG_NOT_COMPUTED_YET; | |
2034 | |
2035 #ifdef _rx_functions | |
2036 // clear TR values | |
2037 int_O_SAC_measured = 0 + INT_FLAG_NOT_AVAIL; // SAC rate | |
2038 int_O_pressure_need[0] = 0 + INT_FLAG_NOT_AVAIL; // pressure need to reading 1 | |
2039 int_O_pressure_need[1] = 0 + INT_FLAG_NOT_AVAIL; // pressure need to reading 2 | |
628 | 2040 int_O_tank_pressure = 0; // tank pressure for logging |
623 | 2041 #endif |
2042 | |
628 | 2043 #ifdef _helium |
2044 int_O_gas_density = 0; | |
2045 #endif | |
2046 | |
2047 // also clear any time++ request | |
2048 char_I_sim_advance_time = 0; | |
623 | 2049 } |
2050 | |
2051 | |
2052 ////////////////////////////////////////////////////////////////////////////// | |
2053 // Reset all tissues to surface pressure equilibrium state | |
2054 // | |
2055 // Input: int_I_pres_surface current surface pressure in hPa (mbar) | |
2056 // | |
2057 // Output: real_pres_tissue_N2[] partial pressure of N2 in real tissues | |
2058 // real_pres_tissue_He[] partial pressure of He in real tissues | |
2059 // char_O_tissue_pres_N2[] partial pressure of N2 for tissue graphics | |
2060 // char_O_tissue_pres_He[] partial pressure of He for tissue graphics | |
2061 // char_O_tissue_pressure[] total pressure for tissue graphics | |
2062 // CNS_fraction_real internal CNS value | |
2063 // int_O_CNS_current current CNS value | |
2064 // int_O_CNS_norm CNS value at end of normal dive plan | |
2065 // int_O_CNS_alt CNS value at end of alternative dive plan | |
2066 // char_O_deco_warnings deco warnings vector | |
631 | 2067 // int_O_NDL_norm remaining NDL time in normal dive plan |
2068 // int_O_NDL_alt remaining NDL time in alternative dive plan | |
623 | 2069 // int_O_TTS_norm ascent time (TTS) in normal dive plan |
2070 // int_O_TTS_alt ascent time (TTS) in alternative dive plan | |
2071 // int_O_lead_supersat supersaturation of the leading tissue | |
0 | 2072 // |
2073 static void clear_tissue(void) | |
2074 { | |
623 | 2075 // safeguard and convert the surface pressure (mbar -> bar) (*) |
2076 if( int_I_pres_surface < 500 ) pres_surface = 0.500; | |
2077 else pres_surface = 0.001 * int_I_pres_surface; | |
2078 | |
2079 // calculate partial pressure of N2 in respired air at surface pressure | |
2080 calc_N2_equilibrium(); | |
2081 | |
2082 // cycle through the 16 Buhlmann tissues | |
604 | 2083 for( ci = 0; ci < NUM_COMP; ci++ ) |
582 | 2084 { |
623 | 2085 // reset tissue pressures |
2086 real_pres_tissue_He[ci] = 0.0; // He | |
2087 real_pres_tissue_N2[ci] = N2_equilibrium; // N2 | |
2088 | |
650 | 2089 real_pres_delta_He[ci] = 0.0; // He |
2090 real_pres_delta_N2[ci] = 0.0; // N2 | |
2091 | |
629 | 2092 // reset tissue pressures for scaled tissue graphics |
631 | 2093 char_O_tissue_pres_He[ci] = 0; // He |
623 | 2094 char_O_tissue_pres_N2[ci] = 10; // N2 |
2095 char_O_tissue_pressure[ci] = 10; // combined | |
582 | 2096 } |
2097 | |
2098 // reset CNS values | |
623 | 2099 CNS_fraction_real = 0.0; |
2100 int_O_CNS_current = int_O_CNS_norm = int_O_CNS_alt = 0; | |
582 | 2101 |
2102 // reset some more vars to their defaults | |
631 | 2103 int_O_NDL_norm = 240; |
2104 int_O_NDL_alt = 240; | |
2105 int_O_TST_norm = 0; | |
2106 int_O_TST_alt = 0 + INT_FLAG_ZERO; | |
2107 int_O_TTS_norm = 0; | |
2108 int_O_TTS_alt = 0; | |
2109 int_O_lead_supersat = 0; | |
623 | 2110 |
2111 // reset all warning and info flags | |
631 | 2112 char_O_deco_warnings = 0; |
2113 char_O_deco_info = 0; | |
0 | 2114 } |
2115 | |
582 | 2116 |
0 | 2117 ////////////////////////////////////////////////////////////////////////////// |
628 | 2118 // Deco engine main code |
0 | 2119 // |
623 | 2120 // This is the major code in dive mode, it calculates the tissue pressures, |
2121 // the bottom time, and it calculates the ascend with all deco stops, etc. | |
2122 // | |
2123 // Input: char_O_main_status deco engine control and real tissues mode | |
2124 // char_O_deco_status deco engine control and simulated tissues mode | |
2125 // char_I_sim_advance_time mailbox for bottom time incrementing | |
2126 // | |
2127 // char_I_SAC_work gas usage rate during working phase in l/min | |
2128 // char_I_SAC_deco gas usage rate during deco stops phase in l/min | |
2129 // | |
631 | 2130 // char_I_model selector for GF extension |
623 | 2131 // char_I_saturation_multiplier safety factor for tissue saturation |
2132 // char_I_desaturation_multiplier safety factor for tissue desaturation | |
2133 // | |
631 | 2134 // char_I_pressure_gas[] amount of gas available for ascent / cave return in bar |
623 | 2135 // int_I_pressure_drop[] pressure drop used to calculate SAC rate |
2136 // char_I_gas_avail_size[] size of the tanks in liters | |
2137 // | |
2138 // Output: int_O_O2_ppO2 partial pressure of pure O2 at current depth | |
2139 // int_O_pure_ppO2 partial pressure of O2 in gas at current depth | |
2140 // int_O_pSCR_ppO2 partial pressure of O2 in gas at current depth, corrected for pSCR mode | |
2141 // int_O_breathed_ppO2 partial pressure of O2 currently breathed | |
2142 // | |
2143 // char_O_deco_status deco engine computations status | |
2144 // char_O_deco_info deco engine information vector | |
2145 // char_O_deco_warnings deco engine warnings vector | |
2146 // | |
631 | 2147 // int_O_NDL_norm remaining NDL time in normal dive plan |
2148 // int_O_NDL_alt remaining NDL time in alternative dive plan | |
623 | 2149 // int_O_TTS_norm ascent time (TTS) in normal dive plan |
2150 // int_O_TTS_alt ascent time (TTS) in alternative dive plan | |
2151 // int_O_CNS_norm CNS value at end of normal dive plan | |
2152 // int_O_CNS_alt CNS value at end of alternative dive plan | |
2153 // | |
631 | 2154 // int_O_gas_need_vol[] calculated gas volumes needed for ascent / cave return |
2155 // int_O_gas_need_pres[] calculated gas pressures needed for ascent / cave return | |
623 | 2156 // |
2157 // int_O_SAC_measured measured surface air consumption (SAC) rate in l/min | |
2158 // | |
2159 // Modified: int_IO_pressure_value[] warning flags added to pressure reading 1 & 2 | |
2160 // int_IO_pressure_need[] pressure needs to pressure reading 1 & 2 | |
0 | 2161 // |
2162 static void calc_hauptroutine(void) | |
2163 { | |
623 | 2164 overlay unsigned short int_ppO2_min; |
628 | 2165 overlay unsigned short int_ppO2_max_warn; |
2166 overlay unsigned short int_ppO2_max_att; | |
623 | 2167 overlay unsigned short int_ppO2_max_dil; |
631 | 2168 overlay float EAD_pres; |
2169 overlay float END_pres; | |
623 | 2170 |
2171 //============================================================================================= | |
2172 | |
2173 // | |
2174 //--- Setup Part --------------------------------------------------------------------------------- | |
2175 // | |
2176 | |
2177 // set time limit for preempting deco calculations, timer is 16 bit and increments every 1/32 ms | |
2178 tmr5_value = 65535 - (32 * BUDGET_PER_SECOND / INVOKES_PER_SECOND); | |
2179 | |
2180 // load timer | |
2181 load_tmr5(); | |
2182 | |
2183 // read command flags and set up what to do | |
2184 switch( char_O_deco_status & COMMAND_MASK ) | |
560 | 2185 { |
623 | 2186 |
2187 case INITIALIZE: | |
2188 case INITIALIZE_START_NORM: | |
2189 case INITIALIZE_START_ALT: | |
2190 | |
2191 // copy master modes to shadow registers | |
2192 main_status = char_O_main_status; | |
2193 deco_status = char_O_deco_status; | |
2194 | |
650 | 2195 // clear all command flags on the master mode to signal that the command is read and in processing |
623 | 2196 char_O_deco_status &= ~COMMAND_MASK; |
2197 | |
2198 // clear the initialization flag on the shadow copy | |
2199 deco_status &= ~INITIALIZE; | |
2200 | |
2201 // initialize the sequence timer | |
2202 sequence_timer = 0; | |
2203 | |
2204 // set the calculation phase to start with to doing the once-per-dive initialization | |
2205 next_planning_phase = PHASE_10_DIVE_INIT; | |
2206 | |
2207 break; | |
2208 | |
2209 | |
2210 case START_NORM: | |
2211 case START_ALT: | |
2212 | |
2213 // copy master modes to shadow registers | |
2214 main_status = char_O_main_status; | |
2215 deco_status = char_O_deco_status; | |
2216 | |
650 | 2217 // clear all command flags on the master mode to signal that the command is read and in processing |
623 | 2218 char_O_deco_status &= ~COMMAND_MASK; |
2219 | |
2220 // set the calculation phase to start with to doing the cyclic initialization | |
628 | 2221 next_planning_phase = PHASE_20_CYCLIC_INIT; |
623 | 2222 |
2223 // continue in CALCULATING | |
2224 | |
2225 | |
2226 case CALCULATING: | |
2227 | |
2228 // keep current calculation phase | |
2229 | |
2230 // step the sequence timer | |
2231 sequence_timer = (sequence_timer < INVOKES_PER_SECOND * 2 - 1) ? sequence_timer + 1 : 0; | |
2232 | |
2233 break; | |
560 | 2234 } |
2235 | |
582 | 2236 |
623 | 2237 // |
2238 //--- End of Setup Part ----------------------------------------------------------------------- | |
2239 // | |
2240 | |
2241 //============================================================================================= | |
2242 | |
2243 // | |
2244 //---- Calculations Part (real Tissues) ------------------------------------------------------- | |
2245 // | |
2246 | |
582 | 2247 |
604 | 2248 // target the real tissues with 2 second increments by default |
623 | 2249 tissue_increment = TISSUE_SELECTOR | 0; |
2250 | |
2251 | |
2252 // Tasks every second, if more than 1 invocation per second: on the first section of the second. | |
2253 // Requests for tissue "fast forward" are executed immediately. | |
2254 #if (INVOKES_PER_SECOND > 1) | |
2255 if( ( sequence_timer == 0 ) | |
2256 || ( sequence_timer == INVOKES_PER_SECOND ) | |
2257 || ( char_I_sim_advance_time > 0 ) | |
2258 ) | |
2259 #endif | |
584 | 2260 { |
623 | 2261 // acquire current environmental data |
2262 calc_hauptroutine_data_input(); | |
2263 | |
628 | 2264 // calculate ppO2, ppN2 and ppHe for real tissues |
623 | 2265 calc_alveolar_pressures(); |
2266 | |
2267 // add decent calculation here and include trigger in above if-statement | |
2268 // TODO | |
2269 | |
2270 } // tasks every second, on the first section of the second | |
2271 | |
2272 | |
2273 // Tasks every 2 seconds, on the first section of the respective second. | |
2274 // Requests for tissue "fast forward" are executed immediately. | |
2275 if( ( sequence_timer == 0 ) | |
2276 || ( char_I_sim_advance_time > 0 ) | |
2277 ) | |
2278 { | |
2279 // Tissue and CNS updates are based on 2 seconds periods! | |
2280 | |
604 | 2281 // Set up normal tissue updating or "fast forward" updating for simulator |
2282 // sim+5' function and deco calculator bottom time calculation. | |
2283 if( char_I_sim_advance_time > 0 ) | |
2284 { | |
2285 // configure "fast forward" tissue updating | |
623 | 2286 tissue_increment = TISSUE_SELECTOR | char_I_sim_advance_time; |
2287 | |
2288 // clear the request | |
604 | 2289 char_I_sim_advance_time = 0; |
2290 } | |
2291 | |
584 | 2292 // calculate the real tissues |
2293 calc_tissues(); | |
2294 | |
604 | 2295 // update the CNS value for the real tissues |
2296 calc_CNS(); | |
2297 | |
2298 // calculate ceiling (at GF_high or 100%) and leading tissue supersaturation | |
631 | 2299 if ( char_I_model ) calc_limit(GF_high); // GF factors enabled |
2300 else calc_limit( 1.0 ); // classic Buhlmann | |
623 | 2301 |
2302 // convert the ceiling value to integer | |
604 | 2303 convert_ceiling_for_display(); |
2304 | |
623 | 2305 // convert the saturation value of the leading tissue to integer |
2306 convert_sat_for_display(); | |
2307 | |
2308 // convert the CNS value to integer | |
2309 convert_cur_CNS_for_display(); | |
2310 | |
2311 } // tasks every 2 seconds | |
2312 | |
2313 | |
2314 // Tasks every second, if more than 1 invocation per second: on the first section of the second. | |
2315 #if (INVOKES_PER_SECOND > 1) | |
2316 if( ( sequence_timer == 0 ) | |
2317 || ( sequence_timer == INVOKES_PER_SECOND ) | |
2318 ) | |
2319 #endif | |
582 | 2320 { |
623 | 2321 //---- Calculate and Export EAD and END ------------------------------------------------------ |
2322 | |
631 | 2323 // calculate EAD (Equivalent Air Depth) as pressure in [bar]: |
2324 // equivalent depth for the same N2 level with plain air | |
2325 EAD_pres = ppN2 / 0.7902 + ppWater - pres_surface; | |
2326 | |
2327 // calculate END (Equivalent Narcotic Depth) as pressure in [bar]: | |
2328 // as before, but with O2 treated as narcotic, too | |
2329 // Source: The Physiology and Medicine of Diving by Peter Bennett and David Elliott, | |
2330 // 4th edition, 1993, W.B.Saunders Company Ltd, London. | |
2331 END_pres = real_pres_respiration - ppHe - pres_surface; | |
2332 | |
2333 | |
2334 // export EAD, factor 10 is because conversion delivers in [cbar] but we need [mbar] | |
2335 float_value = EAD_pres; convert_float_to_int(); int_O_EAD_pres = int_value * 10; | |
2336 | |
2337 // export END, factor 10 is because conversion delivers in [cbar] but we need [mbar] | |
2338 float_value = END_pres; convert_float_to_int(); int_O_END_pres = int_value * 10; | |
623 | 2339 |
2340 | |
2341 //---- Compute ppO2 Values in [cbar] --------------------------------------------------------- | |
2342 | |
2343 float_value = ppO2; convert_float_to_int(); int_O_breathed_ppO2 = int_value; // breathed gas | |
2344 #ifdef _ccr_pscr | |
631 | 2345 float_value = ppO2_O2; convert_float_to_int(); int_O_O2_ppO2 = int_value; // pure oxygen |
2346 float_value = ppO2_OC; convert_float_to_int(); int_O_pure_ppO2 = int_value; // pure gas | |
2347 float_value = ppO2_pSCR; convert_float_to_int(); int_O_pSCR_ppO2 = int_value; // pSCR calculated | |
623 | 2348 #endif |
2349 | |
2350 | |
628 | 2351 //---- Set/Clear Deco Mode ------------------------------------------------------------------ |
2352 | |
2353 // Clear the deco mode flag if: | |
2354 // deco mode is set | |
2355 // AND we are deeper than 7 meters below the deepest deco stop | |
2356 // (7 meters chosen as to be 2 stop depth intervals plus 1 additional meter below) | |
2357 if ( ( deco_info & DECO_MODE ) > 0 ) | |
2358 if ( ( char_depth_real ) > char_O_deco_depth[0] + 7 ) | |
650 | 2359 deco_info &= ~DECO_MODE; |
623 | 2360 |
2361 // Set the deco mode flag if: | |
2362 // deco mode is not set | |
2363 // AND breathing an OC deco gas (gas type 3) | |
2364 // OR breathing a gas or diluent that officially is disabled (type 0) | |
628 | 2365 // OR there is a deco stop |
631 | 2366 // |
2367 // Remark: when breathing a gas, its lost & staged flags are cleared | |
2368 // | |
628 | 2369 if ( ( deco_info & DECO_MODE ) == 0 ) |
2370 if ( ( char_I_current_gas_type == 3 ) | |
2371 || ( char_I_current_gas_type == 0 ) | |
2372 || ( char_O_deco_depth[0] > 0 ) | |
623 | 2373 ) |
650 | 2374 deco_info |= DECO_MODE; |
623 | 2375 |
2376 | |
2377 //---- Compute ppO2 Warnings ------------------------------------------------------------------ | |
2378 | |
628 | 2379 // compute conditional min value |
623 | 2380 #ifdef _ccr_pscr |
2381 int_ppO2_min = ( main_status & MODE_LOOP ) ? (unsigned short)char_I_ppO2_min_loop : (unsigned short)char_I_ppO2_min; | |
2382 #else | |
2383 int_ppO2_min = (unsigned short)char_I_ppO2_min; | |
2384 #endif | |
2385 | |
628 | 2386 // determine the absolute max value (should be the deco one, but who knows...) |
2387 int_ppO2_max_warn = ( char_I_ppO2_max_work > char_I_ppO2_max_deco) ? char_I_ppO2_max_work : char_I_ppO2_max_deco; | |
2388 | |
2389 // add some margin to compensate for surface pressures > 1.000 mbar | |
2390 int_ppO2_max_warn += ppO2_MARGIN_ON_MAX; | |
2391 | |
2392 // determine the normal max value | |
2393 int_ppO2_max_att = ( deco_info & DECO_MODE ) ? (unsigned short)char_I_ppO2_max_deco : (unsigned short)char_I_ppO2_max_work; | |
2394 | |
2395 // add some margin to compensate for surface pressures > 1.000 mbar | |
2396 int_ppO2_max_att += ppO2_MARGIN_ON_MAX; | |
623 | 2397 |
2398 #ifdef _ccr_pscr | |
628 | 2399 // default value for the upper diluent ppO2 warning threshold is the upper warning threshold |
2400 int_ppO2_max_dil = int_ppO2_max_warn; | |
2401 | |
2402 // when enabled and in CCR mode, the upper diluent warning threshold gets adjust according to the current setpoint | |
631 | 2403 if( char_I_dil_check ) |
623 | 2404 if( (main_status & MODE_MASK) == MODE_CCR ) |
2405 { | |
2406 overlay unsigned short max_dil; | |
2407 | |
2408 // The upper diluent ppO2 threshold is ppO2_GAP_TO_SETPOINT below the setpoint... | |
2409 // (the condition protects from negative numbers which would cause a wrap-around in unsigned integers) | |
2410 max_dil = (char_I_const_ppO2 > ppO2_GAP_TO_SETPOINT) ? (unsigned short)(char_I_const_ppO2 - ppO2_GAP_TO_SETPOINT) : 0; | |
2411 | |
628 | 2412 // ...but never above int_ppO2_max_warn |
2413 if( max_dil < int_ppO2_max_warn ) int_ppO2_max_dil = max_dil; | |
623 | 2414 |
2415 // We do not need to guard int_ppO2_max_dil against becoming lower than char_I_ppO2_min because the check | |
2416 // against char_I_ppO2_min is done first and will then raise a low warning and inhibit further checks. | |
2417 } | |
2418 #endif | |
2419 | |
2420 // check for safe range of breathed gas | |
628 | 2421 if ( int_O_breathed_ppO2 <= int_ppO2_min ) int_O_breathed_ppO2 |= INT_FLAG_WARNING + INT_FLAG_LOW; |
2422 else if ( int_O_breathed_ppO2 >= int_ppO2_max_warn ) int_O_breathed_ppO2 |= INT_FLAG_WARNING + INT_FLAG_HIGH; | |
2423 else if ( deco_info & DECO_MODE ) ; // no attention generated in deco mode | |
2424 else if ( main_status & MODE_LOOP ) ; // no attention generated in loop modes | |
2425 else if ( int_O_breathed_ppO2 >= int_ppO2_max_att ) int_O_breathed_ppO2 |= INT_FLAG_ATTENTION; | |
623 | 2426 |
2427 #ifdef _ccr_pscr | |
2428 // check for safe range of pure oxygen | |
628 | 2429 if ( int_O_O2_ppO2 >= int_ppO2_max_warn ) int_O_O2_ppO2 |= INT_FLAG_WARNING + INT_FLAG_HIGH; |
623 | 2430 |
2431 // check for safe range of pure diluent | |
628 | 2432 if ( int_O_pure_ppO2 <= (unsigned short)char_I_ppO2_min ) int_O_pure_ppO2 |= INT_FLAG_WARNING + INT_FLAG_LOW; |
2433 else if ( int_O_pure_ppO2 >= int_ppO2_max_warn ) int_O_pure_ppO2 |= INT_FLAG_WARNING + INT_FLAG_HIGH; | |
2434 else if ( int_O_pure_ppO2 >= int_ppO2_max_dil ) int_O_pure_ppO2 |= INT_FLAG_ATTENTION; | |
623 | 2435 |
2436 // check for safe range of calculated pSCR loop gas | |
628 | 2437 if ( int_O_pSCR_ppO2 <= int_ppO2_min ) int_O_pSCR_ppO2 |= INT_FLAG_WARNING + INT_FLAG_LOW; |
2438 else if ( int_O_pSCR_ppO2 >= int_ppO2_max_warn ) int_O_pSCR_ppO2 |= INT_FLAG_WARNING + INT_FLAG_HIGH; | |
623 | 2439 #endif |
2440 | |
2441 } // tasks every second / on the first section of the second | |
604 | 2442 |
2443 | |
2444 #ifdef _rx_functions | |
2445 | |
623 | 2446 // only when TR functions are enabled |
2447 if( main_status & TR_FUNCTIONS ) | |
2448 | |
2449 // Tasks every second, if more than 1 invocation per second: on the second section of the second. | |
2450 #if (INVOKES_PER_SECOND > 1) | |
2451 if( ( sequence_timer == 1 ) | |
2452 || ( sequence_timer == INVOKES_PER_SECOND + 1 ) | |
2453 ) | |
2454 #endif | |
604 | 2455 { |
623 | 2456 calc_TR_functions(); |
2457 } | |
2458 | |
2459 #endif // _rx_functions | |
2460 | |
2461 | |
2462 // | |
604 | 2463 //---- End of Computations for the real Tissues ----------------------------------------------- |
2464 // | |
623 | 2465 |
604 | 2466 //============================================================================================= |
623 | 2467 |
604 | 2468 // |
623 | 2469 //---- Begin of Computations for Ascent and Decompression (simulated Tissues) ----------------- |
2470 // | |
2471 | |
2472 // Dispatcher: select what to do based on the current calculation phase | |
2473 do | |
582 | 2474 { |
623 | 2475 |
2476 #ifdef _profiling | |
2477 profiling_phase = next_planning_phase; | |
2478 #endif | |
2479 | |
2480 switch( next_planning_phase ) | |
560 | 2481 { |
623 | 2482 |
2483 // | |
2484 //---- once-per-dive Initialization of the Deco Engine ------------------------------------ | |
2485 // | |
2486 case PHASE_10_DIVE_INIT: | |
2487 | |
2488 // initialize all output variables to defaults | |
2489 init_output_vars(); | |
2490 | |
582 | 2491 // initialize values that will be recalculated later on periodically |
631 | 2492 deco_warnings = 0; // reset all deco warnings |
2493 deco_info = 0; // reset all deco infos | |
2494 IBCD_tissue_vector = 0; // reset tissue IBCD vector | |
2495 NDL_tissue_start_norm = 0; // initialize the tissue to start with when calculating normal NDL time | |
2496 NDL_tissue_start_alt = 0; // initialize the tissue to start with when calculating alternative NDL time | |
623 | 2497 |
2498 // enforce initialization of GF data on first cyclic initialization | |
631 | 2499 GF_high_last = 255; |
2500 GF_low_last = 255; | |
2501 | |
2502 | |
2503 // calculate volumes available for each gas | |
2504 for( i = 0; i < NUM_GAS; i++ ) | |
628 | 2505 { |
631 | 2506 // total available volume = tank size * fill press, char_I_gas_avail_pres is in multiples of 10 bar |
2507 gas_volume_avail[i] = (float)char_I_gas_avail_size[i] * (float)char_I_gas_avail_pres[i] * 10.0; | |
2508 | |
2509 // attention threshold | |
2510 gas_volume_atten[i] = gas_volume_avail[i] * GAS_NEEDS_ATTENTION; | |
628 | 2511 } |
631 | 2512 |
623 | 2513 |
2514 #ifdef _profiling | |
2515 int_O_profiling_overrun_max = 0; | |
2516 char_O_profiling_runs_norm = 0; | |
2517 char_O_profiling_runs_alt = 0; | |
2518 #endif | |
2519 | |
2520 | |
2521 // the next calculation phase will do the cyclic initialization of the deco engine if a | |
2522 // normal or alternative plan shall be calculated, else the calculation cycle is done. | |
628 | 2523 if( deco_status & PLAN_MASK ) next_planning_phase = PHASE_20_CYCLIC_INIT; |
623 | 2524 else next_planning_phase = PHASE_00_DONE; |
2525 | |
2526 break; | |
2527 | |
582 | 2528 |
2529 // | |
628 | 2530 //---- once-per-cycle Initialization of the Deco Engine ----------------------------------- |
582 | 2531 // |
628 | 2532 case PHASE_20_CYCLIC_INIT: |
623 | 2533 |
2534 // target the simulated tissues (flag bit 7 = 0) | |
2535 tissue_increment = 0; | |
2536 | |
2537 // clear the internal stops table | |
582 | 2538 clear_deco_table(); |
604 | 2539 |
631 | 2540 // clear deco stops info |
2541 if( deco_status & CALC_NORM ) deco_info &= ~DECO_STOPS_NORM; | |
2542 else deco_info &= ~DECO_STOPS_ALT; | |
2543 | |
560 | 2544 // initialize the simulated tissues with the current state of the real tissues |
650 | 2545 memcpy(sim_pres_tissue_N2, real_pres_tissue_N2, 256); |
582 | 2546 |
631 | 2547 // initialize the gas types |
2548 for( i = 0; i < NUM_GAS; i++ ) | |
2549 { | |
2550 deco_gas_type[i] = char_I_deco_gas_type[i]; | |
2551 } | |
2552 | |
2553 #ifdef _gas_contingency | |
2554 // if in gas contingency mode, | |
2555 // check if there are multiple tanks with the same gas | |
2556 // (or at least with the same change depth...) | |
2557 if( main_status & GAS_CONTINGENCY ) | |
2558 { | |
2559 for( i = 0; i < NUM_GAS; i++ ) | |
2560 { | |
2561 // default to no peer tanks existing | |
2562 peer_tank[i] = 0; | |
2563 | |
2564 // tank enabled? | |
2565 if( char_I_deco_gas_type[i] ) | |
2566 { | |
2567 // YES - check for peer tanks | |
2568 for( j = 0; j < NUM_GAS; j++ ) | |
2569 { | |
2570 // do not check a tank against itself | |
2571 if( i == j ) continue; | |
2572 | |
2573 // is the other tank also enabled and does it have the same change depth? | |
2574 if( char_I_deco_gas_type[j] & GAS_TYPE_MASK ) | |
2575 if( char_I_deco_gas_change[i] == char_I_deco_gas_change[j] ) | |
2576 { | |
2577 // YES - memorize it as a peer tank | |
2578 peer_tank[i] |= (1 << j); | |
2579 } | |
2580 } | |
2581 } | |
2582 } | |
2583 } | |
2584 #endif | |
2585 | |
623 | 2586 // initialize GF parameters if using GF model |
631 | 2587 if( char_I_model != 0 ) |
604 | 2588 { |
623 | 2589 // update GF parameters (GFs may have been switched between GF and aGF) |
628 | 2590 if( (char_I_GF_Low_percentage != GF_low_last) || (char_I_GF_High_percentage != GF_high_last) ) |
604 | 2591 { |
623 | 2592 // store new values in integer format |
628 | 2593 GF_low_last = char_I_GF_Low_percentage; |
623 | 2594 GF_high_last = char_I_GF_High_percentage; |
628 | 2595 |
2596 // safeguard and store new values in float format | |
2597 GF_low = ( GF_low_last > 10 ) ? 0.01 * GF_low_last : 0.10 ; | |
2598 GF_high = ( GF_high_last > GF_low_last ) ? 0.01 * GF_high_last : GF_low; | |
2599 | |
623 | 2600 |
2601 // reset low depth references and slopes | |
631 | 2602 GF_depth_norm = 0; |
2603 GF_depth_alt = 0; | |
2604 GF_slope_norm = 0.0; | |
2605 GF_slope_alt = 0.0; | |
604 | 2606 } |
623 | 2607 |
2608 // retrieve GF parameters for current calculation cycle | |
2609 if( deco_status & CALC_NORM ) | |
560 | 2610 { |
631 | 2611 GF_depth = GF_depth_norm; |
2612 GF_slope = GF_slope_norm; | |
560 | 2613 } |
2614 else | |
2615 { | |
631 | 2616 GF_depth = GF_depth_alt; |
2617 GF_slope = GF_slope_alt; | |
560 | 2618 } |
604 | 2619 } |
2620 | |
623 | 2621 // initialize the simulated CNS value with the current CNS value of the real tissues |
2622 CNS_fraction_sim = CNS_fraction_real; | |
2623 | |
631 | 2624 // initialize the simulated pressure with the current real pressure |
623 | 2625 sim_pres_respiration = real_pres_respiration; |
631 | 2626 |
2627 // initialize the simulated depth with the current real depth | |
2628 char_depth_sim = char_depth_start = char_depth_real; | |
2629 | |
2630 // cache the gas/dil to start calculations with | |
2631 start_gas_num = char_I_current_gas_num; | |
2632 | |
623 | 2633 |
2634 // Lookup the gas that is currently breathed with the real tissues and set it as | |
2635 // the gas to be used with the simulated tissues, too. This gas will be used until | |
628 | 2636 // gas_find_best()/gas_take_best() is invoked and switches to a better gas. |
2637 gas_take_current(); | |
2638 | |
2639 // Setup the calculation ratio's for N2, He and O2 (sim_N2/He/_O2_ratio). | |
2640 // These ratios can be kept until a gas switch is done. Thus, if a call to | |
2641 // gas_find_best() has found a better gas and this gas is taken by a call | |
2642 // to gas_take_best(), gas_set_ratios() needs to be called again. | |
623 | 2643 gas_set_ratios(); |
2644 | |
2645 // compute ppO2, ppN2 and ppHe for current depth from sim_pres_respiration | |
2646 calc_alveolar_pressures(); | |
2647 | |
2648 // initialize the no decompression limit (NDL) time to 240 minutes | |
2649 NDL_time = 240; | |
2650 | |
631 | 2651 // clear the Total Time to Surface (TTS) and the Total Stops Time (TST) |
2652 TTS_time = 0; | |
2653 TST_time = 0; | |
628 | 2654 |
623 | 2655 // retrieve the tissue that had the shortest NDL time during last calculation |
2656 NDL_tissue_start = ( deco_status & CALC_NORM ) ? NDL_tissue_start_norm : NDL_tissue_start_alt; | |
2657 | |
2658 // start calculating NDL time with the tissue that had the shortest NDL last time | |
2659 NDL_tissue = NDL_tissue_start; | |
2660 NDL_tissue_lead = NDL_tissue_start; | |
2661 | |
631 | 2662 // tag gas needs as not calculated in fTTS mode by default |
2663 deco_info &= ~GAS_NEEDS_fTTS; | |
623 | 2664 |
628 | 2665 // shall calculate gas needs? |
2666 if( main_status & CALC_VOLUME ) | |
2667 { | |
2668 // set the usage rate (SAC rate), starting with working part of the dive | |
2669 gas_needs_usage_rate = char_I_SAC_work; | |
2670 | |
2671 // clear the gas volume needs for gases 1-5 | |
2672 for( i = 0; i < NUM_GAS; ++i ) gas_volume_need[i] = 0.0; | |
2673 | |
2674 #ifdef _rx_functions | |
2675 // only for OSTC TR model with TR functions enabled | |
2676 if( main_status & TR_FUNCTIONS ) | |
2677 { | |
2678 // invalidate pressure needs to pressure readings | |
2679 int_O_pressure_need[0] = 0 + INT_FLAG_NOT_AVAIL; | |
2680 int_O_pressure_need[1] = 0 + INT_FLAG_NOT_AVAIL; | |
2681 } | |
2682 #endif | |
2683 } | |
623 | 2684 |
631 | 2685 |
2686 #ifdef _cave_mode | |
2687 if( main_status & CAVE_MODE ) | |
2688 { | |
2689 // get the position of the first data set to start the backtracking from | |
2690 backtrack_index = char_I_backtrack_index; | |
2691 | |
2692 // get the first backtracking data set | |
2693 read_backtrack_data(); | |
2694 } | |
2695 #endif | |
2696 | |
2697 | |
623 | 2698 #ifdef _profiling |
2699 profiling_runs = 0; | |
2700 #endif | |
2701 | |
2702 // The next calculation phase will | |
628 | 2703 // - calculate the extended bottom segment if extended bottom time is configured (fTTS), |
2704 // - calculate the bottom segment gas need if gas needs calculation is configured, | |
623 | 2705 // - proceed with calculating the NDL time else. |
628 | 2706 if ( deco_status & DELAYED_ASCENT ) next_planning_phase = PHASE_30_EXTENDED_BOTTOM_TIME; |
2707 else if ( main_status & CALC_VOLUME ) next_planning_phase = PHASE_40_BOTTOM_GAS_NEED; | |
2708 else next_planning_phase = PHASE_50_NDL_TIME; | |
623 | 2709 |
2710 break; | |
2711 | |
2712 | |
2713 // | |
2714 //---- extended Bottom Time --------------------------------------------------------------- | |
2715 // | |
628 | 2716 case PHASE_30_EXTENDED_BOTTOM_TIME: |
623 | 2717 |
631 | 2718 // tag gas needs as calculated in fTTS mode |
2719 deco_info |= GAS_NEEDS_fTTS; | |
2720 | |
623 | 2721 // program interval on simulated tissues (flag bit 7 = 0) |
2722 tissue_increment = char_I_extra_time; | |
2723 | |
628 | 2724 // update the simulated tissues for tissue_increment (char_I_extra_time) minutes at depth, |
2725 // calc_alveolar_pressures() has already been called in cyclic initialization | |
623 | 2726 calc_tissues(); |
2727 | |
628 | 2728 // update the CNS value for tissue_increment (char_I_extra_time) minutes at depth |
623 | 2729 calc_CNS(); |
2730 | |
628 | 2731 // the next calculation phase will |
2732 // - calculate the extended bottom segment gas needs if gas needs calculation is configured, | |
2733 // - proceed with calculating the NDL time else. | |
2734 if ( main_status & CALC_VOLUME ) next_planning_phase = PHASE_40_BOTTOM_GAS_NEED; | |
2735 else next_planning_phase = PHASE_50_NDL_TIME; | |
2736 | |
2737 break; | |
2738 | |
2739 | |
2740 // | |
2741 //---- Bottom Segment Gas Need ------------------------------------------------------------ | |
2742 // | |
2743 case PHASE_40_BOTTOM_GAS_NEED: | |
2744 | |
2745 // on gas 1-5 ? | |
2746 if( sim_gas_current_num ) | |
2747 { | |
631 | 2748 // YES - take either the whole bottom time or just the fTTS/bailout extra time |
628 | 2749 gas_needs_time = ( main_status & CALCULATE_BOTTOM ) ? char_I_bottom_time : char_I_extra_time; |
2750 | |
631 | 2751 // any time to do? |
2752 if( gas_needs_time ) | |
2753 { | |
2754 // YES - set the bottom depth | |
2755 gas_needs_depth = char_depth_start; | |
2756 | |
2757 // calculate required gas volume | |
2758 calc_required_volume(); | |
2759 | |
2760 // take the result | |
2761 gas_volume_need[sim_gas_current_num-1] = gas_needs_volume_due; | |
2762 } | |
628 | 2763 } |
2764 | |
2765 | |
623 | 2766 // the next calculation phase will calculate the NDL time |
628 | 2767 next_planning_phase = PHASE_50_NDL_TIME; |
604 | 2768 |
582 | 2769 break; |
2770 | |
623 | 2771 |
2772 // | |
2773 //---- NDL Time --------------------------------------------------------------------------- | |
2774 // | |
628 | 2775 case PHASE_50_NDL_TIME: |
623 | 2776 |
2777 // Calculate the remaining no decompression limit (NDL) time for the tissue NDL_tissue. | |
2778 // NDL_time will be updated if the NDL time found is shorter than the current NDL_time. | |
2779 // | |
2780 // In the initialization phase of the calculation cycle: | |
2781 // - NDL_time had been initialized to 240 (minutes), | |
2782 // - NDL_tissue had been initialized to the tissue with | |
2783 // the shortest NDL time in the last cycle. | |
2784 // | |
2785 calc_NDL_time_tissue(); | |
2786 | |
2787 // advance to next tissue, wrapping around after last tissue | |
2788 NDL_tissue = (NDL_tissue + 1) & (NUM_COMP - 1); | |
2789 | |
2790 // did we run out of NDL time or did we have probed all tissues? | |
2791 if( (NDL_time == 0) || (NDL_tissue == NDL_tissue_start) ) | |
2792 { | |
2793 // YES | |
2794 | |
2795 // set the tissue with the shortest NDL time found as | |
2796 // the one to start with in the next calculation cycle | |
2797 if( deco_status & CALC_NORM ) NDL_tissue_start_norm = NDL_tissue_lead; | |
2798 else NDL_tissue_start_alt = NDL_tissue_lead; | |
2799 | |
631 | 2800 // done with calculating NDL time, next phase will calculate the ascent / cave return |
2801 next_planning_phase = PHASE_70_ASCENT_OR_RETURN; | |
623 | 2802 } |
2803 | |
2804 break; | |
2805 | |
2806 | |
560 | 2807 // |
631 | 2808 //---- Ascent or Return (cave mode) ------------------------------------------------------- |
560 | 2809 // |
631 | 2810 case PHASE_70_ASCENT_OR_RETURN: |
2811 | |
560 | 2812 { |
631 | 2813 overlay unsigned char doing_deco_stop = 0; |
2814 overlay unsigned char doing_gas_change = 0; | |
2815 | |
2816 | |
2817 // target simulated tissues, default is 1 minute interval | |
2818 tissue_increment = 1; | |
2819 | |
2820 // check if a deco stop is required: | |
2821 // - stays at the current depth if a stop is required, | |
2822 // - ascents to the next stop if possible, else | |
2823 // - ascents by 1 meter | |
2824 if( find_next_stop() ) | |
2825 { | |
2826 //---- stop required -------------------- | |
2827 | |
2828 // memorize doing a deco stop | |
2829 doing_deco_stop = 1; | |
2830 | |
2831 // set flag for deco stops found | |
2832 if( deco_status & CALC_NORM ) deco_info |= DECO_STOPS_NORM; | |
2833 else deco_info |= DECO_STOPS_ALT; | |
2834 | |
2835 // encountered a deco stop, so switch to deco usage rate (SAC deco) | |
2836 gas_needs_usage_rate = char_I_SAC_deco; | |
2837 | |
2838 // check if there is a better gas to switch to | |
2839 if( gas_find_best() ) | |
2840 { | |
2841 // YES - memorize doing a gas change | |
2842 doing_gas_change = 1; | |
2843 | |
2844 // take the gas | |
2845 gas_take_best(); | |
2846 | |
2847 // set the new calculation ratios for N2, He and O2 | |
2848 gas_set_ratios(); | |
2849 | |
2850 // add the gas change time to the stop time | |
2851 tissue_increment += char_I_gas_change_time; | |
2852 } | |
2853 | |
2854 // add the stop to an existing stop or add a new stop | |
2855 update_deco_table(tissue_increment); | |
2856 } | |
2857 else | |
623 | 2858 { |
631 | 2859 //---- no stop required ----------------- |
2860 | |
2861 // switch to 1/10 minute interval | |
2862 tissue_increment = 0; | |
2863 | |
2864 // memorize not doing a deco stop | |
2865 doing_deco_stop = 0; | |
2866 | |
2867 // check if there is a better gas to switch to, but only: | |
2868 // | |
2869 // if extended stops are activated OR if cave mode is enabled OR if in bailout | |
2870 // AND if the actual depth (char_depth_start) is deeper or at the change | |
2871 // depth of the better gas (change depth has not been passed yet) *) | |
2872 // AND if the depth of the last stop is above (shallower) or at the change | |
2873 // depth of the better gas (do not switch on final ascent) *) | |
2874 // | |
2875 // *) skipped when calculating in cave mode | |
2876 // | |
2877 // Attention: do not use a && formula over all 'if' terms, the | |
2878 // conditions need to be evaluated in the given order! | |
2879 // | |
2880 if( ( main_status & EXTENDED_STOPS ) | |
2881 || ( main_status & CAVE_MODE ) | |
2882 || ( deco_status & BAILOUT_MODE ) | |
2883 ) | |
2884 if( gas_find_best() ) | |
2885 #ifdef _cave_mode | |
2886 if( ( char_depth_start >= sim_gas_best_depth ) || ( main_status & CAVE_MODE ) ) | |
2887 if( ( char_I_last_stop_depth <= sim_gas_best_depth ) || ( main_status & CAVE_MODE ) ) | |
2888 #else | |
2889 if( ( char_depth_start >= sim_gas_best_depth ) ) | |
2890 if( ( char_I_last_stop_depth <= sim_gas_best_depth ) ) | |
2891 #endif | |
623 | 2892 { |
631 | 2893 // YES - memorize doing a gas change |
2894 doing_gas_change = 1; | |
2895 | |
2896 // take the gas | |
2897 gas_take_best(); | |
2898 | |
2899 // set the new calculation values for N2, He and O2 | |
2900 gas_set_ratios(); | |
2901 | |
2902 // create a stop lasting the gas change time | |
628 | 2903 tissue_increment = char_I_gas_change_time; |
2904 | |
631 | 2905 // if in deco and run from the deco calculator: |
2906 // create a stop for the gas change in the stops table | |
2907 if( !NDL_time && (deco_status & DECO_CALCULATOR_MODE) ) | |
2908 update_deco_table(tissue_increment); | |
2909 } | |
2910 | |
2911 } // stop / no stop | |
2912 | |
2913 | |
2914 #ifdef _cave_mode | |
2915 // cave mode actions | |
2916 if( main_status & CAVE_MODE ) | |
2917 { | |
2918 // doing a deco stop? | |
2919 if( doing_deco_stop ) | |
2920 { | |
2921 // YES - not moving, reset the 1/10 minute steps counter | |
2922 backtrack_step_counter = 10; | |
623 | 2923 } |
631 | 2924 else |
2925 { | |
2926 // NO - on the move, switch back to SAC work | |
2927 gas_needs_usage_rate = char_I_SAC_work; | |
2928 | |
2929 // - decrement the 1/10 minute steps counter if not already zero | |
2930 if( backtrack_step_counter ) backtrack_step_counter--; | |
2931 | |
2932 // - target backtracking depth reached? | |
2933 if( char_depth_sim == backtrack_target_depth ) | |
2934 { | |
2935 // YES - on target depth | |
2936 | |
2937 // target depth reached within first 1/10 minute? | |
2938 if( backtrack_step_counter == 9 ) | |
2939 { | |
2940 // YES - will not change depth any more while remaining 9/10 of | |
2941 // the minute, so can do the full full minute in one step | |
2942 tissue_increment = 1; | |
2943 backtrack_step_counter = 0; | |
2944 } | |
2945 | |
2946 // on the move for a minute or more now? | |
2947 // (incl. doing full minute in one step) | |
2948 if( backtrack_step_counter == 0 ) | |
2949 { | |
2950 // YES - get the data of the next backtracking data set | |
2951 read_backtrack_data(); | |
2952 } | |
2953 } | |
2954 } | |
2955 } // cave mode | |
2956 #endif | |
628 | 2957 |
2958 // shall calculate gas needs? | |
2959 if( main_status & CALC_VOLUME ) | |
2960 { | |
650 | 2961 overlay unsigned char index_last_gas = sim_gas_last_num - 1; |
2962 overlay unsigned char index_curr_gas = sim_gas_current_num - 1; | |
631 | 2963 |
2964 #ifdef _cave_mode | |
2965 // in cave mode? | |
2966 if( main_status & CAVE_MODE ) | |
2967 { | |
2968 // YES - set the depth for the gas needs calculation to the | |
2969 // simulated stop / on-the-move depth | |
2970 gas_needs_depth = char_depth_sim; | |
2971 } | |
2972 else | |
2973 #endif | |
2974 { | |
2975 // NO - set the depth for the gas needs calculation to the shallower | |
2976 // one of the actual depth (char_depth_start, current real depth) | |
2977 // and the simulated (stop) depth, as we may on purpose dive | |
2978 // shallower than we should to conserve on a low running gas supply | |
2979 gas_needs_depth = ( char_depth_start < char_depth_sim ) ? | |
2980 char_depth_start : char_depth_sim; | |
2981 } | |
2982 | |
2983 // doing a gas change and a gas change time is set? | |
2984 if( doing_gas_change && char_I_gas_change_time ) | |
628 | 2985 { |
2986 // YES - set time it takes for switching the gas | |
2987 gas_needs_time = char_I_gas_change_time; | |
2988 | |
631 | 2989 // - calculate required gas volume for the gas change |
2990 calc_required_volume(); | |
2991 | |
2992 // - add gas change demand to overall demand on the last gas | |
2993 if( sim_gas_last_num ) gas_volume_need[index_last_gas] += gas_needs_volume_due; | |
2994 | |
2995 // - add gas change demand to overall demand on the current gas | |
2996 if( sim_gas_current_num ) gas_volume_need[index_curr_gas] += gas_needs_volume_due; | |
628 | 2997 } |
2998 | |
631 | 2999 // current gas is 1-5 ? (i.e. not 0 aka gas 6) |
628 | 3000 if( sim_gas_current_num ) |
3001 { | |
631 | 3002 // set time: doing a deco stop -> 1 minute, encoded by tissue_increment = 1 |
3003 // no deco stop -> 1/10 minute, encoded by tissue_increment = 0 | |
628 | 3004 gas_needs_time = tissue_increment; |
3005 | |
631 | 3006 // calculate required gas volume for the stop, ascent or travel |
3007 calc_required_volume(); | |
628 | 3008 |
3009 // add the demand to the overall demand on the current gas | |
631 | 3010 gas_volume_need[index_curr_gas] += gas_needs_volume_due; |
628 | 3011 } |
631 | 3012 |
3013 #ifdef _gas_contingency | |
3014 // in gas contingency mode? | |
3015 if( main_status & GAS_CONTINGENCY ) | |
628 | 3016 { |
631 | 3017 overlay unsigned char all_peer_tanks_used_up = 1; |
3018 | |
3019 | |
3020 // when doing a gas change and the there is an overdraw on the last gas, | |
3021 // then transfer the overdraw to the current gas if the current gas has | |
3022 // an equal or deeper change depth than the overdrawn gas | |
3023 if( doing_gas_change ) | |
3024 if( gas_volume_need[index_last_gas] >= gas_volume_avail[index_last_gas] ) | |
3025 if( char_I_deco_gas_change[index_last_gas] <= char_I_deco_gas_change[index_curr_gas] ) | |
3026 { | |
3027 overlay float overdraw; | |
3028 | |
3029 // calculate overdraw | |
3030 overdraw = gas_volume_need[index_last_gas] - gas_volume_avail[index_last_gas]; | |
3031 | |
3032 // transfer overdraw | |
3033 gas_volume_need[index_last_gas] -= overdraw; | |
3034 gas_volume_need[index_curr_gas] += overdraw; | |
3035 | |
3036 // tag last gas as fully used up | |
3037 deco_gas_type[index_last_gas] |= GAS_FULLY_USED_UP; | |
3038 } | |
3039 | |
3040 // if there are peer tanks with the current gas (i.e. other tanks that have the same | |
3041 // change depth), check if there is at least one tank that is not yet fully used up | |
3042 if( peer_tank[index_curr_gas] ) | |
628 | 3043 { |
631 | 3044 // scan all tanks |
3045 for( i = 0; i < NUM_GAS; i++ ) | |
3046 { | |
3047 // check if | |
3048 // - tank is a peer tank | |
3049 // - tank is currently neither staged nor lost | |
3050 // - tank is not fully used up yet | |
3051 if( (peer_tank[index_curr_gas] & (1 << i) ) ) | |
3052 if( !(deco_gas_type[i] & GAS_AVAIL_MASK ) ) | |
3053 if( !(deco_gas_type[i] & GAS_FULLY_USED_UP) ) | |
3054 { | |
3055 // found a peer tank that is available and not fully used up yet | |
3056 all_peer_tanks_used_up = 0; | |
3057 } | |
3058 } | |
3059 } | |
3060 | |
3061 // select which threshold is sensible to check for | |
3062 if ( deco_gas_type[index_curr_gas] & GAS_FULLY_USED_UP ) | |
3063 { | |
3064 // already found as fully used up, nothing to do any more | |
628 | 3065 } |
631 | 3066 else if( deco_gas_type[index_curr_gas] & GAS_NEARLY_USED_UP ) |
3067 { | |
3068 // check for fully used up threshold | |
3069 if( gas_volume_need[index_curr_gas] >= gas_volume_avail[index_curr_gas] ) | |
3070 { | |
3071 // tag the gas as fully used up | |
3072 deco_gas_type[index_curr_gas] |= GAS_FULLY_USED_UP; | |
3073 | |
3074 // set warning if all peer tanks are fully used up, too | |
3075 if( all_peer_tanks_used_up ) deco_gas_type[index_curr_gas] |= GAS_NEED_WARNING; | |
3076 } | |
3077 } | |
3078 else | |
3079 { | |
3080 // check for nearly used up threshold | |
3081 if( gas_volume_need[index_curr_gas] >= gas_volume_atten[index_curr_gas] ) | |
3082 { | |
3083 // tag the gas as nearly used up | |
3084 deco_gas_type[index_curr_gas] |= GAS_NEARLY_USED_UP; | |
3085 | |
3086 // set attention if all peer tanks are already fully used up | |
3087 if( all_peer_tanks_used_up ) deco_gas_type[index_curr_gas] |= GAS_NEED_ATTENTION; | |
3088 } | |
3089 } | |
3090 } | |
3091 #endif // _gas_contingency | |
3092 | |
3093 } // gas needs | |
3094 | |
3095 // update the total stops time | |
3096 if( doing_deco_stop ) | |
628 | 3097 { |
631 | 3098 // total stops time is counted in full minutes, add 1 minute |
3099 TST_time += 1; | |
3100 } | |
3101 | |
3102 // update the total ascent / cave return time | |
3103 if( tissue_increment ) | |
3104 { | |
3105 // total time to surface is counted in 1/10 minutes, add 1 minute | |
3106 TTS_time += 10 * tissue_increment; | |
3107 } | |
3108 else | |
3109 { | |
3110 // total time to surface is counted in 1/10 minutes, add 1/10 minute | |
3111 TTS_time += 1; | |
3112 } | |
3113 | |
650 | 3114 } |
631 | 3115 |
3116 // calculate absolute pressure at the current depth | |
3117 sim_pres_respiration = (float)char_depth_sim * METER_TO_BAR + pres_surface; | |
582 | 3118 |
604 | 3119 // compute current ppO2, ppN2 and ppHe |
582 | 3120 calc_alveolar_pressures(); |
3121 | |
560 | 3122 // update the tissues |
582 | 3123 calc_tissues(); |
604 | 3124 |
631 | 3125 // update the CNS |
604 | 3126 calc_CNS(); |
623 | 3127 |
631 | 3128 // finish stops calculation if the surface is reached or |
3129 // if the deco table is full / calculations took too long | |
3130 if( (char_depth_sim == 0) || (deco_warnings & DECO_WARNING_INCOMPLETE) ) | |
3131 next_planning_phase = PHASE_80_RESULTS; | |
623 | 3132 |
3133 break; | |
3134 | |
3135 | |
3136 /// | |
3137 //--- Results - Initialization ------------------------------------------------------------ | |
3138 // | |
628 | 3139 case PHASE_80_RESULTS: |
3140 | |
3141 // convert the CNS value to integer | |
3142 convert_sim_CNS_for_display(); | |
3143 | |
631 | 3144 // limit total time to surface to display max. and rescale to full minutes |
3145 if( TTS_time < 9995 ) TTS_time = (TTS_time + 5) / 10; | |
3146 else TTS_time = 999 | INT_FLAG_INVALID; | |
3147 | |
650 | 3148 // limit total stops time to display max. |
3149 if( TST_time > 999 ) TST_time = 999 | INT_FLAG_INVALID; | |
623 | 3150 |
631 | 3151 // normal or alternative plan? |
623 | 3152 if( deco_status & CALC_NORM ) |
3153 { | |
650 | 3154 // normal plan |
3155 | |
3156 // export the integer CNS value | |
3157 int_O_CNS_norm = int_sim_CNS_fraction; | |
3158 | |
3159 // publish the stops table to the display functions | |
3160 publish_deco_table(); | |
3161 | |
3162 // When in deco and the ceiling depth is > 0 but the deco calculation | |
3163 // reveals no distinct deco stop yet because the deco obligation will | |
3164 // vanish during the ascent, create an artificial stop to signal that | |
3165 // expedite surfacing ("popping up") is not allowed any more. | |
3166 if( char_O_deco_depth[0] == 0 ) // simulated ascent reveals no required stops | |
3167 if( int_O_ceiling > 0 ) // real tissues have a ceiling | |
3168 { | |
3169 // set a pro forma stop at the configured last stop depth | |
3170 char_O_deco_depth[0] = char_I_last_stop_depth; | |
3171 | |
3172 // set a stop time of 0 minutes, this will be displayed as "..'" | |
3173 char_O_deco_time[0] = 0; | |
3174 } | |
3175 | |
3176 // within NDL? | |
3177 if ( NDL_time ) | |
3178 { | |
3179 // YES - output the NDL and TTS time | |
3180 int_O_NDL_norm = NDL_time; | |
3181 int_O_TTS_norm = TTS_time; | |
3182 | |
3183 // clear the stops time | |
3184 int_O_TST_norm = 0; | |
3185 } | |
3186 else | |
3187 { | |
3188 // NO - clear the normal NDL time | |
3189 int_O_NDL_norm = 0; | |
3190 | |
3191 // export the TTS and total stops time | |
3192 int_O_TTS_norm = TTS_time; | |
3193 int_O_TST_norm = TST_time; | |
3194 } | |
623 | 3195 } |
3196 else | |
3197 { | |
650 | 3198 // alternative plan |
3199 | |
3200 // export the integer CNS value | |
3201 int_O_CNS_alt = int_sim_CNS_fraction; | |
3202 | |
3203 // within NDL? | |
3204 if ( NDL_time ) | |
3205 { | |
3206 // YES - output the NDL time | |
3207 int_O_NDL_alt = NDL_time; | |
3208 int_O_TTS_alt = TTS_time; | |
3209 | |
3210 // clear the alternative TTS and stops time | |
3211 int_O_TST_alt = 0 + INT_FLAG_ZERO; | |
3212 } | |
3213 else | |
3214 { | |
3215 // NO - clear the alternative NDL time | |
3216 int_O_NDL_alt = 0; | |
3217 | |
3218 // export the TTS and total stops time | |
3219 int_O_TTS_alt = TTS_time; | |
3220 int_O_TST_alt = TST_time; | |
3221 } | |
623 | 3222 } |
3223 | |
650 | 3224 // export deco infos and warnings |
3225 char_O_deco_info = deco_info; | |
3226 char_O_deco_warnings = deco_warnings; | |
3227 | |
623 | 3228 // The next calculation phase will |
631 | 3229 // - convert the gas needs from volume to pressure if gas needs calculation is configured |
3230 // - else finish the calculation cycle | |
650 | 3231 if ( main_status & CALC_VOLUME ) next_planning_phase = PHASE_81_GAS_NEEDS_PRESSURES; |
631 | 3232 else next_planning_phase = PHASE_90_FINISH; |
623 | 3233 |
3234 break; | |
3235 | |
3236 | |
3237 // | |
628 | 3238 //--- Results - convert Gas Needs Volumes to Pressures ------------------------------------ |
623 | 3239 // |
650 | 3240 case PHASE_81_GAS_NEEDS_PRESSURES: |
3241 | |
3242 // step through all gases | |
3243 for (i = 0; i < NUM_GAS; i++) | |
3244 { | |
3245 // convert required volume of the gas into the respective pressure and set the flags | |
3246 convert_volume_to_pressure(i); | |
3247 } | |
623 | 3248 |
631 | 3249 #ifdef _cave_mode |
650 | 3250 // tag gas needs as calculated in cave mode or in open water mode |
3251 if( main_status & CAVE_MODE ) deco_info |= GAS_NEEDS_CAVE; | |
3252 else deco_info &= ~GAS_NEEDS_CAVE; | |
3253 | |
3254 // export updated deco info | |
3255 char_O_deco_info = deco_info; | |
3256 #endif | |
631 | 3257 |
3258 // advance to next calculation phase | |
3259 next_planning_phase = PHASE_90_FINISH; | |
3260 | |
3261 break; | |
3262 | |
623 | 3263 // |
3264 //--- finish Calculation Cycle ------------------------------------------------------------ | |
3265 // | |
3266 case PHASE_90_FINISH: | |
3267 | |
3268 // Check if deco obligation is steady state or decreasing. | |
631 | 3269 // Update the result only: |
3270 // - if an alternative plan is enabled, and | |
3271 // - if a valid alternative plan TTS exists, and | |
3272 // - if it is not a bailout plan | |
3273 if( (deco_status & CALC_ALT ) ) | |
635
9a64914a8fca
3.10 re-release addressing some minor issues and language fixes
heinrichsweikamp
parents:
634
diff
changeset
|
3274 if( !(int_O_TTS_alt & INT_FLAG_INVALID) ) |
631 | 3275 if( !(deco_status & BAILOUT_MODE ) ) |
623 | 3276 { |
650 | 3277 if ( int_O_TTS_alt < int_O_TTS_norm ) deco_info |= DECO_ZONE; |
3278 else if( int_O_TTS_alt > int_O_TTS_norm ) deco_info &= ~DECO_ZONE; | |
3279 | |
3280 // export updated deco info | |
3281 char_O_deco_info = deco_info; | |
623 | 3282 } |
3283 | |
650 | 3284 // restore command flag to indicate that the deco calculation cycle has finished |
3285 char_O_deco_status = deco_status; | |
623 | 3286 |
3287 // signal end of deco calculation | |
3288 next_planning_phase = PHASE_00_DONE; | |
3289 | |
3290 break; | |
3291 | |
3292 } // switch | |
3293 | |
3294 // read timer 5, result will be stored in tmr5_value (in 1/32 ms) and tmr5_overflow | |
3295 read_tmr5(); | |
3296 | |
3297 } // sequence calculation phases while not timed out and calculation cycle is not finished | |
3298 while( (tmr5_overflow == 0) && ( next_planning_phase != PHASE_00_DONE ) ); | |
3299 | |
3300 // report where we are in terms of depth reached, used in deco calculator to show deco calculation progress | |
3301 char_O_depth_sim = char_depth_sim; | |
3302 | |
3303 | |
3304 #ifdef _profiling | |
3305 | |
3306 //---- Performance Measurement ------------------------------------------- | |
3307 | |
3308 // convert timer 5 readout into ms | |
3309 profiling_runtime = tmr5_value / 32; | |
3310 | |
3311 // actual runtime longer than target runtime? | |
3312 if( tmr5_overflow ) | |
3313 { | |
3314 // YES - report excess | |
3315 int_O_profiling_overrun = profiling_runtime; | |
3316 | |
3317 // - excess > max we had so far? | |
3318 if( int_O_profiling_overrun > int_O_profiling_overrun_max ) | |
3319 { | |
3320 // YES - update max | |
3321 int_O_profiling_overrun_max = int_O_profiling_overrun; | |
3322 | |
3323 // - store the causing phase | |
3324 char_O_profiling_overrun_phase = profiling_phase; | |
3325 } | |
560 | 3326 } |
623 | 3327 else |
3328 { | |
3329 // NO - calculate unused budget and flag it to be under-run time | |
3330 int_O_profiling_overrun = (2048 - profiling_runtime) | 0x8000; | |
3331 } | |
3332 | |
3333 // increment number of runs in current cycle | |
3334 profiling_runs += 1; | |
3335 | |
3336 // planning cycle completed? | |
3337 if( next_planning_phase == PHASE_00_DONE ) | |
3338 { | |
3339 // YES - export number of runs it took | |
3340 if( deco_status & COMPLETED_NORM ) char_O_profiling_runs_norm = profiling_runs; | |
3341 else char_O_profiling_runs_alt = profiling_runs; | |
3342 } | |
3343 | |
3344 #endif | |
3345 | |
3346 } | |
3347 | |
3348 | |
3349 ////////////////////////////////////////////////////////////////////////////// | |
3350 // calc_hauptroutine_data_input | |
3351 // | |
3352 // Set all C-code dive parameters from their ASM-code values. | |
3353 // | |
3354 void calc_hauptroutine_data_input(void) | |
3355 { | |
3356 overlay float IG_ratio; | |
3357 | |
3358 // safeguard and convert the surface pressure (mbar -> bar) (*) | |
3359 if( int_I_pres_surface < 500 ) pres_surface = 0.500; | |
3360 else pres_surface = 0.001 * int_I_pres_surface; | |
3361 | |
3362 // safeguard and convert the current real pressure | |
3363 if( int_I_pres_respiration < 500 ) real_pres_respiration = 0.500; | |
3364 else real_pres_respiration = 0.001 * int_I_pres_respiration; | |
3365 | |
3366 // safeguard further parameters to protect the tissue-flag and the stop table | |
3367 if( char_I_sim_advance_time > 127 ) char_I_sim_advance_time = 127; | |
3368 if( char_I_extra_time > 127 ) char_I_extra_time = 127; | |
3369 if( char_I_gas_change_time > 99 ) char_I_gas_change_time = 99; | |
3370 | |
628 | 3371 |
3372 // compute the depth in meters where we are now | |
3373 float_depth_real = (real_pres_respiration - pres_surface) * BAR_TO_METER; | |
3374 | |
3375 // convert to integer and round up to next full meter | |
3376 char_depth_real = (unsigned char)(float_depth_real + 0.99); | |
3377 | |
3378 | |
623 | 3379 // calculate partial pressure of N2 in respired air at surface pressure |
3380 calc_N2_equilibrium(); | |
3381 | |
3382 // get, safeguard and convert the saturation and desaturation factors | |
3383 get_saturation_factors(); | |
3384 | |
3385 #ifdef _ccr_pscr | |
3386 // compute a factor that will be used later on for pSCR ppO2 drop calculation (*) | |
3387 float_pSCR_factor = 0.01 * char_I_PSCR_drop * char_I_PSCR_lungratio; | |
3388 #endif | |
3389 | |
3390 #ifdef _helium | |
3391 // get the currently breathed gas ratios | |
3392 real_O2_ratio = 0.01 * char_I_O2_ratio; | |
3393 real_He_ratio = 0.01 * char_I_He_ratio; | |
3394 | |
3395 // calculate the inert gas ratio (local helper variable) | |
3396 IG_ratio = 1.00 - real_O2_ratio; | |
3397 | |
3398 // calculate the N2 ratio | |
3399 real_N2_ratio = IG_ratio - real_He_ratio; | |
3400 #else | |
3401 // get the currently breathed O2 ratio | |
3402 real_O2_ratio = 0.01 * char_I_O2_ratio; | |
3403 | |
3404 // set the He ratio to zero | |
3405 real_He_ratio = 0.0; | |
3406 | |
3407 // calculate the N2 / inert gas ratio | |
3408 real_N2_ratio = IG_ratio = 1.00 - real_O2_ratio; | |
3409 #endif // _helium | |
3410 | |
3411 #ifdef _ccr_pscr | |
3412 // calculate ppO2 drop in pSCR loop for real tissues | |
3413 real_pSCR_drop = IG_ratio * float_pSCR_factor; | |
3414 #endif | |
3415 | |
0 | 3416 } |
3417 | |
3418 | |
3419 ////////////////////////////////////////////////////////////////////////////// | |
582 | 3420 // calc_tissues |
0 | 3421 // |
623 | 3422 // INPUT: ppN2 partial pressure of inspired N2 |
3423 // ppHe partial pressure of inspired He | |
631 | 3424 // tissue_increment tissue selector (real or simulated) and interval time |
623 | 3425 // |
3426 // MODIFIED: real_pres_tissue_N2[] tissue N2 pressures (in real tissues context) | |
3427 // real_pres_tissue_He[] tissue He pressures (in real tissues context) | |
3428 // sim_pres_tissue_N2[] tissue N2 pressures (in simulated tissues context) | |
3429 // sim_pres_tissue_He[] tissue He pressures (in simulated tissues context) | |
3430 // | |
3431 // OUTPUT: char_O_tissue_pres_N2[] tissue N2 pressures scaled for display purpose (in real tissues context) | |
3432 // char_O_tissue_pres_He[] tissue He pressures scaled for display purpose (in real tissues context) | |
3433 // char_O_tissue_pressure[] combined tissue pressures scaled for display purpose (in real tissue context) | |
582 | 3434 // |
3435 static void calc_tissues() | |
0 | 3436 { |
623 | 3437 overlay unsigned char period; |
650 | 3438 overlay float last_press_tissue; |
3439 overlay float delta_press_N2; | |
623 | 3440 |
3441 #ifdef _helium | |
650 | 3442 overlay float delta_press_He; |
623 | 3443 #endif |
582 | 3444 |
3445 assert( 0.00 <= ppN2 && ppN2 < 11.2 ); // 80% N2 at 130m | |
3446 assert( 0.00 <= ppHe && ppHe < 12.6 ); // 90% He at 130m | |
3447 | |
3448 | |
604 | 3449 for( ci=0; ci < NUM_COMP; ci++ ) // iterate through all compartments |
582 | 3450 { |
631 | 3451 i = tissue_increment & TIME_MASK; // i > 0: do a number of i full minutes |
3452 // I = 0: do 2 (real tissues) or 6 (simulated tissues) seconds | |
3453 | |
3454 if( i == 0 ) // check if we shall do one 2 or 6 seconds interval | |
560 | 3455 { |
631 | 3456 read_Buhlmann_times(0); // YES - program coefficients for a 2 or 6 seconds period |
623 | 3457 period = 1; // - set period length (in cycles) |
3458 i = 1; // - and one cycle to do | |
560 | 3459 } |
582 | 3460 else if( i > 9 ) // check if we can start with 10 minutes periods |
560 | 3461 { |
623 | 3462 read_Buhlmann_times(2); // YES - program coefficients for 10 minutes periods |
3463 period = 10; // set period length (in cycles) to ten | |
560 | 3464 } |
623 | 3465 else // last but not lease, do 1 to 9 minutes |
560 | 3466 { |
623 | 3467 read_Buhlmann_times(1); // NO - program coefficients for 1 minute periods |
3468 period = 1; // - set period length (in cycles) to one | |
560 | 3469 } |
3470 | |
3471 do | |
3472 { | |
650 | 3473 if (tissue_increment & TISSUE_SELECTOR) |
560 | 3474 { |
650 | 3475 //---- real N2 -------------------------------------- |
3476 | |
3477 // get the real tissue pressure | |
3478 last_press_tissue = real_pres_tissue_N2[ci]; | |
3479 | |
3480 // calculate the pressure change | |
3481 temp_tissue = (ppN2 - last_press_tissue) * var_N2_e; | |
3482 | |
3483 // apply the saturation / desaturation factor on temp_tissue | |
3484 apply_saturation_factors(); | |
3485 | |
3486 // store the pressure change for IBCD check and tissue graphics | |
3487 delta_press_N2 = temp_tissue; | |
3488 | |
3489 // update the delta accumulator | |
3490 real_pres_delta_N2[ci] += temp_tissue; | |
3491 | |
3492 // update the real tissue pressure | |
3493 real_pres_tissue_N2[ci] += real_pres_delta_N2[ci]; | |
3494 | |
3495 // reduce the delta accumulator | |
3496 real_pres_delta_N2[ci] -= real_pres_tissue_N2[ci] - last_press_tissue; | |
3497 | |
3498 #ifdef _helium | |
3499 //---- real He -------------------------------------- | |
3500 | |
3501 // get the real tissue pressure | |
3502 last_press_tissue = real_pres_tissue_He[ci]; | |
3503 | |
3504 // calculate the pressure change | |
3505 temp_tissue = (ppHe - last_press_tissue) * var_He_e; | |
3506 | |
3507 // apply the saturation / desaturation factor on temp_tissue | |
3508 apply_saturation_factors(); | |
3509 | |
3510 // store the pressure change for IBCD check and tissue graphics | |
3511 delta_press_He = temp_tissue; | |
3512 | |
3513 // update the delta accumulator | |
3514 real_pres_delta_He[ci] += temp_tissue; | |
3515 | |
3516 // update the real tissue pressure | |
3517 real_pres_tissue_He[ci] += real_pres_delta_He[ci]; | |
3518 | |
3519 // reduce the delta accumulator | |
3520 real_pres_delta_He[ci] -= real_pres_tissue_He[ci] - last_press_tissue; | |
3521 #endif | |
560 | 3522 } |
3523 else | |
3524 { | |
650 | 3525 //---- simulated N2 --------------------------------- |
3526 | |
3527 // get the simulated tissue pressure | |
3528 last_press_tissue = sim_pres_tissue_N2[ci]; | |
3529 | |
3530 // calculate the pressure change | |
3531 temp_tissue = (ppN2 - last_press_tissue) * var_N2_e; | |
3532 | |
3533 // apply the saturation / desaturation factor on temp_tissue | |
3534 apply_saturation_factors(); | |
3535 | |
3536 // update the delta accumulator | |
3537 sim_pres_delta_N2[ci] += temp_tissue; | |
3538 | |
3539 // update the simulated tissue pressure | |
3540 sim_pres_tissue_N2[ci] += sim_pres_delta_N2[ci]; | |
3541 | |
3542 // reduce the delta accumulator | |
3543 sim_pres_delta_N2[ci] -= sim_pres_tissue_N2[ci] - last_press_tissue; | |
560 | 3544 |
623 | 3545 #ifdef _helium |
650 | 3546 //---- simulated He --------------------------------- |
3547 | |
3548 // get the simulated tissue pressure | |
3549 last_press_tissue = sim_pres_tissue_He[ci]; | |
3550 | |
3551 // calculate the pressure change | |
3552 temp_tissue = (ppHe - last_press_tissue) * var_He_e; | |
3553 | |
3554 // apply the saturation / desaturation factor on temp_tissue | |
3555 apply_saturation_factors(); | |
3556 | |
3557 // update the delta accumulator | |
3558 sim_pres_delta_He[ci] += temp_tissue; | |
3559 | |
3560 // update the simulated tissue pressure | |
3561 sim_pres_tissue_He[ci] += sim_pres_delta_He[ci]; | |
3562 | |
3563 // reduce the delta accumulator | |
3564 sim_pres_delta_He[ci] -= sim_pres_tissue_He[ci] - last_press_tissue; | |
3565 #endif | |
560 | 3566 } |
623 | 3567 |
3568 //---- decrement loop counter and adjust step size --------------- | |
560 | 3569 |
3570 // decrement loop counter | |
3571 i -= period; | |
582 | 3572 |
560 | 3573 // check if we need to switch from 10 minute periods to 1 minute periods |
3574 if( (i > 0) && (period = 10) && (i < 10) ) | |
3575 { | |
582 | 3576 read_Buhlmann_times(1); // program coefficients for 1 minute periods |
560 | 3577 period = 1; // set period length (in cycles) to one |
3578 } | |
3579 } | |
3580 while( i ); | |
582 | 3581 |
3582 | |
560 | 3583 // have the computations been done for the "real" tissues? |
623 | 3584 if( tissue_increment & TISSUE_SELECTOR ) |
560 | 3585 { |
623 | 3586 |
3587 #ifdef _helium | |
560 | 3588 // net tissue balance |
650 | 3589 temp_tissue = delta_press_N2 + delta_press_He; |
623 | 3590 |
560 | 3591 // check tissue on-/off-gassing and IBCD with applying a threshold of +/-HYST |
3592 // | |
584 | 3593 if ( temp_tissue < -HYST ) // check if the tissue is off-gassing |
560 | 3594 { |
623 | 3595 // tag tissue as not experiencing mentionable IBCD |
3596 IBCD_tissue_vector &= ~(1 << ci); | |
560 | 3597 } |
3598 else if ( temp_tissue > +HYST ) // check if the tissue in on-gassing | |
3599 { | |
623 | 3600 // check for counter diffusion |
650 | 3601 if( ((delta_press_N2 > 0.0) && (delta_press_He < 0.0)) |
3602 || ((delta_press_N2 < 0.0) && (delta_press_He > 0.0)) ) | |
560 | 3603 { |
623 | 3604 // tag tissue as experiencing mentionable IBCD |
3605 IBCD_tissue_vector |= (1 << ci); | |
560 | 3606 } |
3607 } | |
623 | 3608 #endif |
3609 | |
3610 // For N2 tissue pressure display purpose: | |
3611 | |
3612 // basically keep the on-gassing / off-gassing flag from last invocation, but flip | |
3613 // it in case the rate exceeds a set hysteresis (actual value: see #define of HYST) | |
3614 char_O_tissue_pres_N2[ci] &= 128; | |
650 | 3615 if ( delta_press_N2 > +HYST ) char_O_tissue_pres_N2[ci] = 128; // set flag for tissue pressure is increasing |
3616 else if ( delta_press_N2 < -HYST ) char_O_tissue_pres_N2[ci] = 0; // clear flag (-> tissue pressure is decreasing) | |
623 | 3617 |
3618 // scale N2 tissue pressure such that the surface steady-state tissue loading | |
3619 // of [0.7902 * (1013 hPa - ppWater)] bar will give a 8, which aligns with | |
3620 // the 2nd scale line. | |
650 | 3621 delta_press_N2 = (8 / (0.7902 * (1.013 - ppWater))) * real_pres_tissue_N2[ci]; |
623 | 3622 |
3623 // limit to 127 to protect the uppermost bit which holds the sat/desat flag | |
650 | 3624 if (delta_press_N2 > 127) delta_press_N2 = 127; |
623 | 3625 |
3626 // convert to integer and combine with sat/desat flag | |
650 | 3627 char_O_tissue_pres_N2[ci] += (unsigned char)delta_press_N2; |
623 | 3628 |
3629 #ifdef _helium | |
3630 | |
3631 // For He tissue pressure display purpose: | |
3632 | |
3633 // basically keep the on-gassing / off-gassing flag from last invocation, but flip | |
3634 // it in case the rate exceeds a set hysteresis (actual value: see #define of HYST) | |
3635 char_O_tissue_pres_He[ci] &= 128; | |
650 | 3636 if ( delta_press_He > +HYST ) char_O_tissue_pres_He[ci] = 128; // set flag for tissue pressure is increasing |
3637 else if ( delta_press_He < -HYST ) char_O_tissue_pres_He[ci] = 0; // clear flag (-> tissue pressure is decreasing) | |
623 | 3638 |
3639 // scale He tissue pressure alike it is done for N2. | |
3640 // With no He in a tissue, the result will be 0. | |
650 | 3641 delta_press_He = (8 / (0.7902 * (1.013 - ppWater))) * real_pres_tissue_He[ci]; |
623 | 3642 |
3643 // limit to 127 to protect the uppermost bit which holds the sat/desat flag | |
650 | 3644 if (delta_press_He > 127) delta_press_He = 127; |
623 | 3645 |
3646 // convert to integer and combine with sat/desat flag | |
650 | 3647 char_O_tissue_pres_He[ci] += (unsigned char)delta_press_He; |
623 | 3648 |
3649 // For combined tissue pressure display purpose: | |
3650 | |
3651 // basically keep the on-gassing / off-gassing flag from last invocation, but flip | |
3652 // it in case the rate exceeds a set hysteresis (actual value: see #define of HYST) | |
3653 char_O_tissue_pressure[ci] &= 128; | |
3654 if ( temp_tissue > +HYST ) char_O_tissue_pressure[ci] = 128; // set flag for tissue pressure is increasing | |
3655 else if ( temp_tissue < -HYST ) char_O_tissue_pressure[ci] = 0; // clear flag (-> tissue pressure is decreasing) | |
3656 | |
3657 // add the two scaled pressures. | |
650 | 3658 temp_tissue = delta_press_N2 + delta_press_He; |
623 | 3659 |
3660 // limit to 127 to protect the uppermost bit which holds the sat/desat flag | |
560 | 3661 if (temp_tissue > 127) temp_tissue = 127; |
3662 | |
623 | 3663 // convert to integer and combine with sat/desat flag |
3664 char_O_tissue_pressure[ci] += (unsigned char)temp_tissue; | |
3665 | |
3666 #else | |
3667 | |
3668 // He tissue pressure is zero | |
3669 char_O_tissue_pres_He[ci] = 0; | |
3670 | |
3671 // combined tissue pressure equals N2 tissue pressure | |
3672 char_O_tissue_pressure[ci] = char_O_tissue_pres_N2[ci]; | |
3673 | |
3674 #endif | |
3675 | |
582 | 3676 } //if |
3677 | |
3678 } // for | |
0 | 3679 } |
3680 | |
623 | 3681 |
0 | 3682 ////////////////////////////////////////////////////////////////////////////// |
3683 // calc_limit | |
3684 // | |
623 | 3685 // Input: GF_parameter gradient factor to be used, negative values activate surface mode |
3686 // tissue_increment selector for context: real or simulated tissues | |
3687 // sim_pres_tissue_N2/_He tissue pressures (used in simulated tissues context) | |
3688 // real_pres_tissue_N2/_He tissue pressures (used in real tissues context) | |
3689 // | |
3690 // Output: lead_supersat highest supersaturation found among all tissues, 1.0 = 100% | |
3691 // lead_tissue number of the leading tissue (0-15) | |
3692 // ceiling ceiling in bar relative pressure | |
3693 // | |
3694 // Modified: deco_warnings for IBCD, micro bubbles and outside warning (only in real tissues context) | |
582 | 3695 // |
3696 static void calc_limit(PARAMETER float GF_parameter) | |
0 | 3697 { |
631 | 3698 overlay float pres_ambient_min_overall = 0.0; |
3699 overlay unsigned char surface_mode = 0; // 0: off, 1: on | |
623 | 3700 |
3701 | |
3702 // check mode | |
3703 if( GF_parameter < 0 ) | |
3704 { | |
3705 // activate surface mode | |
3706 surface_mode = 1; | |
3707 | |
3708 // normalize parameter | |
3709 GF_parameter = -GF_parameter; | |
3710 } | |
3711 | |
3712 // set leading tissue number to tissue 1 (it has the index 0) | |
3713 lead_tissue = 0; | |
604 | 3714 |
3715 // initialize leading tissue supersaturation value to null | |
623 | 3716 lead_supersat = 0.0; |
3717 | |
3718 // next code section is relevant only when invoked on the real tissues | |
3719 if( tissue_increment & TISSUE_SELECTOR ) | |
582 | 3720 { |
623 | 3721 // clear IBCD, micro-bubbles and outside warning flags (locked warnings will be preserved) |
3722 deco_warnings &= ~( DECO_WARNING_IBCD + DECO_WARNING_MBUBBLES + DECO_WARNING_OUTSIDE + DECO_ATTENTION_OUTSIDE ); | |
582 | 3723 } |
3724 | |
3725 // loop over all tissues | |
604 | 3726 for( ci = 0; ci < NUM_COMP; ci++ ) |
582 | 3727 { |
631 | 3728 overlay float pres_ambient_min_tissue; |
623 | 3729 |
3730 | |
3731 // get the coefficients for tissue ci | |
3732 read_Buhlmann_coefficients(); | |
3733 | |
3734 #ifdef _helium | |
582 | 3735 |
3736 // get the tissue pressures | |
623 | 3737 // adopt_Buhlmann_coefficients needs calc_pres_tissue_N2/He when compiled for helium |
3738 if( tissue_increment & TISSUE_SELECTOR ) | |
560 | 3739 { |
582 | 3740 // context is real tissues |
623 | 3741 calc_pres_tissue_N2 = real_pres_tissue_N2[ci]; |
3742 calc_pres_tissue_He = real_pres_tissue_He[ci]; | |
560 | 3743 } |
3744 else | |
3745 { | |
582 | 3746 // context is simulated tissues |
3747 calc_pres_tissue_N2 = sim_pres_tissue_N2[ci]; | |
3748 calc_pres_tissue_He = sim_pres_tissue_He[ci]; | |
3749 } | |
3750 | |
3751 // overall tissue pressure | |
650 | 3752 calc_pres_tissue = calc_pres_tissue_N2 + calc_pres_tissue_He; |
582 | 3753 |
623 | 3754 #else |
3755 | |
3756 // get the tissue pressure | |
650 | 3757 calc_pres_tissue = ( tissue_increment & TISSUE_SELECTOR ) ? real_pres_tissue_N2[ci] : sim_pres_tissue_N2[ci]; |
623 | 3758 |
3759 #endif | |
582 | 3760 |
604 | 3761 // adopt a and b coefficients to current N2/He ratio inside the tissue |
3762 adopt_Buhlmann_coefficients(); | |
582 | 3763 |
3764 // next calculations are only relevant when invoked on the real tissues | |
623 | 3765 if( tissue_increment & TISSUE_SELECTOR ) |
582 | 3766 { |
618 | 3767 overlay float pres_tissue_max; |
582 | 3768 overlay float supersat; |
608 | 3769 overlay float baseline_threshold; |
604 | 3770 |
623 | 3771 |
582 | 3772 // check if tissue is in supersaturation |
650 | 3773 if( calc_pres_tissue > real_pres_respiration ) |
582 | 3774 { |
618 | 3775 // calculate maximum allowed tissue pressure at current ambient pressure |
623 | 3776 pres_tissue_max = real_pres_respiration / var_b + var_a; |
618 | 3777 |
3778 // calculate current supersaturation value (1.0 = 100%) of this tissue according to straight Buhlmann | |
650 | 3779 supersat = ( calc_pres_tissue - real_pres_respiration ) |
3780 / ( pres_tissue_max - real_pres_respiration ); | |
618 | 3781 |
623 | 3782 // calculate supersaturation value for display purpose: 1.35 = 135% = 86 pixel |
3783 if( supersat <= 1.35 ) char_O_tissue_saturation[ci] = (unsigned char)(supersat * 64); | |
3784 else char_O_tissue_saturation[ci] = 86; | |
3785 | |
582 | 3786 // memorize highest supersaturation found |
3787 if( supersat > lead_supersat ) lead_supersat = supersat; | |
3788 | |
608 | 3789 // tissue-dependent baseline threshold for micro bubbles and outside warnings |
3790 baseline_threshold = 0.02 * ci + 1.0; | |
3791 | |
3792 // micro bubbles warning: supersaturation > baseline threshold | |
3793 if( supersat > baseline_threshold ) | |
623 | 3794 deco_warnings |= (DECO_WARNING_MBUBBLES + DECO_WARNING_MBUBBLES_lock); |
604 | 3795 |
608 | 3796 // outside warning: supersaturation > baseline threshold + additional 5% margin |
623 | 3797 if( supersat > (baseline_threshold + 0.05) ) |
3798 deco_warnings |= (DECO_WARNING_OUTSIDE + DECO_WARNING_OUTSIDE_lock ); | |
3799 } | |
3800 else | |
3801 { | |
3802 // supersaturation is defined as zero while tissue pressure <= ambient pressure | |
3803 supersat = 0.0; | |
3804 char_O_tissue_saturation[ci] = 0; | |
560 | 3805 } |
623 | 3806 |
3807 // next only when in surface mode | |
3808 if( surface_mode ) | |
3809 { | |
3810 // tag tissue whether it is beyond the M-line limit or not | |
3811 if( supersat > 1.0 ) | |
3812 { | |
3813 char_O_tissue_pres_N2[ci] |= 128; | |
3814 #ifdef _helium | |
3815 char_O_tissue_pres_He[ci] |= 128; | |
3816 #endif | |
3817 char_O_tissue_pressure[ci] |= 128; | |
3818 } | |
3819 else | |
3820 { | |
3821 char_O_tissue_pres_N2[ci] &= ~128; | |
3822 #ifdef _helium | |
3823 char_O_tissue_pres_He[ci] &= ~128; | |
3824 #endif | |
3825 char_O_tissue_pressure[ci] &= ~128; | |
3826 } | |
3827 } | |
3828 } // real tissues | |
582 | 3829 |
618 | 3830 // calculate the minimum ambient pressure that the tissue can withstand |
631 | 3831 if( char_I_model == 0 ) |
618 | 3832 { |
3833 // straight Buhlmann | |
650 | 3834 pres_ambient_min_tissue = (calc_pres_tissue - var_a) * var_b; |
618 | 3835 } |
3836 else | |
3837 { | |
3838 // Buhlmann with Eric Baker's varying gradient factor correction | |
3839 // note: this equation [1] is the inverse of equation [2] | |
650 | 3840 pres_ambient_min_tissue = ( calc_pres_tissue - (var_a * GF_parameter) ) |
631 | 3841 / ( 1.0 - GF_parameter + (GF_parameter / var_b ) ); |
618 | 3842 } |
560 | 3843 |
3844 // check if this tissue requires a higher ambient pressure than was found to be needed up to now | |
631 | 3845 if( pres_ambient_min_tissue > pres_ambient_min_overall ) |
582 | 3846 { |
631 | 3847 pres_ambient_min_overall = pres_ambient_min_tissue; |
3848 lead_tissue = ci; | |
582 | 3849 } |
3850 } // for | |
3851 | |
631 | 3852 // compute ceiling in bar relative pressure |
3853 ceiling = pres_ambient_min_overall - pres_surface; | |
3854 | |
3855 // limit ceiling to positive values | |
3856 if( ceiling < 0.0 ) ceiling = 0.0; | |
623 | 3857 |
3858 #ifdef _helium | |
3859 // IBCD is checked for real tissues only | |
3860 if( tissue_increment & TISSUE_SELECTOR ) | |
560 | 3861 { |
604 | 3862 // check if the leading tissue is in IBCD condition |
623 | 3863 if( (IBCD_tissue_vector & (1 << lead_tissue)) |
3864 && ((real_pres_tissue_N2[lead_tissue] + real_pres_tissue_He[lead_tissue]) > real_pres_respiration) ) | |
582 | 3865 { |
623 | 3866 // leading tissue is in IBCD condition and in super-saturation, so issue a warning. |
3867 deco_warnings |= (DECO_WARNING_IBCD + DECO_WARNING_IBCD_lock); | |
582 | 3868 } |
560 | 3869 } |
623 | 3870 #endif |
3871 | |
0 | 3872 } |
623 | 3873 |
3874 | |
0 | 3875 ////////////////////////////////////////////////////////////////////////////// |
623 | 3876 // calc_NDL_time_tissue |
3877 // | |
3878 // calculation of the remaining no decompression limit (NDL) time for a tissue | |
0 | 3879 // |
604 | 3880 // NOTE: Erik Baker's closed formula works for Nitrox. Trimix adds a second |
0 | 3881 // exponential term to the M-value equation, making it impossible to |
623 | 3882 // invert. So we have to solve the problem with a search approach. |
3883 // | |
3884 // Input: NDL_tissue tissue for which to calculate remaining NDL time | |
3885 // GF_high gradient factor used when GF factors are enabled | |
3886 // ppN2, ppHe partial pressures of N2 and He breathed | |
3887 // | |
3888 // Modified: NDL_time shortest NDL time found so far | |
3889 // NDL_tissue_lead leading tissue, i.e. tissue with the shortest NDL | |
3890 // | |
3891 static void calc_NDL_time_tissue(void) | |
0 | 3892 { |
623 | 3893 overlay unsigned char NDL_time_tissue = 0; // NDL time of this tissue, starting with 0 minutes |
3894 overlay unsigned char step_size = 10; // step size in searching, starting with 10 minutes | |
3895 overlay float pres_limit; // max. tissue pressure allowed | |
3896 | |
3897 #ifdef _helium | |
3898 overlay float last_pres_tissue_N2; // last tissue pressure for N2 | |
3899 overlay float last_pres_tissue_He; // last tissue pressure for He | |
3900 #else | |
3901 overlay float last_pres_tissue; // last tissue pressure | |
3902 #endif | |
3903 | |
3904 | |
3905 // set the compartment index ci for reading the Buhlmann increments and coefficients | |
3906 ci = NDL_tissue; | |
3907 | |
3908 // read the tissue increments for a step size of 10 minutes | |
3909 read_Buhlmann_times(2); | |
3910 | |
3911 // read Buhlmann a and b coefficients for tissue ci | |
3912 read_Buhlmann_coefficients(); | |
3913 | |
3914 #ifdef _helium | |
3915 | |
3916 // get the current simulated tissue pressures | |
3917 calc_pres_tissue_N2 = last_pres_tissue_N2 = sim_pres_tissue_N2[ci]; | |
3918 calc_pres_tissue_He = last_pres_tissue_He = sim_pres_tissue_He[ci]; | |
3919 | |
3920 #else | |
3921 | |
3922 // get the current simulated tissue pressure | |
650 | 3923 calc_pres_tissue = last_pres_tissue = sim_pres_tissue_N2[ci]; |
623 | 3924 |
3925 // set the a and b coefficients | |
3926 adopt_Buhlmann_coefficients(); | |
3927 | |
3928 #endif | |
3929 | |
3930 // simulate an increasing bottom time and check when the NDL is hit | |
3931 for(;;) | |
582 | 3932 { |
623 | 3933 |
3934 #ifdef _helium | |
3935 | |
3936 // calculate the total tissue pressure | |
650 | 3937 calc_pres_tissue = calc_pres_tissue_N2 + calc_pres_tissue_He; |
582 | 3938 |
623 | 3939 // adopt a and b coefficients to current N2/He ratio inside the tissue |
3940 adopt_Buhlmann_coefficients(); | |
3941 | |
3942 #endif | |
3943 | |
3944 // compute the maximum tissue pressure allowed to be exposed to an | |
3945 // ambient pressure equaling the surface pressure | |
631 | 3946 if( char_I_model != 0 ) |
623 | 3947 { |
3948 // GF model enabled, this equation [2] is the inverse of equation [1] | |
3949 pres_limit = (1.0 - GF_high + GF_high / var_b) * pres_surface + GF_high * var_a; | |
3950 } | |
3951 else | |
582 | 3952 { |
623 | 3953 // straight Buhlmann |
3954 pres_limit = pres_surface / var_b + var_a; | |
3955 } | |
3956 | |
3957 // is the tissue pressure higher than the maximum tissue pressure allowed? | |
650 | 3958 if( calc_pres_tissue > pres_limit) |
623 | 3959 { |
3960 // YES - tissue is outside NDL | |
3961 | |
3962 // was the tissue outside NDL right from the start? | |
3963 if( NDL_time_tissue == 0 ) | |
582 | 3964 { |
623 | 3965 // YES - search can be aborted |
3966 | |
3967 // at least one tissue is outside NDL, so overall NDL time is zero | |
3968 NDL_time = 0; | |
3969 | |
3970 // store the number of this tissue as being the leading one | |
3971 NDL_tissue_lead = NDL_tissue; | |
3972 | |
3973 // done | |
582 | 3974 break; |
3975 } | |
3976 | |
623 | 3977 // when code execution passes here, the tissue has become |
3978 // being outside NDL after doing one or more search steps | |
3979 | |
3980 // still searching with a step size of 10 minutes? | |
3981 if( step_size == 10 ) | |
582 | 3982 { |
623 | 3983 // YES - retry with smaller step size |
3984 | |
3985 // go back to last NDL time | |
3986 NDL_time_tissue -= 10; | |
3987 | |
3988 #ifdef _helium | |
3989 | |
3990 // go back to last pressures | |
3991 calc_pres_tissue_N2 = last_pres_tissue_N2; | |
3992 calc_pres_tissue_He = last_pres_tissue_He; | |
3993 | |
3994 #else | |
3995 | |
3996 // go back to last pressure | |
650 | 3997 calc_pres_tissue = last_pres_tissue; |
623 | 3998 |
3999 #endif | |
4000 | |
4001 // reduce step size to 1 minute | |
4002 step_size = 1; | |
4003 | |
4004 // read the tissue increments for a step size of 1 minute | |
4005 read_Buhlmann_times(1); | |
4006 | |
4007 // redo search from last pressure & time within NDL with smaller step size | |
582 | 4008 continue; |
4009 } | |
623 | 4010 else |
582 | 4011 { |
623 | 4012 // NO - already tried with a step size of 1 minute |
4013 | |
4014 // go back to last NDL time that was within NDL | |
4015 NDL_time_tissue -= 1; | |
4016 | |
4017 // is the NDL time of this tissue shorter than the overall NDL time found so far? | |
4018 if( NDL_time_tissue < NDL_time ) | |
4019 { | |
4020 // YES - set this tissue's NDL time as the new overall NDL time | |
4021 NDL_time = NDL_time_tissue; | |
4022 | |
4023 // - store the number of this tissue as being the leading one | |
4024 NDL_tissue_lead = NDL_tissue; | |
4025 } | |
4026 | |
4027 // done | |
4028 break; | |
582 | 4029 } |
623 | 4030 } |
4031 else | |
582 | 4032 { |
623 | 4033 // NO - tissue is still within NDL |
4034 | |
4035 // The search can be terminated when the NDL time of this tissue | |
4036 // exceeds the overall NDL time, thus when a shorter NDL time has | |
4037 // already been found with another tissue. | |
4038 if( NDL_time_tissue >= NDL_time ) break; | |
4039 | |
4040 #ifdef _helium | |
4041 | |
4042 // back-up current tissue pressures | |
4043 last_pres_tissue_N2 = calc_pres_tissue_N2; | |
4044 last_pres_tissue_He = calc_pres_tissue_He; | |
4045 | |
4046 #else | |
4047 | |
4048 // back-up current tissue pressure | |
650 | 4049 last_pres_tissue = calc_pres_tissue; |
623 | 4050 |
4051 #endif | |
4052 | |
4053 // step forward NDL time of current tissue | |
4054 NDL_time_tissue += step_size; | |
4055 | |
4056 #ifdef _helium | |
4057 | |
4058 // step forward tissue pressure - N2 | |
4059 temp_tissue = (ppN2 - calc_pres_tissue_N2) * var_N2_e; // pressure delta breathed - tissue | |
4060 apply_saturation_factors(); // apply safety factor | |
4061 calc_pres_tissue_N2 += temp_tissue; // add pressure delta to tissue | |
4062 | |
4063 // step forward tissue pressure - He | |
4064 temp_tissue = (ppHe - calc_pres_tissue_He) * var_He_e; // pressure delta breathed - tissue | |
4065 apply_saturation_factors(); // apply safety factor | |
4066 calc_pres_tissue_He += temp_tissue; // add pressure delta to tissue | |
4067 | |
4068 #else | |
4069 | |
4070 // step forward tissue pressure | |
650 | 4071 temp_tissue = (ppN2 - calc_pres_tissue ) * var_N2_e; // pressure delta breathed - tissue |
623 | 4072 apply_saturation_factors(); // apply safety factor |
650 | 4073 calc_pres_tissue += temp_tissue; // add pressure delta to tissue |
623 | 4074 |
4075 #endif | |
4076 | |
582 | 4077 } |
623 | 4078 } |
0 | 4079 } |
4080 | |
604 | 4081 |
0 | 4082 ////////////////////////////////////////////////////////////////////////////// |
4083 // clear_deco_table | |
4084 // | |
623 | 4085 // Modified: internal_deco_time[] stop durations |
4086 // internal_deco_depth[] stop depths | |
4087 // internal_deco_gas[] gases used at stops | |
0 | 4088 // |
4089 static void clear_deco_table(void) | |
4090 { | |
623 | 4091 for( i = 0; i < NUM_STOPS; ++i ) |
582 | 4092 { |
623 | 4093 internal_deco_time [i] = 0; |
4094 internal_deco_depth[i] = 0; | |
4095 internal_deco_gas[i] = 0; | |
582 | 4096 } |
4097 | |
628 | 4098 // reset stop table index and chained stops counter |
4099 stop_index = 0; | |
4100 chained_stops = 0; | |
4101 | |
560 | 4102 // clear stop table overflow warning |
628 | 4103 deco_warnings &= ~DECO_WARNING_INCOMPLETE; |
0 | 4104 } |
4105 | |
623 | 4106 |
0 | 4107 ////////////////////////////////////////////////////////////////////////////// |
4108 // update_deco_table | |
4109 // | |
623 | 4110 // Add time to a stop at char_depth_sim |
560 | 4111 // |
4112 // It is possible to create stops with a duration of 0 minutes, e.g. to | |
4113 // note a gas change "on the fly" while ascending. Therefore the criteria | |
604 | 4114 // to have reached the end of the list is depth == 0. |
0 | 4115 // |
623 | 4116 // Input: char_depth_sim stop's depth, in meters |
4117 // sim_gas_current_num gas used at stop, as index 1..5 or 0 for gas 6 | |
4118 // time_increment number of minutes to add to the stop | |
4119 // | |
4120 // Updated: internal_deco_depth[] depth (in meters) of each stop | |
4121 // internal_deco_time [] time (in minutes) of each stop | |
4122 // internal_deco_gas [] gas used (index 1-5) at each stop | |
560 | 4123 // |
631 | 4124 static void update_deco_table(PARAMETER unsigned char time_increment) |
0 | 4125 { |
623 | 4126 assert( char_depth_sim > 0 ); // no stop at surface |
560 | 4127 |
628 | 4128 |
4129 // is there already a stop entry matching with the current depth and gas? | |
4130 if( internal_deco_depth[stop_index] == char_depth_sim ) | |
4131 if( internal_deco_gas [stop_index] == sim_gas_current_num ) | |
560 | 4132 { |
628 | 4133 // YES - increment stop time if possible, stop time entries are |
4134 // limited to 99 minutes because of display constraints | |
4135 if( internal_deco_time[stop_index] < (100 - time_increment) ) | |
560 | 4136 { |
628 | 4137 // YES - time increment fits into current stop entry, |
631 | 4138 // increment stop time |
628 | 4139 internal_deco_time[stop_index] += time_increment; |
631 | 4140 |
4141 // done | |
4142 return; | |
628 | 4143 } |
4144 else | |
4145 { | |
4146 // NO - A chained stop entry will be created further down in the | |
4147 // code to continue the stop, but we will limit the number | |
4148 // of chained stop table entries in order to abort an ever- | |
4149 // running deco calculation. Too many chained entries? | |
4150 if( ++chained_stops >= STOP_CHAINING_LIMIT ) | |
560 | 4151 { |
631 | 4152 // YES - set warning that calculations took too long |
628 | 4153 deco_warnings |= DECO_WARNING_INCOMPLETE; |
631 | 4154 |
4155 // done | |
4156 return; | |
560 | 4157 } |
4158 } | |
628 | 4159 } |
4160 | |
4161 // the current stop entry does not match the current depth and gas, | |
4162 // or hasn't enough room left for the time increment | |
4163 | |
4164 // is the current stop entry in use? | |
4165 if( internal_deco_depth[stop_index] > 0 ) | |
4166 { | |
4167 // YES - current entry is in use, need to move on | |
4168 // to next entry position if possible | |
4169 | |
4170 // have all entry positions been used up? | |
4171 if( stop_index < (NUM_STOPS - 1) ) | |
560 | 4172 { |
628 | 4173 // NO - move on to next entry position |
4174 stop_index += 1; | |
4175 } | |
4176 else | |
4177 { | |
631 | 4178 // YES - if run in deco calculator mode, set a warning that there is an overflow in the stops table |
4179 if( main_status & CALCULATE_BOTTOM ) deco_warnings |= DECO_WARNING_INCOMPLETE; | |
4180 | |
4181 // limit runtime via reached TTS (scaled in 1/10 minutes here) | |
4182 if( TTS_time > 9999 ) deco_warnings |= DECO_WARNING_INCOMPLETE; | |
4183 | |
4184 // done | |
4185 return; | |
560 | 4186 } |
4187 } | |
4188 | |
631 | 4189 // initial use of a new (or the very first) stop entry, store all stop data |
628 | 4190 internal_deco_time [stop_index] = time_increment; |
4191 internal_deco_depth[stop_index] = char_depth_sim; | |
4192 internal_deco_gas [stop_index] = sim_gas_current_num; | |
631 | 4193 |
4194 // done | |
4195 return; | |
628 | 4196 } |
4197 | |
4198 | |
4199 ////////////////////////////////////////////////////////////////////////////// | |
4200 // publish_deco_table | |
4201 // | |
4202 // Input: internal_deco_depth[] depth in internal stops table | |
4203 // internal_deco_time[] times ... | |
4204 // internal_deco_gas[] gases ... | |
4205 // | |
4206 // Output: char_O_deco_depth[] depth in the external stops table | |
4207 // char_O_deco_time[] times ... | |
4208 // char_O_deco_gas[] gases ... | |
4209 // char_O_deco_time_for_log times in reverse order | |
4210 // | |
4211 static void publish_deco_table(void) | |
4212 { | |
4213 overlay unsigned char x = stop_index; | |
4214 overlay unsigned char y; | |
4215 | |
4216 | |
4217 // copy depth, time and gas from internal to external stops table | |
4218 for( y = 0; y < NUM_STOPS; y++ ) | |
4219 { | |
4220 char_O_deco_depth[y] = internal_deco_depth[y]; | |
4221 char_O_deco_time [y] = internal_deco_time [y]; | |
4222 char_O_deco_gas [y] = internal_deco_gas [y]; | |
4223 } | |
4224 | |
4225 // copy times of shallowest stops to logging table | |
4226 for(y = 0; y < NUM_STOPS_LOG; x-- ) | |
4227 { | |
4228 // copy all stops that have a non-null stop time | |
4229 if( internal_deco_time[x] ) | |
4230 char_O_deco_time_for_log[y++] = internal_deco_time[x]; | |
4231 | |
4232 // abort if all stops are copied | |
4233 if( x == 0) break; | |
4234 } | |
4235 | |
4236 // fill the remainder of the logging table with null | |
4237 // if it is not completely filled already | |
4238 while( y < NUM_STOPS_LOG ) | |
4239 { | |
4240 char_O_deco_time_for_log[y++] = 0; | |
4241 } | |
0 | 4242 } |
4243 | |
4244 | |
4245 ////////////////////////////////////////////////////////////////////////////// | |
623 | 4246 // calc_desaturation_time_helper |
0 | 4247 // |
560 | 4248 // Helper function |
4249 // | |
623 | 4250 // Input: pres_actual current tissue pressure |
4251 // pres_target target tissue pressure | |
4252 // var_ht half-time of the tissue | |
4253 // desat_factor desaturation factor | |
4254 // | |
4255 // Output: int_time time needed by tissue to reach target pressure | |
4256 // | |
604 | 4257 static void calc_desaturation_time_helper(void) |
0 | 4258 { |
623 | 4259 // check if actual pressure is higher then target pressure |
4260 if( pres_actual > pres_target ) | |
4261 { | |
4262 // YES - compute remaining time | |
4263 | |
604 | 4264 overlay float pres_ratio; |
582 | 4265 |
623 | 4266 // compute pressure ratio to archive |
560 | 4267 pres_ratio = pres_actual / pres_target; |
4268 | |
4269 // Compute desaturation time with result rounded up to multiples of 10 minutes. | |
582 | 4270 // Main purpose is to avoid confusion, because the times do not clock down in |
4271 // one minute steps any more but get constantly re-computed according to current | |
4272 // ambient pressure and may therefor make steps of several minutes forwards and | |
604 | 4273 // backwards as ambient pressure rises/falls and N2/He ratio is being adjusted. |
623 | 4274 int_time = (unsigned short)( (var_ht * log(pres_ratio) / desat_factor) + 0.9 ); |
560 | 4275 } |
4276 else | |
623 | 4277 { |
4278 // NO - desaturation state reached, no remaining time | |
582 | 4279 int_time = 0; |
560 | 4280 } |
4281 } | |
4282 | |
623 | 4283 |
560 | 4284 ///////////////////////////////////////////////////////////////////////////// |
604 | 4285 // calc_desaturation_time |
4286 // | |
623 | 4287 // Calculates the time needed for the tissues to equilibrate with |
4288 // surface pressure and the no-fly / no-altitude time. | |
4289 // | |
4290 // Input: int_I_pres_surface | |
4291 // char_I_desaturation_multiplier | |
4292 // | |
4293 // Output: int_O_desaturation_time | |
4294 // int_O_nofly_time | |
560 | 4295 // |
4296 void calc_desaturation_time(void) | |
4297 { | |
623 | 4298 overlay float P_ambient_altitude; |
4299 | |
604 | 4300 assert( 800 < int_I_pres_surface && int_I_pres_surface < 1100 ); |
4301 assert( 0 < char_I_desaturation_multiplier && char_I_desaturation_multiplier <= 100 ); | |
4302 | |
4303 | |
623 | 4304 // safeguard and convert surface pressure |
4305 if( int_I_pres_surface < 500) pres_surface = 0.5; | |
4306 else pres_surface = 0.001 * int_I_pres_surface; | |
4307 | |
4308 // calculate partial pressure of N2 in respired air at surface pressure | |
4309 calc_N2_equilibrium(); | |
4310 | |
4311 // get, safeguard and convert the saturation and desaturation factors | |
4312 get_saturation_factors(); | |
4313 | |
4314 // pre-computed term for later use: 10 [Min] * 0.6931 [=log(2)] * 1 [Desat Factor] * ... | |
4315 desat_factor = (6.931 * SURFACE_DESAT_FACTOR) * float_desaturation_multiplier; | |
582 | 4316 |
4317 // initialize vars | |
560 | 4318 int_O_desaturation_time = 0; |
582 | 4319 int_O_nofly_time = 0; |
4320 | |
623 | 4321 // get selected target altitude |
4322 switch( char_I_altitude_wait ) | |
4323 { | |
4324 case 1: P_ambient_altitude = P_ambient_1000m; break; | |
4325 case 2: P_ambient_altitude = P_ambient_2000m; break; | |
4326 case 3: P_ambient_altitude = P_ambient_3000m; break; | |
4327 default: P_ambient_altitude = P_ambient_fly; break; | |
4328 } | |
4329 | |
4330 // loop over all compartments in order slowest to fastest | |
604 | 4331 for( ci = NUM_COMP; ci > 0; ) |
582 | 4332 { |
623 | 4333 overlay float pres_tissue_max; |
4334 overlay unsigned short nofly_last = ~0; | |
4335 overlay unsigned short nofly_N2 = 0; | |
4336 | |
4337 #ifdef _helium | |
4338 overlay signed char search_direction; | |
4339 overlay unsigned short nofly_He = 0; | |
4340 #endif | |
4341 | |
4342 | |
4343 // decrement compartment index | |
560 | 4344 ci -= 1; |
582 | 4345 |
623 | 4346 // get the Buhlmann halftimes and coefficients |
582 | 4347 read_Buhlmann_ht(); |
560 | 4348 read_Buhlmann_coefficients(); |
582 | 4349 |
623 | 4350 |
4351 // | |
4352 // Desaturation time | |
4353 // | |
4354 | |
4355 // calculate desaturation time for N2 in tissue, | |
4356 // desaturated state is defined as residual tissue pressure <= 1.05 x ppN2 respired | |
4357 | |
4358 // current tissue pressure above equilibrium pressure | |
4359 pres_actual = real_pres_tissue_N2[ci] - N2_equilibrium; | |
4360 | |
4361 // target pressure above equilibrium pressure | |
4362 pres_target = 0.05 * N2_equilibrium; | |
4363 | |
4364 // half-time of the current tissue | |
4365 var_ht = var_N2_ht; | |
4366 | |
4367 // calculate desaturation time | |
4368 calc_desaturation_time_helper(); | |
4369 | |
4370 // store desaturation time if it is longer than longest found so far | |
4371 if( int_time > int_O_desaturation_time) int_O_desaturation_time = int_time; | |
4372 | |
4373 | |
4374 #ifdef _helium | |
4375 | |
4376 // calculate desaturation time for He in the tissue, | |
4377 // desaturated state is defined as residual tissue pressure <= 0.05 x ppN2 respired | |
4378 | |
4379 // actual tissue pressure above equilibrium: equilibrium for He is 0 bar | |
4380 pres_actual = real_pres_tissue_He[ci]; | |
4381 | |
4382 // target pressure above equilibrium pressure: use same target pressure as for N2 | |
4383 pres_target = 0.05 * N2_equilibrium; | |
4384 | |
4385 // half-time of the current tissue | |
4386 var_ht = var_He_ht; | |
4387 | |
4388 // calculate desaturation time | |
4389 calc_desaturation_time_helper(); | |
4390 | |
4391 // store desaturation time if it is longer than longest found so far | |
4392 if( int_time > int_O_desaturation_time) int_O_desaturation_time = int_time; | |
4393 | |
4394 #endif | |
4395 | |
4396 // | |
4397 // no-fly time | |
4398 // | |
582 | 4399 |
560 | 4400 // Target pressure for the tissue is the Buhlmann limit. We use the Buhlmann |
4401 // coefficients for N2 also for He because it is easier to calculate and the | |
4402 // N2 coefficients are more conservative than those for He, so we are on the | |
4403 // safe side, too. | |
582 | 4404 pres_tissue_max = (P_ambient_altitude/var_N2_b + var_N2_a); |
4405 | |
623 | 4406 // adjust target pressure by GF-high in case the GF model is in use, but not |
4407 // for the no-fly time as it's target pressure is hard to reach anyhow | |
631 | 4408 if( char_I_model && char_I_altitude_wait ) |
623 | 4409 pres_tissue_max = P_ambient_altitude + |
4410 0.01 * char_I_GF_High_percentage * (pres_tissue_max - P_ambient_altitude); | |
4411 | |
4412 | |
4413 #ifdef _helium | |
4414 | |
4415 //---- Variant with Helium ------------------------------------------- | |
4416 | |
4417 // initialize split_N2_He in case there was a hard reboot / memory clear | |
604 | 4418 if( split_N2_He[ci] == 0 ) split_N2_He[ci] = 90; |
4419 | |
560 | 4420 // initialize search direction |
4421 search_direction = 0; | |
582 | 4422 |
560 | 4423 for(;;) |
4424 { | |
4425 // Calculate no-fly time for N2 in the tissue. | |
4426 // Flying is permitted when the N2 pressure fits into the assigned fraction above equilibrium. | |
4427 | |
623 | 4428 // current tissue pressure above equilibrium |
4429 pres_actual = real_pres_tissue_N2[ci] - N2_equilibrium; | |
4430 | |
4431 // target pressure above equilibrium pressure, weighted by N2/He split | |
560 | 4432 pres_target = (split_N2_He[ci] * 0.01) * (pres_tissue_max - N2_equilibrium); |
4433 | |
623 | 4434 // half-time of the current tissue |
4435 var_ht = var_N2_ht; | |
4436 | |
4437 // check if desaturation to target pressure is possible at all | |
4438 if( pres_target < 0.0 ) | |
560 | 4439 { |
623 | 4440 // NO - set no-fly time to 288 * 10 min = 48 h |
4441 int_O_nofly_time = 288; | |
4442 break; | |
560 | 4443 } |
604 | 4444 else |
560 | 4445 { |
623 | 4446 // YES - calculate desaturation time |
560 | 4447 calc_desaturation_time_helper(); |
623 | 4448 |
4449 // store time found | |
582 | 4450 nofly_N2 = int_time; |
560 | 4451 } |
582 | 4452 |
623 | 4453 // calculate no-fly time for He in the tissue, |
4454 // flying is permitted when the He pressure fits into the assigned fraction | |
4455 | |
4456 // current tissue pressure above equilibrium: equilibrium for He is 0 bar | |
4457 pres_actual = real_pres_tissue_He[ci]; | |
4458 | |
4459 // target pressure above equilibrium pressure, weighted by N2/He split | |
4460 pres_target = ((100 - split_N2_He[ci]) * 0.01) * (pres_tissue_max - N2_equilibrium); | |
4461 | |
4462 // half-time of the current tissue | |
582 | 4463 var_ht = var_He_ht; |
4464 | |
623 | 4465 // calculate desaturation time |
560 | 4466 calc_desaturation_time_helper(); |
623 | 4467 |
4468 // store time found | |
582 | 4469 nofly_He = int_time; |
560 | 4470 |
4471 | |
4472 // Because the sum of N2 and He tissue pressures needs to fit into the Buhlmann limit for | |
4473 // no-fly time calculation, each gas gets assigned a fraction of the available total pressure | |
623 | 4474 // limit. The optimum split between the two gases can not be computed by a single formula, |
560 | 4475 // because this would require the inversion of a function with two exponential terms, which is |
4476 // not possible. We do not want to do a computational complex simulation here like it is done | |
4477 // in the deco calculation code (although we tackle the same base problem here), so we just let | |
4478 // the computer try out which split will balance the no-fly times induced by the N2 and the He | |
4479 // at best. | |
582 | 4480 |
560 | 4481 // first of all, skip any optimization in case the current compartment is not the leading one |
4482 if( (nofly_N2 <= int_O_nofly_time) && (nofly_He <= int_O_nofly_time) ) break; | |
4483 | |
4484 // check if the N2 requires more waiting time than the He | |
582 | 4485 if( nofly_N2 >= nofly_He ) |
560 | 4486 { |
4487 // check if the search direction has changed, which means we are beyond the | |
4488 // optimum now, or if we are at the upper stop limit of split_N2_He | |
4489 if( (search_direction < 0) || (split_N2_He[ci] == 99) ) | |
604 | 4490 { |
623 | 4491 // either the just completed iteration was more close to the optimum or the one before |
4492 // was, so we take the best (i.e. shortest) time of both as the final no-fly time | |
560 | 4493 int_O_nofly_time = (nofly_N2 < nofly_last) ? nofly_N2 : nofly_last; |
623 | 4494 |
4495 // done | |
560 | 4496 break; |
4497 } | |
4498 | |
4499 // store the no-fly time found in this iteration | |
582 | 4500 nofly_last = nofly_N2; |
4501 | |
623 | 4502 // increase the N2 fraction of the split |
560 | 4503 split_N2_He[ci] += 1; |
623 | 4504 |
4505 // set search direction towards more N2 | |
560 | 4506 search_direction = +1; |
4507 } | |
4508 else | |
4509 { | |
4510 // check if the search direction has changed, which means we are beyond the | |
4511 // optimum now, or if we are at the lower stop limit of split_N2_He | |
4512 if( (search_direction > 0) || (split_N2_He[ci] == 1) ) | |
582 | 4513 { |
623 | 4514 // either the just completed iteration was more close to the optimum or the one before |
4515 // was, so we take the best (i.e. shortest) time of both as the final no-fly time | |
560 | 4516 int_O_nofly_time = (nofly_He < nofly_last) ? nofly_He : nofly_last; |
623 | 4517 |
4518 // done | |
560 | 4519 break; |
4520 } | |
4521 | |
4522 // store the no-fly time found in this iteration | |
582 | 4523 nofly_last = nofly_He; |
4524 | |
623 | 4525 // decrease the N2 fraction of the split |
560 | 4526 split_N2_He[ci] -= 1; |
623 | 4527 |
4528 // set search direction towards less N2 | |
604 | 4529 search_direction = -1; |
560 | 4530 } |
582 | 4531 |
560 | 4532 } // for(;;) |
4533 | |
623 | 4534 #else |
4535 | |
4536 //---- Variant without Helium ---------------------------------------- | |
4537 | |
4538 // current tissue pressure above equilibrium | |
4539 pres_actual = real_pres_tissue_N2[ci] - N2_equilibrium; | |
4540 | |
4541 // target pressure above equilibrium pressure | |
4542 pres_target = pres_tissue_max - N2_equilibrium; | |
4543 | |
4544 // half-time of the current tissue | |
4545 var_ht = var_N2_ht; | |
4546 | |
4547 // check if desaturation to target pressure is possible at all | |
4548 if( pres_target < 0.0 ) | |
4549 { | |
4550 // NO - set no-fly time to 288 * 10 min = 48 h | |
4551 int_O_nofly_time = 288; | |
4552 } | |
4553 else | |
4554 { | |
4555 // YES - calculate desaturation time | |
4556 calc_desaturation_time_helper(); | |
4557 | |
4558 // - extend desaturation time if this tissue needs | |
4559 // more time than already found to be needed | |
4560 if( int_time > int_O_nofly_time ) int_O_nofly_time = int_time; | |
4561 } | |
4562 | |
4563 #endif | |
4564 | |
560 | 4565 } // for(compartments) |
4566 | |
582 | 4567 |
623 | 4568 // rescale int_O_desaturation_time and int_O_nofly_time to full minutes for display purpose |
560 | 4569 int_O_desaturation_time *= 10; |
4570 int_O_nofly_time *= 10; | |
582 | 4571 |
623 | 4572 // limit int_O_desaturation_time and int_O_nofly_time to 5999 = 99 hours + 59 minutes |
4573 // because of display space constraints and rounding done above | |
560 | 4574 if( int_O_desaturation_time > 5999 ) int_O_desaturation_time = 5999; |
4575 if( int_O_nofly_time > 5999 ) int_O_nofly_time = 5999; | |
4576 | |
4577 | |
623 | 4578 // Clear the micro bubbles warning when the current gradient factor is < 100%. |
604 | 4579 // The current gradient factor is calculated by calc_interval() while not in diving mode. |
4580 // As the locked warning will stay set, this will cause the warning be be displayed in | |
4581 // attention color instead of warning color. | |
623 | 4582 if( int_O_lead_supersat < 100 ) |
4583 deco_warnings &= ~DECO_WARNING_MBUBBLES; | |
582 | 4584 |
560 | 4585 // clear some warnings when the desaturation time has become zero |
582 | 4586 if( int_O_desaturation_time == 0 ) |
623 | 4587 deco_warnings &= ~( DECO_WARNING_IBCD + DECO_WARNING_IBCD_lock |
4588 + DECO_WARNING_MBUBBLES + DECO_WARNING_MBUBBLES_lock | |
4589 + DECO_WARNING_OUTSIDE + DECO_WARNING_OUTSIDE_lock | |
4590 + DECO_ATTENTION_OUTSIDE ); | |
0 | 4591 } |
4592 | |
623 | 4593 |
0 | 4594 ////////////////////////////////////////////////////////////////////////////// |
582 | 4595 // Calculate desaturation of the real tissues for a given time interval |
0 | 4596 // |
582 | 4597 // Caution: Works on the real tissues! |
4598 // If in doubt, use this function only inside a context surrounded with | |
4599 // push_tissues_to_vault() / pull_tissues_from_vault() ! | |
4600 // | |
623 | 4601 // Input: int_I_pres_surface surface pressure in mbar |
4602 // time_interval time interval in minutes, must be limited to 254 at max | |
4603 // | |
4604 // Modified: tissue pressures N2 and He pressures of the tissues | |
4605 // CNS_fraction_real current real CNS value | |
631 | 4606 // ceiling minimum allowed depth in bar relative pressure |
623 | 4607 // lead_supersat supersaturation of the leading tissue (float) |
4608 // int_O_lead_supersat supersaturation of the leading tissue (integer) | |
631 | 4609 // char_O_lead_tissue number of the leading tissue |
560 | 4610 // |
582 | 4611 static void calc_interval(PARAMETER unsigned char time_interval) |
0 | 4612 { |
582 | 4613 overlay unsigned char time; |
4614 | |
4615 assert( 800 < int_I_pres_surface && int_I_pres_surface < 1100 ); | |
604 | 4616 assert( 100 <= char_I_saturation_multiplier && char_I_saturation_multiplier < 200 ); |
4617 assert( 0 < char_I_desaturation_multiplier && char_I_desaturation_multiplier <= 100 ); | |
4618 | |
4619 | |
623 | 4620 // safeguard and convert surface pressure |
4621 if( int_I_pres_surface < 500) pres_surface = 0.500; | |
4622 else pres_surface = 0.001 * int_I_pres_surface; | |
4623 | |
631 | 4624 // safeguard time interval |
4625 if( time_interval > 254 ) time_interval = 254; | |
4626 | |
623 | 4627 // set breathed pressure to surface pressure |
4628 real_pres_respiration = pres_surface; | |
4629 | |
4630 // calculate partial pressure of N2 in respired air at surface pressure | |
4631 calc_N2_equilibrium(); | |
4632 | |
4633 // calculate partial pressures (0.7902 is fraction of N2 in atmosphere as of Buhlmann) | |
4634 ppN2 = N2_equilibrium; | |
4635 ppHe = 0.0; | |
4636 | |
4637 // get, safeguard and convert the saturation and desaturation factors | |
4638 get_saturation_factors(); | |
4639 | |
4640 // adjust desaturation factor to surface mode | |
4641 float_desaturation_multiplier *= SURFACE_DESAT_FACTOR; | |
582 | 4642 |
4643 // Calculate the tissues: | |
4644 // Because calc_tissues() can calculate for 127 minutes at max, | |
4645 // the tissue updating may need to be done in two chunks. | |
4646 | |
4647 time = time_interval; | |
4648 | |
4649 // first chunk for the part exceeding 127 minutes | |
4650 if( time > 127) | |
560 | 4651 { |
582 | 4652 // do a full 127 minutes on the real tissues |
623 | 4653 tissue_increment = TISSUE_SELECTOR | 127; |
582 | 4654 calc_tissues(); |
4655 | |
623 | 4656 // determine the remaining time |
582 | 4657 time -= 127; |
560 | 4658 } |
4659 | |
623 | 4660 // program the remaining time (or full time if not exceeding 127 minutes) on the real tissues |
4661 tissue_increment = TISSUE_SELECTOR | time; | |
604 | 4662 |
4663 // update the N2 and He pressures in the tissues | |
582 | 4664 calc_tissues(); |
4665 | |
560 | 4666 |
4667 // Calculate CNS: | |
4668 // To speed up things and because on most invocations of this code char_I_dive_interval | |
4669 // is a multiple of 10 minutes, we loop the loop-counter down using two speeds. | |
4670 | |
582 | 4671 time = time_interval; |
4672 | |
604 | 4673 while( time ) |
560 | 4674 { |
582 | 4675 if( time > 9 ) |
560 | 4676 { |
623 | 4677 CNS_fraction_real *= 0.925874712; // half-time = 90 min -> 10 min: (1/2)^(1/9) |
4678 time -= 10; // fast speed looping | |
560 | 4679 } |
4680 else | |
4681 { | |
623 | 4682 CNS_fraction_real *= 0.992327946; // half-time = 90 min -> 1 min: (1/2)^(1/90) |
4683 time -= 1; // slow speed looping | |
560 | 4684 } |
582 | 4685 } |
560 | 4686 |
623 | 4687 // convert the CNS value to integer |
4688 convert_cur_CNS_for_display(); | |
4689 | |
4690 // calculate the supersaturation of the leading tissue, the | |
4691 // negative argument puts calc_limit() into surface mode | |
4692 // Attention: do not pass char_I_GF_High_percentage as an argument | |
4693 // here because it is not configured outside dive mode | |
4694 calc_limit(-1.0); | |
4695 | |
4696 // convert the saturation value of the leading tissue to integer | |
4697 convert_sat_for_display(); | |
0 | 4698 } |
4699 | |
560 | 4700 |
4701 ////////////////////////////////////////////////////////////////////////////// | |
604 | 4702 // calc_CNS |
560 | 4703 // |
623 | 4704 // Input: char_ppO2 current ppO2 [in 0.1 bars] |
631 | 4705 // tissue_increment tissue selector and time interval |
623 | 4706 // |
4707 // Modified: CNS_fraction_real accumulated CNS (real tissue context) | |
4708 // CNS_fraction_sim accumulated CNS (simulated tissue context) | |
560 | 4709 // |
604 | 4710 static void calc_CNS(void) |
560 | 4711 { |
604 | 4712 overlay float CNS_fraction_inc; // increment of CNS load, 0.01 = 1% |
623 | 4713 |
4714 | |
631 | 4715 // calculate CNS increment for a 2 seconds interval |
623 | 4716 if( char_ppO2 > 160 ) |
4717 { | |
4718 // step-wise CNS increment | |
4719 | |
631 | 4720 // calculate index for increment look-up (uses integer division) |
4721 cns_i = (char_ppO2 - 161) / 5; | |
623 | 4722 |
628 | 4723 // indexes > 17 use increment of index 17 |
4724 if( cns_i > 17 ) cns_i = 17; | |
4725 | |
623 | 4726 // read coefficient (increment) |
4727 read_CNS_c_coefficient(); | |
4728 | |
4729 // re-scale coefficient from storage format in [1/100000] to productive value | |
631 | 4730 CNS_fraction_inc = (float)var_cns_value / 100000.0; |
623 | 4731 } |
4732 else if( char_ppO2 > 50 ) | |
4733 { | |
4734 // range wise CNS increment approximation | |
4735 | |
631 | 4736 // calculate index for approximation coefficients look-up (uses integer division) |
4737 cns_i = (char_ppO2 - 51) / 10; | |
623 | 4738 |
4739 // read coefficients | |
4740 read_CNS_ab_coefficient(); | |
4741 | |
4742 // calculate the CNS increment | |
631 | 4743 CNS_fraction_inc = 1.0 / (var_cns_gain * char_ppO2 + var_cns_offset ); |
623 | 4744 } |
4745 else | |
631 | 4746 { // no increment for a ppO2 of up to 0.5 bar |
623 | 4747 CNS_fraction_inc = 0.0; |
4748 } | |
4749 | |
631 | 4750 // apply a time factor in case of: |
4751 // - simulated tissues and interval = 0 (i.e. 6 seconds to do) -> factor 3 | |
4752 // - any tissues and interval > 0 (i.e. i minutes to do) -> factor 30 * i | |
4753 if( tissue_increment == 0 ) CNS_fraction_inc *= 3.0; | |
4754 else if( tissue_increment & TIME_MASK ) CNS_fraction_inc *= 30.0 * (float)(tissue_increment & TIME_MASK); | |
4755 | |
604 | 4756 |
4757 // update the CNS accumulator | |
623 | 4758 if ( tissue_increment & TISSUE_SELECTOR ) CNS_fraction_real += CNS_fraction_inc; // real tissues |
4759 else CNS_fraction_sim += CNS_fraction_inc; // simulated tissues | |
4760 } | |
4761 | |
4762 | |
4763 ////////////////////////////////////////////////////////////////////////////// | |
631 | 4764 // calc_required_volume |
623 | 4765 // |
4766 // Calculates the gas volume required for a given depth, time and usage (SAC) | |
4767 // rate. It uses a fixed surface pressure of 1.0 bar to deliver stable results | |
4768 // when used through the deco calculator. | |
4769 // | |
628 | 4770 // Input: gas_needs_depth depth in meters |
631 | 4771 // gas_needs_time time in minutes (0 encodes 1/10 minute) |
628 | 4772 // gas_needs_usage_rate gas usage in liters per minute at surface pressure |
623 | 4773 // |
628 | 4774 // Output: gas_needs_volume_due required gas volume in liters |
623 | 4775 // |
631 | 4776 static void calc_required_volume(void) |
623 | 4777 { |
631 | 4778 // calculate volume for 1 minute |
4779 gas_needs_volume_due = ((float)gas_needs_depth * METER_TO_BAR + pres_surface) * gas_needs_usage_rate; | |
4780 | |
4781 // multiply 1-minute-volume with time factor if time factor <> 1 | |
4782 if ( gas_needs_time == 0 ) gas_needs_volume_due *= 0.1; // 1/10 minute | |
4783 else if ( gas_needs_time > 1 ) gas_needs_volume_due *= gas_needs_time; // multiple minutes | |
0 | 4784 } |
4785 | |
560 | 4786 |
631 | 4787 |
4788 #ifdef _rx_functions | |
4789 | |
0 | 4790 ////////////////////////////////////////////////////////////////////////////// |
623 | 4791 // calc_TR_functions |
4792 // | |
4793 // Process Pressure Readings (OSTC TR only) | |
4794 // | |
4795 // Input: todo | |
4796 // | |
4797 // Output: todo | |
4798 // | |
4799 static void calc_TR_functions(void) | |
560 | 4800 { |
623 | 4801 // pressure warnings for reading 1, but only if enabled and pressure value available |
4802 if( (char_I_pressure_gas[0] > 0) && !(int_IO_pressure_value[0] & INT_FLAG_NOT_AVAIL) ) | |
604 | 4803 { |
623 | 4804 overlay unsigned short pressure_value = int_IO_pressure_value[0] & ~INT_FLAG_OUTDATED; |
4805 | |
4806 if( (char_I_pressure_gas[0] < 6 ) && !(int_O_pressure_need[0] & INT_FLAG_NOT_AVAIL) ) | |
4807 { | |
4808 // not a diluent and need available: warning & attention by need | |
4809 if ( pressure_value <= int_O_pressure_need[0]) | |
4810 int_IO_pressure_value[0] |= INT_FLAG_WARNING; | |
4811 else if( pressure_value <= int_O_pressure_need[0] + int_O_pressure_need[0] / 2 ) | |
4812 int_IO_pressure_value[0] |= INT_FLAG_ATTENTION; | |
4813 } | |
4814 else | |
4815 { | |
4816 // a diluent or need not available: warning & attention by fixed thresholds | |
4817 if ( pressure_value <= PRESSURE_LIMIT_WARNING ) int_IO_pressure_value[0] |= INT_FLAG_WARNING; | |
4818 else if ( pressure_value <= PRESSURE_LIMIT_ATTENTION ) int_IO_pressure_value[0] |= INT_FLAG_ATTENTION; | |
4819 } | |
604 | 4820 } |
4821 | |
623 | 4822 // pressure warnings for reading 2, but only if enabled and pressure value available |
4823 if( (char_I_pressure_gas[1] > 0) && !(int_IO_pressure_value[1] & INT_FLAG_NOT_AVAIL) ) | |
560 | 4824 { |
623 | 4825 overlay unsigned short pressure_value = int_IO_pressure_value[1] & ~INT_FLAG_OUTDATED; |
4826 | |
4827 if( (char_I_pressure_gas[1] < 6 ) && !(int_O_pressure_need[1] & INT_FLAG_NOT_AVAIL) ) | |
560 | 4828 { |
623 | 4829 // not a diluent and need available: warning & attention by need |
4830 if ( pressure_value <= int_O_pressure_need[1]) | |
4831 int_IO_pressure_value[1] |= INT_FLAG_WARNING; | |
4832 else if ( pressure_value <= int_O_pressure_need[1] + int_O_pressure_need[1] / 2 ) | |
4833 int_IO_pressure_value[1] |= INT_FLAG_ATTENTION; | |
560 | 4834 } |
4835 else | |
4836 { | |
623 | 4837 // a diluent or need not available: warning & attention by fixed thresholds |
4838 if ( pressure_value <= PRESSURE_LIMIT_WARNING ) int_IO_pressure_value[1] |= INT_FLAG_WARNING; | |
4839 else if ( pressure_value <= PRESSURE_LIMIT_ATTENTION ) int_IO_pressure_value[1] |= INT_FLAG_ATTENTION; | |
560 | 4840 } |
4841 } | |
582 | 4842 |
623 | 4843 //--- SAC Calculation --------------------------------------------------------------------- |
4844 // | |
4845 // char_I_SAC_mode =0: disabled | |
4846 // =1: SAC from 1st reading | |
4847 // =2: SAC from 2nd reading | |
4848 // =3: SAC from higher one of both pressure drops (independent double mode) | |
4849 // =4: SAC (O2 usage) from 2nd reading without real_pres_respiration term | |
4850 | |
4851 // set SAC rate to not available by default | |
4852 int_O_SAC_measured = 0 + INT_FLAG_NOT_AVAIL; | |
4853 | |
4854 // get a copy of the current absolute pressure | |
4855 pres_respiration_sac = real_pres_respiration; | |
4856 | |
4857 // set threshold for SAC rate attention | |
628 | 4858 max_sac_rate = (deco_info & DECO_MODE) ? char_I_SAC_deco : char_I_SAC_work; |
623 | 4859 |
4860 // char_I_SAC_deco / char_I_SAC_work are in l/min, max_sac_rate is in 0.1 l/min | |
4861 max_sac_rate *= 10; | |
4862 | |
4863 | |
4864 // pre-process SAC mode 3 (independent double) | |
4865 if( char_I_SAC_mode == 3 ) | |
560 | 4866 { |
623 | 4867 overlay unsigned char reading1_gas; |
4868 overlay unsigned char reading2_gas; | |
4869 overlay unsigned char reading1_tanksize; | |
4870 overlay unsigned char reading2_tanksize; | |
4871 overlay unsigned short reading1_press; | |
4872 overlay unsigned short reading2_press; | |
4873 overlay unsigned short reading1_drop; | |
4874 overlay unsigned short reading2_drop; | |
4875 | |
4876 // get gas numbers (1-10) of both readings | |
4877 reading1_gas = char_I_pressure_gas[0]; | |
4878 reading2_gas = char_I_pressure_gas[1]; | |
4879 | |
4880 // default to no SAC calculation | |
4881 char_I_SAC_mode = 0; | |
4882 | |
4883 // clear switch advice by default | |
4884 deco_info &= ~IND_DOUBLE_SWITCH_FLAG; | |
4885 | |
4886 // check if both readings are configured and available | |
4887 if( reading1_gas ) | |
4888 if( reading2_gas ) | |
4889 if( !(int_IO_pressure_value[0] & INT_FLAG_NOT_AVAIL) ) | |
4890 if( !(int_IO_pressure_value[1] & INT_FLAG_NOT_AVAIL) ) | |
4891 if( !(int_I_pressure_drop[0] & INT_FLAG_NOT_AVAIL) ) | |
4892 if( !(int_I_pressure_drop[1] & INT_FLAG_NOT_AVAIL) ) | |
560 | 4893 { |
623 | 4894 // get tank pressures, stripping flags |
4895 reading1_press = int_IO_pressure_value[0] & 0x0FFF; // in 0.1 bar | |
4896 reading2_press = int_IO_pressure_value[1] & 0x0FFF; // in 0.1 bar | |
4897 | |
4898 // get pressure drops as integers, stripping flags and shifting right | |
4899 // to avoid an overflow when multiplying with the tank size later on | |
4900 reading1_drop = (int_I_pressure_drop[0] & 0x0FFF) >> 2; | |
4901 reading2_drop = (int_I_pressure_drop[1] & 0x0FFF) >> 2; | |
4902 | |
4903 // get tank sizes | |
4904 reading1_tanksize = char_I_gas_avail_size[reading1_gas-1]; | |
4905 reading2_tanksize = char_I_gas_avail_size[reading2_gas-1]; | |
4906 | |
4907 // set mode to calculate SAC on the reading with the higher absolute drop | |
4908 char_I_SAC_mode = (reading1_drop * reading1_tanksize > reading2_drop * reading2_tanksize) ? 1 : 2; | |
4909 | |
4910 // compute switch advice if pressure (in 0.1 bar) of tank breathed from is | |
4911 // more than char_I_max_pres_diff (in bar) below pressure of the other tank. | |
4912 if( char_I_SAC_mode == 1 ) | |
4913 { | |
4914 // breathing from reading 1, switch advice if pressure on reading 1 lower than on 2 | |
4915 if( (reading1_press + 10*char_I_max_pres_diff) <= reading2_press ) | |
4916 deco_info |= IND_DOUBLE_SWITCH_FLAG; | |
4917 } | |
4918 else | |
4919 { | |
4920 // breathing from reading 2, switch advice if pressure on reading 2 lower than on 1 | |
4921 if( (reading2_press + 10*char_I_max_pres_diff) <= reading1_press ) | |
4922 deco_info |= IND_DOUBLE_SWITCH_FLAG; | |
4923 } | |
560 | 4924 } |
4925 } | |
4926 | |
623 | 4927 |
4928 // pre-process SAC mode 4 (O2 usage by reading 2) | |
4929 if( char_I_SAC_mode == 4 ) | |
4930 { | |
4931 // O2 usage on CCR is independent from absolute pressure | |
4932 pres_respiration_sac = 1.0; | |
4933 | |
4934 // O2 pressure drop is measured via reading 2 | |
4935 char_I_SAC_mode = 2; | |
4936 | |
4937 // reconfigure max SAC rate to O2 consumption attention threshold | |
4938 max_sac_rate = O2_CONSUMPTION_LIMIT_ATTENTION; | |
4939 } | |
4940 | |
4941 | |
628 | 4942 // select which pressure reading to log |
4943 if( char_I_SAC_mode == 1 ) int_O_tank_pressure = int_IO_pressure_value[0]; | |
4944 else if( char_I_SAC_mode == 2 ) int_O_tank_pressure = int_IO_pressure_value[1]; | |
4945 else int_O_tank_pressure = 0; | |
4946 | |
4947 // strip flags | |
4948 int_O_tank_pressure &= 0x0FFF; | |
4949 | |
631 | 4950 // scale to recording format of full bar only |
628 | 4951 int_O_tank_pressure /= 10; |
4952 | |
4953 | |
623 | 4954 // calculate SAC - modes 1 & 2 |
4955 if( (char_I_SAC_mode == 1) || (char_I_SAC_mode == 2) ) | |
560 | 4956 { |
623 | 4957 overlay unsigned char reading_index; |
4958 overlay unsigned char reading_gas; | |
4959 overlay unsigned char reading_tanksize; | |
4960 overlay float reading_drop; | |
4961 | |
4962 // set index: char_I_SAC_mode = 1 -> reading one, index 0 | |
4963 // = 2 -> two, 1 | |
4964 reading_index = char_I_SAC_mode - 1; | |
4965 | |
4966 // get gas number (1-10) | |
4967 reading_gas = char_I_pressure_gas[reading_index]; | |
4968 | |
4969 // check if reading is configured and available | |
4970 if( reading_gas ) | |
4971 if( !(int_I_pressure_drop[reading_index] & INT_FLAG_NOT_AVAIL) ) | |
4972 { | |
4973 // get tank size (in liter) | |
4974 reading_tanksize = char_I_gas_avail_size[reading_gas-1]; | |
4975 | |
4976 // get pressure drop as float, stripping flags (in 1/5120 bar/sec) | |
4977 reading_drop = (float)(int_I_pressure_drop[reading_index] & 0x0FFF); | |
4978 | |
4979 // check if pressure drop is within range | |
4980 if( !(int_I_pressure_drop[reading_index] & INT_FLAG_OUT_OF_RANGE) ) | |
4981 { | |
4982 // calculate SAC, 10 is factor to have result in 0.1 liter/min | |
4983 // 60 is factor for 60 seconds per 1 minute, | |
4984 // 5120 accounts for reading_drop being in 1/5120 bar/sec | |
4985 // 10*60/5120 = 60/512 = 15/128 | |
4986 float_sac = reading_drop * 15/128 * reading_tanksize / pres_respiration_sac; | |
4987 | |
4988 // limit result to 999 (99.9 liter/min) | |
4989 if ( float_sac >= 998.5 ) | |
4990 { | |
4991 int_O_SAC_measured = 999 + INT_FLAG_ATTENTION; | |
4992 } | |
4993 else | |
4994 { | |
4995 // convert float to integer | |
4996 int_O_SAC_measured = (unsigned short)(float_sac + 0.5); | |
4997 | |
4998 // set attention flag if exceeding SAC threshold, but only if pressure drop is not outdated | |
4999 if( !(int_I_pressure_drop[reading_index] & INT_FLAG_OUTDATED) ) | |
5000 if( int_O_SAC_measured >= max_sac_rate ) | |
5001 { | |
5002 int_O_SAC_measured |= INT_FLAG_ATTENTION; | |
5003 } | |
5004 } | |
5005 } | |
5006 else | |
5007 { | |
5008 // pressure drop is out of range, so SAC will be set out of range, too | |
5009 int_O_SAC_measured = 999 + INT_FLAG_ATTENTION; | |
5010 } | |
5011 | |
5012 // copy outdated flag from int_I_pressure_drop to int_O_SAC_measured | |
5013 if( int_I_pressure_drop[reading_index] & INT_FLAG_OUTDATED ) | |
5014 { | |
5015 int_O_SAC_measured |= INT_FLAG_OUTDATED; | |
5016 } | |
5017 } | |
5018 } | |
5019 } | |
631 | 5020 #endif // _rx_functions |
5021 | |
5022 | |
5023 #ifdef _cave_mode | |
5024 | |
5025 ////////////////////////////////////////////////////////////////////////////// | |
5026 // read_backtrack_data | |
5027 // | |
5028 // Gets the data of the next backtracking data set | |
5029 // | |
5030 // Modified: backtrack_index last current position in backtracking storage | |
5031 // | |
5032 // Output: backtrack_step_counter number of 1/10 min calculation steps to do on next target depth | |
5033 // backtrack_target_depth next target depth | |
5034 // | |
5035 static void read_backtrack_data(void) | |
5036 { | |
5037 overlay unsigned char firstround = 1; | |
5038 | |
5039 | |
5040 // load the step counter with the default of ten 1/10 minute steps to go between two depth samples | |
5041 backtrack_step_counter = 10; | |
5042 | |
5043 // repeat until having read the whole data set or having reached the first storage position | |
5044 while(backtrack_index) | |
5045 { | |
5046 // backtracking data recording format: | |
5047 // --------------------------------------------------------------------------- | |
5048 // 0ddddddd -> datum is a depth recording with d = 0..127 depth in meters | |
5049 // 10tttttt -> delta time with t = 0.. 59 time in seconds | |
5050 // 110ggggg -> gas staging status with g = 1 gas staged | |
5051 // 111nnnnn -> waypoint marker with n = 1.. 31 waypoint number | |
5052 // | |
5053 // gas availability vector: LSB : gas 1 (and so on) | |
5054 // waypoint marker : 1 - 30: user waypoints, last waypoint is turn point | |
5055 // : 31: spare for turn point if all 30 waypoints used up | |
5056 // : 0: reserved | |
5057 | |
5058 // read recording entry and then advance (backward direction!) the reading index | |
5059 overlay unsigned char datum = char_I_backtrack_storage[backtrack_index--]; | |
5060 | |
5061 // is it a target depth? | |
5062 if( datum < 128 ) | |
5063 { | |
5064 // YES - assign the target depth | |
5065 backtrack_target_depth = datum; | |
5066 | |
5067 // a depth entry closes a data set, so done with this data set | |
5068 return; | |
5069 } | |
5070 | |
5071 // is it a delta time entry? | |
5072 else if( datum < 128 + 64 ) | |
5073 { | |
5074 // YES - When a delta time entry is contained in a data set, the time | |
5075 // stored in the delta time entry is the time that has elapsed | |
5076 // between storage of the depth that is part of this data set | |
5077 // and the previous depth recording. | |
5078 // This entry is stored whenever the delta time is shorter than | |
5079 // the default 1 minute depth sampling interval time. | |
5080 | |
5081 // assign the delta time to the step counter: remove entry tag and | |
5082 // convert datum from 0..59 seconds to 0..9 steps by integer division | |
5083 backtrack_step_counter = (datum - 128) / 6; | |
5084 } | |
5085 | |
5086 // is it a gas staging status entry? | |
5087 else if( datum < 128 + 64 + 32 ) | |
5088 { | |
5089 // YES - extract gas staging status | |
5090 overlay unsigned char gas_status = datum - (128 + 64); | |
5091 | |
5092 // decode and update gas staging status | |
5093 // | |
5094 // bit set : gas is staged (not available) during next section of backtracking, | |
5095 // bit cleared: gas is not staged ( available) during next section of backtracking. | |
5096 // | |
5097 // bit 0 corresponds to gas 1, ..., bit 4 corresponds to gas 5 | |
5098 // | |
5099 for( i = 0; i < NUM_GAS; i++ ) | |
5100 { | |
5101 if ( gas_status & (1 << i) ) deco_gas_type[i] |= GAS_AVAIL_STAGED; // staged | |
5102 else deco_gas_type[i] &= ~GAS_AVAIL_STAGED; // not staged | |
5103 } | |
5104 } | |
5105 | |
5106 // must be waypoint marker entry then | |
5107 else | |
5108 { | |
5109 // set step counter to zero if first entry read is a waypoint entry | |
5110 if( firstround ) backtrack_step_counter = 0; | |
5111 } | |
5112 | |
5113 // first round done | |
5114 firstround = 0; | |
5115 | |
5116 } // while | |
5117 | |
5118 // first storage position reached, by convention it contains | |
5119 // the final target depth which is zero meters aka the surface | |
5120 backtrack_target_depth = 0; | |
5121 } | |
5122 | |
5123 #endif // _cave_mode | |
5124 | |
623 | 5125 |
5126 | |
5127 ////////////////////////////////////////////////////////////////////////////// | |
631 | 5128 // convert_volume_to_pressure |
623 | 5129 // |
5130 // Converts gas volumes into pressures and sets respective flags | |
5131 // | |
650 | 5132 // Input: index index of the gas to convert (0-4) |
623 | 5133 // gas_volume_need[] needed gas volume in liters |
5134 // char_I_gas_avail_pres[] available gas volume in bar | |
5135 // char_I_gas_avail_size[] size of the tanks in liters | |
5136 // char_I_pressure_gas[] gas configured on reading 1/2 (TR only) | |
5137 // | |
631 | 5138 // Output: int_O_gas_need_vol[] required gas amount in liters |
5139 // int_O_gas_need_pres[] required gas amount in bar, including flags | |
623 | 5140 // int_O_pressure_need[] required gas amount for reading 1/2 (TR only) |
5141 // | |
650 | 5142 static void convert_volume_to_pressure(PARAMETER unsigned char index) |
623 | 5143 { |
5144 // just to make the code more readable... | |
650 | 5145 i = index; |
623 | 5146 |
5147 if( gas_volume_need[i] >= 65534.5 ) | |
5148 { | |
5149 int_O_gas_need_vol[i] = 65535; // clip at 65535 liters | |
5150 int_O_gas_need_pres[i] = 999 | INT_FLAG_WARNING | INT_FLAG_HIGH; // 999 bar + warning flag + >999 flag | |
560 | 5151 } |
5152 else | |
5153 { | |
631 | 5154 // convert gas volume need from float to integer [in liter] |
5155 int_O_gas_need_vol[i] = (unsigned short)( gas_volume_need[i] + 0.5 ); | |
623 | 5156 |
5157 // compute how much pressure in the tank will be needed [in bar] | |
631 | 5158 int_O_gas_need_pres[i] = (unsigned short)( gas_volume_need[i] / char_I_gas_avail_size[i] + 0.5 ); |
623 | 5159 |
5160 // limit result to 999 bar because of display constraints | |
5161 if( int_O_gas_need_pres[i] > 999 ) int_O_gas_need_pres[i] = 999 | INT_FLAG_HIGH; | |
5162 | |
631 | 5163 // set flags for fast evaluation by output routine |
5164 if( int_O_gas_need_pres[i] == 0 ) int_O_gas_need_pres[i] |= INT_FLAG_ZERO; | |
5165 else | |
5166 #ifdef _gas_contingency | |
5167 if( main_status & GAS_CONTINGENCY ) | |
5168 { | |
5169 // take warning and attention computed en-route | |
5170 if ( deco_gas_type[i] & GAS_NEED_WARNING ) | |
5171 { | |
5172 // tag the tank with a warning | |
5173 int_O_gas_need_pres[i] |= INT_FLAG_WARNING; | |
5174 | |
5175 // tag the peer tanks with a warning, too | |
5176 for( j = 0; j < NUM_GAS; j++ ) | |
5177 { | |
5178 if( peer_tank[i] & (1 << j) ) int_O_gas_need_pres[j] |= INT_FLAG_WARNING; | |
5179 } | |
5180 } | |
5181 else if( deco_gas_type[i] & GAS_NEED_ATTENTION ) | |
5182 { | |
5183 // tag the tank with an attention | |
5184 int_O_gas_need_pres[i] |= INT_FLAG_ATTENTION; | |
5185 | |
5186 // tag the peer tanks with an attention, too | |
5187 for( j = 0; j < NUM_GAS; j++ ) | |
5188 { | |
5189 if( peer_tank[i] & (1 << j) ) int_O_gas_need_pres[j] |= INT_FLAG_ATTENTION; | |
5190 } | |
5191 } | |
5192 } | |
5193 else | |
5194 #endif | |
5195 { | |
5196 // compute warning and attention now | |
5197 if ( gas_volume_need[i] >= gas_volume_avail[i] ) int_O_gas_need_pres[i] |= INT_FLAG_WARNING; | |
5198 else if( gas_volume_need[i] >= gas_volume_atten[i] ) int_O_gas_need_pres[i] |= INT_FLAG_ATTENTION; | |
5199 } | |
560 | 5200 } |
5201 | |
631 | 5202 // set invalid flag if there is an overflow in the stops table or calculation took too long |
628 | 5203 if( deco_warnings & DECO_WARNING_INCOMPLETE ) int_O_gas_need_pres[i] |= INT_FLAG_INVALID; |
560 | 5204 |
604 | 5205 #ifdef _rx_functions |
5206 // only for OSTC TR model with TR functions enabled | |
623 | 5207 if( main_status & TR_FUNCTIONS ) |
560 | 5208 { |
623 | 5209 // char_I_pressure_gas[] uses gas indexes from 1-10, loop variable i runs from 0 to 4 |
631 | 5210 j = i+1; |
623 | 5211 |
5212 // check if the current gas is configured on pressure reading 1 or 2 | |
5213 if( (char_I_pressure_gas[0] == j) || (char_I_pressure_gas[1] == j) ) | |
560 | 5214 { |
623 | 5215 // get a copy of the required pressure in full bar |
5216 overlay unsigned short int_pres_need = int_O_gas_need_pres[i]; | |
5217 | |
5218 // strip all flags | |
5219 int_pres_need &= 1023; | |
5220 | |
5221 // limit to 400 bar and multiply by 10 to get required pressure in 0.1 bar | |
5222 int_pres_need = (int_pres_need > 400) ? 4000 | INT_FLAG_OUT_OF_RANGE : 10 * int_pres_need; | |
5223 | |
631 | 5224 // tag as not available if there is an overflow in the stops table or calculation took too long |
628 | 5225 if( deco_warnings & DECO_WARNING_INCOMPLETE ) int_pres_need |= INT_FLAG_NOT_AVAIL; |
623 | 5226 |
5227 // copy to reading data (in both readings the same gas could be configured) | |
5228 if( char_I_pressure_gas[0] == j ) int_O_pressure_need[0] = int_pres_need; | |
5229 if( char_I_pressure_gas[1] == j ) int_O_pressure_need[1] = int_pres_need; | |
5230 } | |
5231 } // TR functions | |
604 | 5232 #endif |
0 | 5233 } |
5234 | |
623 | 5235 |
5236 ////////////////////////////////////////////////////////////////////////////// | |
5237 // convert the real CNS value to integer | |
5238 // | |
5239 // Input CNS_fraction_real current CNS value as float | |
5240 // | |
5241 // Output: int_O_CNS_current current CNS value as integer including flags | |
5242 // | |
5243 static void convert_cur_CNS_for_display(void) | |
5244 { | |
5245 // convert to integer | |
5246 float_value = CNS_fraction_real; convert_float_to_int(); int_O_CNS_current = int_value; | |
5247 | |
5248 // set warning & attention flags | |
628 | 5249 if ( int_O_CNS_current >= CNS_LIMIT_WARNING ) int_O_CNS_current |= INT_FLAG_WARNING; |
5250 else if ( int_O_CNS_current >= CNS_LIMIT_ATTENTION ) int_O_CNS_current |= INT_FLAG_ATTENTION; | |
623 | 5251 } |
5252 | |
5253 | |
0 | 5254 ////////////////////////////////////////////////////////////////////////////// |
623 | 5255 // convert the simulated CNS value to integer |
5256 // | |
5257 // Input: CNS_fraction_sim CNS value after predicted ascent in float | |
5258 // | |
5259 // Output: int_sim_CNS_fraction CNS value after predicted ascent in integer | |
5260 // including flags, will be routed to | |
5261 // int_O_{normal,alternative}_CNS_fraction | |
5262 // | |
604 | 5263 static void convert_sim_CNS_for_display(void) |
582 | 5264 { |
623 | 5265 // convert to integer |
5266 float_value = CNS_fraction_sim; convert_float_to_int(); int_sim_CNS_fraction = int_value; | |
5267 | |
5268 // set warning & attention flags | |
628 | 5269 if ( int_sim_CNS_fraction >= CNS_LIMIT_WARNING ) int_sim_CNS_fraction |= INT_FLAG_WARNING; |
5270 else if ( int_sim_CNS_fraction >= CNS_LIMIT_ATTENTION ) int_sim_CNS_fraction |= INT_FLAG_ATTENTION; | |
604 | 5271 |
631 | 5272 // set invalid flag if there is an overflow in the stops table or calculation took too long |
628 | 5273 if ( deco_warnings & DECO_WARNING_INCOMPLETE ) int_sim_CNS_fraction |= INT_FLAG_INVALID; |
604 | 5274 } |
5275 | |
623 | 5276 |
604 | 5277 ////////////////////////////////////////////////////////////////////////////// |
623 | 5278 // convert the saturation value of the leading tissue to integer |
5279 // | |
5280 // Input lead_supersat saturation of the leading tissue | |
5281 // lead_tissue number of the leading tissue | |
5282 // char_I_GF_High_percentage GF high factor | |
5283 // | |
5284 // Output: int_O_lead_supersat saturation of the leading tissue | |
5285 // char_O_lead_tissue number of the leading tissue | |
5286 // | |
5287 // Modified: deco_warnings deco engine warnings vector | |
5288 // | |
5289 static void convert_sat_for_display(void) | |
604 | 5290 { |
623 | 5291 // convert supersaturation of the leading tissue to int_O_lead_supersat in % (1.0 = 100%) |
604 | 5292 // limit to 255 because of constraints in ghostwriter code |
623 | 5293 if ( lead_supersat <= 0.000 ) int_O_lead_supersat = 0; |
5294 else if ( lead_supersat > 2.545 ) int_O_lead_supersat = 255; | |
5295 else int_O_lead_supersat = (unsigned short)(100 * lead_supersat + 0.5); | |
5296 | |
5297 // set warning & attention flags | |
5298 if( int_O_lead_supersat > 100 ) | |
604 | 5299 { |
623 | 5300 int_O_lead_supersat |= INT_FLAG_WARNING; // make GF factor shown in red |
5301 deco_warnings |= DECO_WARNING_OUTSIDE; // make depth shown in red | |
5302 } | |
631 | 5303 else if( (char_I_model != 0) && (int_O_lead_supersat > char_I_GF_High_percentage) |
5304 || (char_I_model == 0) && (int_O_lead_supersat > 99 ) ) | |
623 | 5305 { |
5306 int_O_lead_supersat |= INT_FLAG_ATTENTION; // make GF factor shown in yellow | |
5307 deco_warnings |= DECO_ATTENTION_OUTSIDE; // make depth shown in yellow | |
604 | 5308 } |
5309 | |
5310 // export also the number of the leading tissue | |
623 | 5311 char_O_lead_tissue = lead_tissue; |
604 | 5312 } |
5313 | |
623 | 5314 |
604 | 5315 ////////////////////////////////////////////////////////////////////////////// |
623 | 5316 // convert the ceiling value to integer |
5317 // | |
5318 // Input: ceiling minimum depth permitted in float | |
5319 // | |
628 | 5320 // Output: int_O_ceiling minimum depth permitted in mbar (cm) |
623 | 5321 // |
5322 // Modified: deco_info deco engine information vector | |
5323 // | |
604 | 5324 static void convert_ceiling_for_display(void) |
5325 { | |
5326 // Convert ceiling to int_O_ceiling in mbar relative pressure. | |
5327 // Round up to next 10 cm so that the ceiling disappears only | |
5328 // when the ceiling limit is really zero. This will coincident | |
5329 // with TTS switching back to NDL time. | |
628 | 5330 // The +1.5 term figures in the conversion factor of 10.015 m/bar |
5331 // which is used inside the deco engine but not outside of it. | |
623 | 5332 if ( ceiling <= 0.0 ) int_O_ceiling = 0; |
5333 else if ( ceiling > 16.0 ) int_O_ceiling = 16000; | |
628 | 5334 else int_O_ceiling = (unsigned short)(ceiling * (1000+1.5) + 9); |
604 | 5335 |
5336 // set/reset ceiling flag | |
623 | 5337 if ( int_O_ceiling ) deco_info |= DECO_CEILING; |
5338 else deco_info &= ~DECO_CEILING; | |
0 | 5339 } |
5340 | |
623 | 5341 |
0 | 5342 ////////////////////////////////////////////////////////////////////////////// |
582 | 5343 // push_tissues_to_vault & pull_tissues_from_vault |
5344 // | |
5345 // ATTENTION: Do not use from inside the deco engine! | |
5346 // The vault is exclusively reserved to back-up and restore the real | |
5347 // tissues and related data when entering / leaving simulation mode! | |
5348 // | |
623 | 5349 // Input/Output: CNS_fraction_real current real CNS value |
5350 // char_O_deco_warnings deco engine warnings vector | |
5351 // real_pres_tissue_N2[] partial pressure of N2 in real tissues | |
5352 // real_pres_tissue_He[] partial pressure of He in real tissues | |
5353 // | |
5354 // Output: int_O_CNS_current current CNS value as integer including flags | |
5355 // | |
604 | 5356 static void push_tissues_to_vault(void) |
0 | 5357 { |
623 | 5358 // store the current CNS value and deco warnings |
5359 vault_CNS_fraction_real = CNS_fraction_real; | |
5360 vault_deco_warnings = char_O_deco_warnings; | |
5361 vault_deco_info = char_O_deco_info; | |
5362 | |
650 | 5363 // copy the real pressures to the vault |
5364 memcpy(vault_pres_tissue_N2, real_pres_tissue_N2, 256); | |
0 | 5365 } |
5366 | |
604 | 5367 static void pull_tissues_from_vault(void) |
0 | 5368 { |
623 | 5369 // restore the CNS value and deco warnings |
5370 CNS_fraction_real = vault_CNS_fraction_real; | |
5371 char_O_deco_warnings = vault_deco_warnings; | |
5372 char_O_deco_info = vault_deco_info; | |
5373 | |
5374 // convert the CNS value to integer | |
5375 convert_cur_CNS_for_display(); | |
5376 | |
650 | 5377 // copy the vault back to the real pressures |
5378 memcpy(real_pres_tissue_N2, vault_pres_tissue_N2, 256); | |
0 | 5379 } |
5380 | |
623 | 5381 |
0 | 5382 ////////////////////////////////////////////////////////////////////////////// |
5383 // | |
5384 #ifndef CROSS_COMPILE | |
5385 void main() {} | |
5386 #endif |