Mercurial > public > hwos_code
annotate src/p2_deco.c @ 583:6636cbe64c6d
optical input work
| author | heinrichsweikamp |
|---|---|
| date | Tue, 27 Feb 2018 12:27:31 +0100 |
| parents | b455b31ce022 |
| children | d63dec562d50 |
| rev | line source |
|---|---|
| 582 | 1 // *************************************************************************** |
| 2 // p2_deco.c REFACTORED VERSION V2.97b | |
| 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 | |
| 11 // Copyright (C) 2011 HeinrichsWeikamp GbR | |
| 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 | |
| 15 // the Free Software Foundation, either version 3 of the License, or | |
| 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 | |
| 20 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
| 21 // GNU General Public License for more details. | |
| 22 // | |
| 23 // You should have received a copy of the GNU General Public License | |
| 24 // along with this program. If not, see <http://www.gnu.org/licenses/>. | |
| 25 // | |
| 26 ////////////////////////////////////////////////////////////////////////////// | |
| 27 | |
| 28 // history: | |
| 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 |
| 33 // 03/13/25 v101: CNS_fraction calculation | |
| 34 // 03/13/26 v101: optimization of tissue calc routines | |
| 35 // 07/xx/08 v102a: debug of bottom time routine | |
| 560 | 36 // 09/xx/08 v102d: Gradient Factor Model implementation |
| 0 | 37 // 10/10/08 v104: renamed to build v103 for v118 stable |
| 582 | 38 // 10/14/08 v104: integration of char_I_depth_last_deco for Gradient Model |
| 0 | 39 // 03/31/09 v107: integration of FONT Incon24 |
| 40 // 05/23/10 v109: 5 gas changes & 1 min timer | |
| 41 // 07/13/10 v110: cns vault added | |
| 42 // 12/25/10 v110: split in three files (deco.c, main.c, definitions.h) | |
| 43 // 2011/01/20: [jDG] Create a common file included in ASM and C code. | |
| 44 // 2011/01/24: [jDG] Make ascenttime an short. No more overflow! | |
| 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. | |
| 50 // 2011/04/15: [jDG] Store low_depth in 32bits (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 | |
| 560 | 61 // 2012/10/05: [jDG] Better gas_volumes accuracy (average depth, switch between stop). |
| 0 | 62 // 2013/03/05: [jDG] Should vault low_depth too. |
| 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 | |
| 0 | 72 // |
| 73 // | |
| 74 // Literature: | |
| 313 | 75 // Buhlmann, Albert: Tauchmedizin; 4. Auflage [2002]; |
| 0 | 76 // Schr"oder, Kai & Reith, Steffen; 2000; S"attigungsvorg"ange beim Tauchen, das Modell ZH-L16, Funktionsweise von Tauchcomputern; http://www.achim-und-kai.de/kai/tausim/saett_faq |
| 77 // Morrison, Stuart; 2000; DIY DECOMPRESSION; http://www.lizardland.co.uk/DIYDeco.html | |
| 78 // Balthasar, Steffen; Dekompressionstheorie I: Neo Haldane Modelle; http://www.txfreak.de/dekompressionstheorie_1.pdf | |
| 79 // Baker, Erik C.; Clearing Up The Confusion About "Deep Stops" | |
| 80 // Baker, Erik C.; Understanding M-values; http://www.txfreak.de/understanding_m-values.pdf | |
| 81 // | |
| 82 // | |
| 83 | |
| 84 // ********************* | |
| 85 // ** I N C L U D E S ** | |
| 86 // ********************* | |
| 87 #include <math.h> | |
| 88 | |
| 89 // *********************************************** | |
| 90 // ** V A R I A B L E S D E F I N I T I O N S ** | |
| 91 // *********************************************** | |
| 92 | |
| 582 | 93 #include "p2_definitions.h" |
| 94 #define TEST_MAIN | |
| 95 #include "shared_definitions.h" | |
| 0 | 96 |
| 560 | 97 |
| 98 // ambient pressure at different mountain heights | |
| 99 #define P_ambient_1000m 0.880 // [bar] based on 990 hPa and 20°C at sea level, 15°C at altitude | |
| 100 #define P_ambient_2000m 0.782 // [bar] | |
| 101 #define P_ambient_3000m 0.695 // [bar] | |
| 102 | |
| 103 // ambient pressure in aircraft cabin during flying - worst case according to Buhlmann | |
| 104 #define P_ambient_fly 0.600 // [bar], 0.600 bar is the value used by Buhlmann for his flying-after-diving calculations | |
| 582 | 105 // 0.735 bar is a typical cabin pressure for nowadays commercial jet aircrafts |
| 560 | 106 // ----- |
| 107 // 0.135 bar safety margin | |
| 108 | |
| 109 // constants and factors | |
| 582 | 110 #define ppWater 0.0627 // water vapor partial pressure in the lungs |
| 111 #define METER_TO_BAR 0.09985 // conversion factor | |
| 112 #define BAR_TO_METER 10.0150 // conversion factor (1.0/METER_TO_BAR) | |
| 113 #define SURFACE_DESAT_FACTOR 0.7042 // surface desaturation safety factor | |
| 560 | 114 #define HYST 1.0E-06 // threshold for tissue graphics on-gassing / off-gassing visualization |
| 115 | |
| 116 // thresholds | |
| 582 | 117 #define GF_WARNING_THRESHOLD 100 // threshold for GF warning (attention threshold is current GF_high) |
| 118 #define CNS_WARNING_THRESHOLD 100 // threshold for CNS warning | |
| 119 #define CNS_ATTENTION_THRESHOLD 70 // threshold for CNS attention | |
| 120 #define ppO2_ATTENTION_THRESHOLD 120 // threshold for ppO2 attention (thresholds for warnings come by options_table.asm) | |
| 121 #define ppO2_GAP_TO_SETPOINT 10 // gap between setpoint and max. ppO2 of the pure diluent [cbar] | |
| 560 | 122 #define GAS_NEEDS_ATTENTION_THRESHOLD 0.70 // threshold for gas needs attention |
| 123 | |
| 124 // deco engine states and modes - char_O_deco_status | |
| 125 #define DECO_STATUS_MASK 0x03 | |
| 126 #define DECO_STATUS_START 0x00 | |
| 127 #define DECO_STATUS_FINISHED 0x00 | |
| 128 #define DECO_STATUS_STOPS 0x01 | |
| 582 | 129 #define DECO_STATUS_RESULTS 0x02 |
| 560 | 130 #define DECO_STATUS_INIT 0x03 |
| 131 | |
| 132 #define DECO_MODE_MASK 0x0C | |
| 133 #define DECO_MODE_LOOP 0x04 | |
| 134 #define DECO_MODE_CCR 0x04 // to be used with == operator in combination with DECO_MODE_MASK only! | |
| 135 #define DECO_MODE_PSCR 0x08 | |
| 136 | |
| 137 #define DECO_PLAN_ALTERNATE 0x10 | |
| 582 | 138 #define DECO_CNS_CALCULATE 0x20 |
| 139 #define DECO_VOLUME_CALCULATE 0x40 | |
| 140 #define DECO_ASCENT_DELAYED 0x80 | |
| 560 | 141 |
| 142 // deco engine states and modes - char_O_main_status | |
| 143 //#define DECO_MODE_MASK 0x0C | |
| 144 //#define DECO_MODE_LOOP 0x04 | |
| 145 //#define DECO_MODE_CCR 0x04 // to be used with == operator in combination with DECO_MODE_MASK only! | |
| 146 //#define DECO_MODE_PSCR 0x08 | |
| 582 | 147 #define DECO_GASCHANGE_OVRD 0x10 |
| 560 | 148 #define DECO_BOTTOM_CALCULATE 0x40 |
| 149 | |
| 582 | 150 // deco engine states and modes - tissue_increment |
| 151 #define TIME_MASK 0x7F // (127 decimal, bits 0-6) | |
| 152 #define TISSUE_FLAG 0x80 // (128 decimal, bit 7 ) | |
| 560 | 153 |
| 154 // deco engine warnings | |
| 155 #define DECO_WARNING_IBCD 0x01 | |
| 156 #define DECO_WARNING_IBCD_lock 0x02 | |
| 582 | 157 #define DECO_WARNING_MBUBBLES 0x04 |
| 560 | 158 #define DECO_WARNING_MBUBBLES_lock 0x08 |
| 159 #define DECO_WARNING_OUTSIDE 0x10 | |
| 160 #define DECO_WARNING_OUTSIDE_lock 0x20 | |
| 161 #define DECO_WARNING_STOPTABLE_OVERFLOW 0x40 | |
| 162 #define DECO_FLAG 0x80 | |
| 163 | |
| 164 // flags used with integer numbers | |
| 165 #define INT_FLAG_INVALID 0x0400 | |
| 166 #define INT_FLAG_ZERO 0x0800 | |
| 167 #define INT_FLAG_LOW 0x1000 | |
| 168 #define INT_FLAG_HIGH 0x2000 | |
| 582 | 169 #define INT_FLAG_ATTENTION 0x4000 |
| 560 | 170 #define INT_FLAG_WARNING 0x8000 |
| 171 | |
| 172 | |
| 0 | 173 |
| 174 // ************************* | |
| 175 // ** P R O T O T Y P E S ** | |
| 176 // ************************* | |
| 177 | |
| 178 static void calc_hauptroutine(void); | |
| 179 static void calc_hauptroutine_data_input(void); | |
| 180 static void calc_hauptroutine_update_tissues(void); | |
| 181 static void calc_hauptroutine_calc_deco(void); | |
| 582 | 182 static void calc_alveolar_pressures(void); |
| 183 static void calc_tissues(void); | |
| 184 static void calc_NDL_time(void); | |
| 560 | 185 static void calc_ascenttime(void); |
| 582 | 186 static void calc_CNS_increment(void); |
| 560 | 187 static void calc_desaturation_time(void); |
| 582 | 188 static void calc_ascent_to_first_stop(void); |
| 189 static void calc_limit(PARAMETER float GF_current); | |
| 190 static void calc_interval(PARAMETER unsigned char time_increment); | |
| 191 | |
| 192 static void gas_find_current(void); | |
| 193 static void gas_set_ratios(void); | |
| 194 static void convert_CNS_for_display(void); | |
| 195 static void convert_sim_CNS_for_display(void); | |
| 196 static void publish_deco_table(void); | |
| 560 | 197 static void clear_deco_table(void); |
| 198 static void clear_tissue(void); | |
| 199 | |
| 582 | 200 static unsigned char calc_nextdecodepth(void); |
| 560 | 201 static unsigned char gas_find_better(void); |
| 202 static unsigned char update_deco_table(PARAMETER unsigned char time_increment); | |
| 203 | |
| 0 | 204 |
| 205 //---- Bank 5 parameters ----------------------------------------------------- | |
| 206 #ifndef UNIX | |
| 207 # pragma udata bank5=0x500 | |
| 208 #endif | |
| 209 | |
| 560 | 210 // general deco parameters |
| 211 | |
| 212 static float GF_low; // initialized from deco parameters, constant during all computations | |
| 213 static float GF_high; // initialized from deco parameters, constant during all computations | |
| 214 static float GF_delta; // initialized from deco parameters, constant during all computations | |
| 215 static float locked_GF_step_norm; // GF_delta / low_depth_norm in normal plan | |
| 216 static float locked_GF_step_alt; // GF_delta / low_depth_alt in alternative plan | |
| 217 | |
| 218 static float low_depth_norm; // Depth of deepest stop in normal plan | |
| 219 static float low_depth_alt; // Depth of deepest stop in alternative plan | |
| 220 | |
| 221 static float float_ascent_speed; // ascent speed from options_table (1.0 .. 10.0 m/min) | |
| 582 | 222 static float float_deco_distance; // additional depth below stop depth for tissue, CNS and gas volume calculation |
| 223 static float float_saturation_multiplier; // safety factor for on-gassing rates | |
| 224 static float float_desaturation_multiplier; // safety factor for off-gassing rates | |
| 225 | |
| 226 // real context: what we are doing now | |
| 227 | |
| 228 static float ceiling; // minimum tolerated relative pressure (i.e. without surface pressue) | |
| 229 static float CNS_fraction; // current CNS (1.00 = 100%) | |
| 230 | |
| 231 static unsigned short deco_tissue_vector; // 16 bit vector to memories all tissues that are in decompression | |
| 232 static unsigned short IBCD_tissue_vector; // 16 bit vector to memories all tissues that experience IBCD | |
| 233 | |
| 234 // simulation context: used to predict ascent | |
| 235 | |
| 236 static float sim_ceiling; // minimum tolerated relative pressure (i.e. without surface pressue) | |
| 237 static float sim_CNS_fraction; // CNS increase during predicted ascent, 0.01 = 1% | |
| 238 | |
| 239 static unsigned int int_sim_CNS_fraction; // CNS increase during predicted ascent, in % | |
| 240 | |
| 241 static unsigned char sim_depth_limit; // depth of next stop in meters, used in deco calculations | |
| 560 | 242 static unsigned char split_N2_He[NUM_COMP]; // used for calculating the desaturation time |
| 582 | 243 static unsigned char NDL_lead_tissue; // used to cache tissue to start with calculating NDL |
| 560 | 244 |
| 245 | |
| 246 // stops table | |
| 247 | |
| 248 static unsigned char internal_deco_depth[NUM_STOPS]; // depth of the stop | |
| 249 static unsigned char internal_deco_time[NUM_STOPS]; // duration of the stop | |
| 250 static unsigned char internal_deco_gas[NUM_STOPS]; // gas used at the stop | |
| 251 | |
| 252 | |
| 253 // transfer variables between calc_desaturation_time() and calc_desaturation_time_helper() | |
| 254 | |
| 255 static float desat_factor; // used to cache a pre-computed factor | |
| 256 static float var_ht; // buffer for a half-time factor | |
| 582 | 257 static float pres_target; // target pressure for a compartment |
| 560 | 258 static float pres_actual; // current pressure of the compartment |
| 582 | 259 static unsigned int int_time; // time it takes for the compartment to reach the target pressure |
| 260 | |
| 560 | 261 |
| 262 // transfer variables between gas_volumes() and gas_volumes_helper() | |
| 582 | 263 |
| 560 | 264 static float float_depth; // depth of the stop or half-way point |
| 265 static float float_time; // duration of the stop or ascent phase | |
| 266 static float volume; // computed volume of gas | |
| 267 static unsigned char usage; // gas usage in l/min | |
| 268 | |
| 269 | |
| 582 | 270 // auxiliary variables for data buffering |
| 271 | |
| 272 static float N2_equilibrium; // used for N2 tissue graphics scaling | |
| 273 static float temp_tissue; // auxiliary variable to buffer tissue pressures | |
| 274 static float float_pSCR_factor; // pre-computed factor for pSCR ppO2 drop calculation | |
| 275 | |
| 276 | |
| 277 // 35 byte free space left in this bank (4 bytes per float, 2 bytes per int/short, 1 byte per char) | |
| 560 | 278 |
| 0 | 279 |
| 280 //---- Bank 6 parameters ----------------------------------------------------- | |
| 281 #ifndef UNIX | |
| 282 # pragma udata bank6=0x600 | |
| 283 #endif | |
| 284 | |
| 560 | 285 // indexing and sequencing |
| 286 | |
| 287 static unsigned char ci; // used as index to the Buhlmann tables | |
| 288 static unsigned char twosectimer = 0; // used for timing the tissue updating | |
| 582 | 289 static unsigned char tissue_increment; // selector for real/simulated tissues and time increment |
| 560 | 290 |
| 291 | |
| 292 // environmental and gas data | |
| 293 | |
| 582 | 294 static float pres_surface; // absolute pressure at the surface |
| 560 | 295 |
| 296 static unsigned char bottom_depth; // bottom depth in meters, used by CNS and gas needs calculation | |
| 297 | |
| 582 | 298 static float pres_respiration; // current depth in absolute pressure |
| 299 static float O2_ratio; // real breathed gas oxygen ratio | |
| 300 static float N2_ratio; // real breathed gas nitrogen ratio | |
| 301 static float He_ratio; // real breathed gas helium ratio | |
| 302 static float pSCR_drop; // real ppO2 drop in pSCR loop | |
| 303 | |
| 304 static float sim_pres_respiration; // simulated current depth in abs.pressure, used for deco calculations | |
| 305 static float sim_O2_ratio; // simulated breathed gas oxygen ratio | |
| 306 static float sim_N2_ratio; // simulated breathed gas nitrogen ratio | |
| 307 static float sim_He_ratio; // simulated breathed gas helium ratio | |
| 308 static float sim_pSCR_drop; // simulated ppO2 drop in pSCR loop | |
| 560 | 309 |
| 310 static float O2_ppO2; // ppO2 - calculated for pure oxygen at current depth | |
| 582 | 311 static float OC_ppO2; // ppO2 - calculated for breathed in OC mode |
| 560 | 312 static float pSCR_ppO2; // ppO2 - calculated for breathed from pSCR loop |
| 582 | 313 |
| 314 static float ppO2; // partial pressure of breathed oxygen | |
| 315 static float ppN2; // partial pressure of breathed nitrogen | |
| 316 static float ppHe; // partial pressure of breathed helium | |
| 317 | |
| 318 | |
| 319 // Result values from calculation functions | |
| 320 | |
| 321 static float CNS_fraction_inc; // increment of CNS load, 0.01 = 1% | |
| 322 | |
| 323 static unsigned char char_ppO2; // partial pressure of breathed oxygen, as integer 100 = 1.00 bar | |
| 324 static unsigned char NDL_time; // time in minutes until reaching NDL | |
| 325 static unsigned int ascent_time; // time in minutes needed for the ascent | |
| 560 | 326 |
| 327 | |
| 328 // Buhlmann model parameters | |
| 329 | |
| 582 | 330 static float var_N2_a; // Buhlmann a, for current N2 tissue |
| 331 static float var_N2_b; // Buhlmann b, for current N2 tissue | |
| 332 static float var_He_a; // Buhlmann a, for current He tissue | |
| 333 static float var_He_b; // Buhlmann b, for current He tissue | |
| 334 static float var_N2_e; // exposition, for current N2 tissue | |
| 335 static float var_He_e; // exposition, for current He tissue | |
| 336 static float var_N2_ht; // half-time for current N2 tissue | |
| 337 static float var_He_ht; // half-time for current N2 tissue | |
| 338 | |
| 339 | |
| 340 // Gas switch history | |
| 560 | 341 |
| 342 static unsigned char sim_gas_first_used; // Number of first used gas, for bottom segment | |
| 582 | 343 static unsigned char sim_gas_last_used; // number of last used gas |
| 344 static unsigned char sim_gas_last_depth; // change depth of last used gas | |
| 345 | |
| 346 | |
| 347 // Vault to back-up & restore tissue data | |
| 560 | 348 |
| 349 static float pres_tissue_N2_vault[NUM_COMP]; // stores the nitrogen tissue pressures | |
| 350 static float pres_tissue_He_vault[NUM_COMP]; // stores the helium tissue pressures | |
| 351 static float cns_vault_float; // stores current CNS (float representation) | |
| 352 static unsigned char deco_warnings_vault; // stores warnings status | |
| 353 | |
| 354 | |
| 582 | 355 // 8 byte free space left in this bank (4 bytes per float, 2 bytes per int/short, 1 byte per char) |
| 560 | 356 |
| 0 | 357 |
| 358 //---- Bank 7 parameters ----------------------------------------------------- | |
| 359 #ifndef UNIX | |
| 360 # pragma udata bank7=0x700 | |
| 361 #endif | |
| 560 | 362 |
| 363 // Keep order and position of the variables in bank 7 as they are backed-up to & restored from EEPROM | |
| 364 | |
| 365 float pres_tissue_N2[NUM_COMP]; // 16 floats = 64 bytes | |
| 366 float pres_tissue_He[NUM_COMP]; // 16 floats = 64 bytes | |
| 582 | 367 |
| 560 | 368 float sim_pres_tissue_N2[NUM_COMP]; // 16 floats = 64 bytes |
| 369 float sim_pres_tissue_He[NUM_COMP]; // 16 floats = 64 bytes | |
| 370 | |
| 582 | 371 // bank is full! |
| 372 | |
| 0 | 373 |
| 374 //---- Bank 8 parameters ----------------------------------------------------- | |
| 375 #ifndef UNIX | |
| 376 # pragma udata overlay bank8=0x800 | |
| 560 | 377 |
| 582 | 378 static char md_pi_subst[256]; // Overlay C-code data stack here, too. |
| 560 | 379 |
| 380 # define C_STACK md_pi_subst | |
| 0 | 381 #endif |
| 382 | |
| 582 | 383 |
| 0 | 384 // Back to bank6 for further tmp data |
| 582 | 385 // Do not delete this assignment, it is needed by the compiler/linker. |
| 0 | 386 #ifndef UNIX |
| 387 # pragma udata bank6 | |
| 388 #endif | |
| 389 | |
| 582 | 390 |
| 0 | 391 ////////////////////////////////////////////////////////////////////////////// |
| 392 ////////////////////////////////////////////////////////////////////////////// | |
| 582 | 393 //////////////// THE LOOKUP TABLES //////////////// |
| 0 | 394 ////////////////////////////////////////////////////////////////////////////// |
| 395 ////////////////////////////////////////////////////////////////////////////// | |
| 582 | 396 |
| 0 | 397 #ifndef UNIX |
| 560 | 398 # pragma romdata Buhlmann_tables = 0x1DD00 // Needs to be in UPPER bank. |
| 0 | 399 #endif |
| 400 | |
| 560 | 401 rom const float Buhlmann_ab[4*16] = { |
|
521
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
402 // Data ZH-L16C, from Bühlmann Tauchmedizin 2002, option 1a (4mn) |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
403 // a for N2 b for N2 a of He b for He |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
404 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
|
405 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
|
406 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
|
407 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
|
408 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
|
409 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
|
410 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
|
411 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
|
412 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
|
413 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
|
414 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
|
415 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
|
416 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
|
417 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
|
418 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
|
419 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
|
420 }; |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
421 |
| 560 | 422 rom const float Buhlmann_ht[2*16] = { |
| 423 // Compartment half-life, in minute | |
| 424 //--- N2 ---- He ---------------------- | |
|
521
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
425 4.0, 1.51, |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
426 8.0, 3.02, |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
427 12.5, 4.72, |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
428 18.5, 6.99, |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
429 27.0, 10.21, |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
430 38.3, 14.48, |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
431 54.3, 20.53, |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
432 77.0, 29.11, |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
433 109.0, 41.20, |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
434 146.0, 55.19, |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
435 187.0, 70.69, |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
436 239.0, 90.34, |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
437 305.0, 115.29, |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
438 390.0, 147.42, |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
439 498.0, 188.24, |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
440 635.0, 240.03 |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
441 }; |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
442 |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
443 rom const float e2secs[2*16] = { |
| 560 | 444 // result of 1 - 2^(-1/(2sec*HT)) |
|
521
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
445 //---- N2 ------------- He ------------ |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
446 5.75958E-03, 1.51848E-02, |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
447 2.88395E-03, 7.62144E-03, |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
448 1.84669E-03, 4.88315E-03, |
| 582 | 449 1.24813E-03, 3.29997E-03, |
| 450 8.55371E-04, 2.26041E-03, | |
| 451 6.03079E-04, 1.59437E-03, | |
| 452 4.25414E-04, 1.12479E-03, | |
| 453 3.00019E-04, 7.93395E-04, | |
| 454 2.11949E-04, 5.60641E-04, | |
| 455 1.58240E-04, 4.18555E-04, | |
| 456 1.23548E-04, 3.26795E-04, | |
| 457 9.66686E-05, 2.55722E-04, | |
| 458 7.57509E-05, 2.00387E-04, | |
| 459 5.92416E-05, 1.56716E-04, | |
| 460 4.63943E-05, 1.22734E-04, | |
| 461 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
|
462 //------------------------------------- |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
463 }; |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
464 |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
465 rom const float e1min[2*16] = { |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
466 // Integration constant for 1 minute, |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
467 // Ie. 1- 2^(-1/HT) |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
468 //----- N2 --------- e 1min He -------- |
| 582 | 469 1.59104E-01, 3.68109E-01, |
| 470 8.29960E-02, 2.05084E-01, | |
| 471 5.39424E-02, 1.36579E-01, | |
| 472 3.67742E-02, 9.44046E-02, | |
| 473 2.53454E-02, 6.56359E-02, | |
| 474 1.79351E-02, 4.67416E-02, | |
| 475 1.26840E-02, 3.31991E-02, | |
| 476 8.96152E-03, 2.35301E-02, | |
| 477 6.33897E-03, 1.66832E-02, | |
| 478 4.73633E-03, 1.24808E-02, | |
| 479 3.69981E-03, 9.75753E-03, | |
| 480 2.89600E-03, 7.64329E-03, | |
| 481 2.27003E-03, 5.99417E-03, | |
| 482 1.77572E-03, 4.69082E-03, | |
| 483 1.39089E-03, 3.67548E-03, | |
| 484 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
|
485 //------------------------------------- |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
486 }; |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
487 |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
488 rom const float e10min[2*16] = { |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
489 // The 10 min Value in float notation: |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
490 // result of 1 - 2^(-10/ht) |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
491 //---- N2 -------------- He ----------- |
| 582 | 492 8.23223E-01, 9.89851E-01, |
| 493 5.79552E-01, 8.99258E-01, | |
| 494 4.25651E-01, 7.69737E-01, | |
| 495 3.12487E-01, 6.29027E-01, | |
| 496 2.26416E-01, 4.92821E-01, | |
| 497 1.65547E-01, 3.80407E-01, | |
| 498 1.19840E-01, 2.86538E-01, | |
| 499 8.60863E-02, 2.11886E-01, | |
| 500 6.16117E-02, 1.54849E-01, | |
| 501 4.63665E-02, 1.18026E-01, | |
| 502 3.63881E-02, 9.34005E-02, | |
| 503 2.85855E-02, 7.38569E-02, | |
| 504 2.24698E-02, 5.83504E-02, | |
| 505 1.76160E-02, 4.59303E-02, | |
| 506 1.38222E-02, 3.61528E-02, | |
| 507 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
|
508 //------------------------------------- |
|
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
509 }; |
| 0 | 510 |
| 511 ////////////////////////////////////////////////////////////////////////////// | |
| 512 ////////////////////////////////////////////////////////////////////////////// | |
| 582 | 513 //////////////// THE SUBROUTINES //////////////// |
| 0 | 514 ////////////////////////////////////////////////////////////////////////////// |
| 515 ////////////////////////////////////////////////////////////////////////////// | |
| 516 // | |
| 517 // all new in v.102 | |
| 518 // moved from 0x0D000 to 0x0C000 in v.108 | |
| 519 #ifndef UNIX | |
| 520 # pragma code p2_deco = 0x0C000 | |
| 521 #endif | |
| 522 | |
| 523 ////////////////////////////////////////////////////////////////////////////// | |
| 524 ////////////////////////////////////////////////////////////////////////////// | |
| 582 | 525 //////////////// U T I L I T I E S //////////////// |
| 0 | 526 ////////////////////////////////////////////////////////////////////////////// |
| 527 ////////////////////////////////////////////////////////////////////////////// | |
| 528 | |
| 529 ////////////////////////////////////////////////////////////////////////////// | |
| 530 // Bump to blue-screen when an assert is wrong | |
| 531 #ifdef __DEBUG | |
| 532 void assert_failed(PARAMETER short int line) | |
| 533 { | |
| 534 } | |
| 535 #endif | |
| 536 | |
| 537 ////////////////////////////////////////////////////////////////////////////// | |
| 538 // When calling C code from ASM context, the data stack pointer and | |
| 539 // frames should be reset. Bank8 is used by stack | |
| 540 | |
| 541 #ifdef CROSS_COMPILE | |
| 542 # define RESET_C_STACK | |
| 543 #else | |
| 544 # ifdef __DEBUG | |
| 545 # define RESET_C_STACK fillDataStack(); | |
| 546 void fillDataStack(void) | |
| 547 { | |
| 548 _asm | |
| 549 LFSR 1,C_STACK | |
| 550 MOVLW 0xCC | |
| 551 loop: MOVWF POSTINC1,0 | |
| 552 TSTFSZ FSR1L,0 | |
| 553 BRA loop | |
| 554 | |
| 555 LFSR 1,C_STACK | |
| 556 LFSR 2,C_STACK | |
| 557 _endasm | |
| 558 } | |
| 559 # else | |
| 560 # define RESET_C_STACK \ | |
| 561 _asm \ | |
| 562 LFSR 1, C_STACK \ | |
| 563 LFSR 2, C_STACK \ | |
| 564 _endasm | |
| 565 # endif | |
| 566 #endif | |
| 567 | |
| 568 ////////////////////////////////////////////////////////////////////////////// | |
| 569 // Fast subroutine to read timer 5. | |
| 560 | 570 // Note: result is in 1/32 of milliseconds (30,51757813 us/bit to be precise) |
| 0 | 571 static unsigned short tmr5(void) |
| 572 { | |
| 573 #ifndef CROSS_COMPILE | |
| 574 _asm | |
| 575 movff 0xf7c,PRODL // TMR5L | |
| 576 movff 0xf7d,PRODH // TMR5H | |
| 577 _endasm // result in PRODH:PRODL. | |
| 578 #else | |
| 579 return 0; | |
| 580 #endif | |
| 581 } | |
| 582 | |
| 583 ////////////////////////////////////////////////////////////////////////////// | |
| 560 | 584 // read Buhlmann tables A and B for compartment ci |
| 0 | 585 // |
| 560 | 586 static void read_Buhlmann_coefficients(void) |
| 0 | 587 { |
| 588 #ifndef CROSS_COMPILE | |
| 589 // Note: we don't use far rom pointer, because the | |
| 590 // 24 bits is too complex, hence we have to set | |
| 591 // the UPPER page ourself... | |
| 592 // --> Set zero if tables are moved to lower pages ! | |
| 593 _asm | |
| 594 movlw 1 | |
| 595 movwf TBLPTRU,0 | |
| 596 _endasm | |
| 597 #endif | |
| 598 | |
| 599 assert( ci < NUM_COMP ); | |
| 600 | |
| 601 // Use an interleaved array (AoS) to access coefficients with a | |
| 602 // single addressing. | |
| 603 { | |
| 560 | 604 overlay rom const float* ptr = &Buhlmann_ab[4*ci]; |
| 0 | 605 var_N2_a = *ptr++; |
| 606 var_N2_b = *ptr++; | |
| 607 var_He_a = *ptr++; | |
| 608 var_He_b = *ptr++; | |
| 609 } | |
| 610 } | |
| 611 | |
| 612 ////////////////////////////////////////////////////////////////////////////// | |
| 560 | 613 // read Buhlmann tables for compartment ci |
| 0 | 614 // If period == 0 : 2sec interval |
| 615 // 1 : 1 min interval | |
| 616 // 2 : 10 min interval. | |
| 560 | 617 static void read_Buhlmann_times(PARAMETER char period) |
| 0 | 618 { |
| 619 #ifndef CROSS_COMPILE | |
| 620 // Note: we don't use far rom pointer, because the | |
| 621 // 24 bits is to complex, hence we have to set | |
| 622 // the UPPER page ourself... | |
| 623 // --> Set zero if tables are moved to lower pages ! | |
| 624 _asm | |
| 625 movlw 1 | |
| 626 movwf TBLPTRU,0 | |
| 627 _endasm | |
| 628 #endif | |
| 629 | |
| 630 assert( ci < NUM_COMP ); | |
| 631 | |
| 632 // Integration intervals. | |
| 633 switch(period) | |
| 634 { | |
| 635 case 0: //---- 2 sec ----------------------------------------------------- | |
| 636 { | |
| 637 overlay rom const float* ptr = &e2secs[2*ci]; | |
| 638 var_N2_e = *ptr++; | |
| 639 var_He_e = *ptr++; | |
| 640 } | |
| 641 break; | |
| 642 | |
| 643 case 1: //---- 1 min ----------------------------------------------------- | |
| 644 { | |
| 645 overlay rom const float* ptr = &e1min[2*ci]; | |
| 646 var_N2_e = *ptr++; | |
| 647 var_He_e = *ptr++; | |
| 648 } | |
| 649 break; | |
| 650 | |
| 651 case 2: //---- 10 min ---------------------------------------------------- | |
| 652 { | |
| 653 overlay rom const float* ptr = &e10min[2*ci]; | |
| 654 var_N2_e = *ptr++; | |
| 655 var_He_e = *ptr++; | |
| 656 } | |
| 657 break; | |
| 658 | |
| 659 default: | |
| 660 assert(0); // Never go there... | |
| 661 } | |
| 662 } | |
| 663 | |
| 664 ////////////////////////////////////////////////////////////////////////////// | |
| 560 | 665 // read Buhlmann tables for compartment ci |
| 0 | 666 // |
| 560 | 667 static void read_Buhlmann_ht(void) |
| 0 | 668 { |
| 669 | |
| 670 #ifndef CROSS_COMPILE | |
| 671 // Note: we don't use far rom pointer, because the | |
| 672 // 24 bits is to complex, hence we have to set | |
| 673 // the UPPER page ourself... | |
| 674 // --> Set zero if tables are moved to lower pages ! | |
| 675 _asm | |
| 676 movlw 1 | |
| 677 movwf TBLPTRU,0 | |
| 678 _endasm | |
| 679 #endif | |
| 680 | |
| 681 assert( ci < NUM_COMP ); | |
| 682 { | |
| 560 | 683 overlay rom const float* ptr = &Buhlmann_ht[2*ci]; |
| 0 | 684 var_N2_ht = *ptr++; |
| 685 var_He_ht = *ptr++; | |
| 686 } | |
| 687 | |
| 688 assert( 4.0 <= var_N2_ht && var_N2_ht <= 635.0 ); | |
| 689 assert( 1.5099 <= var_He_ht && var_He_ht <= 240.03 ); | |
| 690 } | |
| 691 | |
| 692 ////////////////////////////////////////////////////////////////////////////// | |
| 582 | 693 ////////////////////////////////////////////////////////////////////////////// |
| 694 //////////////// THE JUMP-IN CODE for the asm code //////////////// | |
| 695 ////////////////////////////////////////////////////////////////////////////// | |
| 696 ////////////////////////////////////////////////////////////////////////////// | |
| 697 | |
| 698 ////////////////////////////////////////////////////////////////////////////// | |
| 699 // deco_calc_hauptroutine | |
| 700 // | |
| 701 // called from: divemode.asm | |
| 702 // | |
| 703 // Called every second during diving, | |
| 704 // updates tissues on every second invocation. | |
| 705 // | |
| 706 // Every few seconds (or slower when TTS > 16): | |
| 707 // - Updates deco table (char_O_deco_time/depth) with new values, | |
| 708 // - updates ascent time, and | |
| 709 // - sets status to zero (so we can check there is new results). | |
| 710 // | |
| 711 void deco_calc_hauptroutine(void) | |
| 712 { | |
| 713 RESET_C_STACK | |
| 714 calc_hauptroutine(); | |
| 715 } | |
| 716 | |
| 717 ////////////////////////////////////////////////////////////////////////////// | |
| 718 // deco_clear_tissue | |
| 719 // | |
| 720 // called from: start.asm | |
| 721 // menu_tree.asm | |
| 722 // simulator.asm | |
| 723 // | |
| 724 // Sets all tissues to equilibrium with Air at ambient pressure, | |
| 725 // resets all CNS values, any warnings and resets all model output. | |
| 726 // | |
| 727 void deco_clear_tissue(void) | |
| 728 { | |
| 729 RESET_C_STACK | |
| 730 clear_tissue(); | |
| 731 } | |
| 732 | |
| 733 ////////////////////////////////////////////////////////////////////////////// | |
| 734 // deco_calc_dive_interval | |
| 735 // | |
| 736 // called from: simulator.asm | |
| 737 // | |
| 738 // Updates tissues and CNS value for char_I_dive_interval minutes on Air | |
| 739 // at ambient pressure and calculates resulting GF factor and ceiling for | |
| 740 // a GF-high of 100% (ceiling and GF factor not used by simulator.asm) | |
| 741 // | |
| 742 void deco_calc_dive_interval(void) | |
| 743 { | |
| 744 RESET_C_STACK | |
| 745 calc_interval(char_I_dive_interval); | |
| 746 } | |
| 747 | |
| 748 ////////////////////////////////////////////////////////////////////////////// | |
| 749 // deco_calc_dive_interval_1min | |
| 750 // | |
| 751 // called from: start.asm | |
| 752 // sleepmode.asm | |
| 753 // surfmode.asm | |
| 754 // menu_tree.asm | |
| 755 // ghostwriter.asm | |
| 756 // | |
| 757 // Updates tissues and CNS value for 1 minute on Air at ambient pressure and | |
| 758 // calculates resulting GF factor and ceiling for a GF-high of 100% (ceiling | |
| 759 // is not used by *.asm files). | |
| 760 // | |
| 761 void deco_calc_dive_interval_1min(void) | |
| 762 { | |
| 763 RESET_C_STACK | |
| 764 calc_interval(1); | |
| 765 } | |
| 766 | |
| 767 | |
| 768 ////////////////////////////////////////////////////////////////////////////// | |
| 769 // deco_calc_dive_interval_1min | |
| 770 // | |
| 771 // called from: sleepmode.asm | |
| 772 // | |
| 773 // Updates tissues and CNS value for 10 minutes on Air at ambient pressure and | |
| 774 // calculates resulting GF factor and ceiling for a GF-high of 100% (ceiling | |
| 775 // is not used by sleepmode.asm). | |
| 776 // | |
| 777 void deco_calc_dive_interval_10min(void) | |
| 778 { | |
| 779 RESET_C_STACK | |
| 780 calc_interval(10); | |
| 781 } | |
| 782 | |
| 783 | |
| 784 ////////////////////////////////////////////////////////////////////////////// | |
| 785 // deco_calc_desaturation_time | |
| 786 // | |
| 787 // called from: start.asm | |
| 788 // surfmode.asm | |
| 789 // menu_tree.asm | |
| 790 // ghostwriter.asm | |
| 791 // | |
| 792 // Computes desaturation and no-fly times. | |
| 793 // | |
| 794 void deco_calc_desaturation_time(void) | |
| 795 { | |
| 796 RESET_C_STACK | |
| 797 calc_desaturation_time(); | |
| 798 } | |
| 799 | |
| 800 ////////////////////////////////////////////////////////////////////////////// | |
| 801 // deco_push_tissues_to_vault | |
| 802 // | |
| 803 // called from: simulator.asm | |
| 804 // | |
| 805 // Makes a backup of the state of the real tissues and the deco engine. | |
| 806 // | |
| 807 void deco_push_tissues_to_vault(void) | |
| 808 { | |
| 809 RESET_C_STACK | |
| 810 push_tissues_to_vault(); | |
| 811 } | |
| 812 | |
| 813 ////////////////////////////////////////////////////////////////////////////// | |
| 814 // deco_pull_tissues_from_vault | |
| 815 // | |
| 816 // called from: simulator.asm | |
| 817 // ghostwriter.asm | |
| 818 // | |
| 819 // Restores the state of the real tissues and the deco engine from the backup. | |
| 820 // | |
| 821 void deco_pull_tissues_from_vault(void) | |
| 822 { | |
| 823 RESET_C_STACK | |
| 824 pull_tissues_from_vault(); | |
| 825 } | |
| 826 | |
| 827 ////////////////////////////////////////////////////////////////////////////// | |
| 828 ////////////////////////////////////////////////////////////////////////////// | |
| 829 //////////////// THE FUNCTIONS //////////////// | |
| 830 ////////////////////////////////////////////////////////////////////////////// | |
| 831 ////////////////////////////////////////////////////////////////////////////// | |
| 832 | |
| 833 | |
| 834 ////////////////////////////////////////////////////////////////////////////// | |
| 0 | 835 // calc_nextdecodepth |
| 836 // | |
| 837 // new in v.102 | |
| 838 // | |
| 839 // INPUT, changing during dive: | |
| 582 | 840 // sim_pres_respiration : current depth in absolute pressure |
| 0 | 841 // |
| 842 // INPUT, fixed during dive: | |
| 843 // pres_surface | |
| 844 // GF_delta | |
| 845 // GF_high | |
| 846 // GF_low | |
| 847 // char_I_depth_last_deco | |
| 848 // | |
| 560 | 849 // MODIFIED |
| 850 // locked_GF_step_norm/_alt : used for GF model | |
| 851 // low_depth_norm/_alt : used for GF model | |
| 0 | 852 // |
| 853 // OUTPUT | |
| 582 | 854 // sim_depth_limit : depth of next stop in meters (if RETURN == true ) |
| 855 // depth we can ascent to without stop (if RETURN == false) | |
| 560 | 856 // |
| 857 // RETURN TRUE if a stop is needed. | |
| 0 | 858 // |
| 859 static unsigned char calc_nextdecodepth(void) | |
| 860 { | |
| 582 | 861 overlay unsigned char need_stop; |
| 862 | |
| 560 | 863 // compute current depth in meters |
| 582 | 864 overlay float depth = (sim_pres_respiration - pres_surface) * BAR_TO_METER; |
| 865 | |
| 866 // compute depth in meters after 1 minute of ascent at float_ascent_speed (5..10 m/min) | |
| 867 overlay float min_depth = (depth > float_ascent_speed) ? (depth - float_ascent_speed) : 0.0; | |
| 868 | |
| 869 | |
| 870 // allow for 200mbar of weather dependent surface pressure change | |
| 871 assert( depth >= -0.2 ); | |
| 560 | 872 |
| 873 | |
| 874 //---- check if a stop is needed for deco reasons ---------------------------- | |
| 582 | 875 |
| 876 // switch on deco model | |
| 877 if( char_I_deco_model != 0 ) | |
| 878 { | |
| 560 | 879 //---- ZH-L16 + GRADIENT FACTOR Model ------------------------------------ |
| 582 | 880 |
| 560 | 881 overlay float locked_GF_step; |
| 882 overlay float low_depth; | |
| 582 | 883 overlay float limit_depth; |
| 884 | |
| 885 overlay unsigned char first_stop = 0; | |
| 886 | |
| 887 | |
| 888 // calculate minimum depth we can ascent to in bar relative pressure | |
| 889 calc_limit(GF_low); | |
| 560 | 890 |
| 891 // check if we can surface directly | |
| 582 | 892 if( sim_ceiling <= 0.0 ) |
| 560 | 893 { |
| 894 min_depth = 0.0; // set minimum depth to 0 meters = surface | |
| 895 goto no_deco_stop; // done. | |
| 896 } | |
| 897 | |
| 898 // convert minimum depth we can ascent to from relative pressure to depth in meters | |
| 582 | 899 limit_depth = sim_ceiling * BAR_TO_METER; |
| 560 | 900 |
| 901 // recall low_depth dependent on current plan | |
| 902 low_depth = (char_O_deco_status & DECO_PLAN_ALTERNATE) ? low_depth_alt : low_depth_norm; | |
| 903 | |
| 582 | 904 // Store the deepest point needing a deco stop as the LOW reference for GF. |
| 905 // NOTE: following stops will be validated using this LOW-HIGH GF scale, | |
| 906 // so if we want to keep coherency, we should not validate this stop | |
| 907 // yet, but apply the search to it, as for all the following stops afterward. | |
| 908 if( limit_depth > low_depth ) | |
| 909 { | |
| 560 | 910 // update GF parameters |
| 582 | 911 low_depth = limit_depth; |
| 912 locked_GF_step = GF_delta / low_depth; | |
| 913 | |
| 560 | 914 // store updated GF parameters dependent on current plan |
| 915 if( char_O_deco_status & DECO_PLAN_ALTERNATE ) | |
| 916 { | |
| 917 low_depth_alt = low_depth; | |
| 918 locked_GF_step_alt = locked_GF_step; | |
| 919 } | |
| 920 else | |
| 921 { | |
| 922 low_depth_norm = low_depth; | |
| 923 locked_GF_step_norm = locked_GF_step; | |
| 924 } | |
| 582 | 925 } |
| 560 | 926 else |
| 927 { | |
| 928 // recall locked_GF_step dependent on current plan | |
| 929 locked_GF_step = (char_O_deco_status & DECO_PLAN_ALTERNATE) ? locked_GF_step_alt : locked_GF_step_norm; | |
| 930 } | |
| 931 | |
| 932 // invalidate this stop if we can ascent for 1 minute without going above minimum required deco depth | |
| 582 | 933 if( limit_depth < min_depth ) goto no_deco_stop; |
| 934 | |
| 935 | |
| 560 | 936 // if program execution passes here, we need a deco stop |
| 582 | 937 |
| 938 // Round to multiple of 3 meters | |
| 939 first_stop = 3 * (unsigned char)(0.9995 + limit_depth * 0.333333); | |
| 560 | 940 |
| 941 // check a constraint | |
| 582 | 942 assert( first_stop < 128 ); |
| 943 | |
| 944 // apply correction for the shallowest stop, use char_I_depth_last_deco (3..6 m) instead | |
| 945 if( first_stop == 3 ) first_stop = char_I_depth_last_deco; | |
| 946 | |
| 947 // We have a stop candidate. | |
| 948 // But maybe ascending to the next stop will diminish the constraint, | |
| 949 // because the GF might decrease more than the pressure gradient... | |
| 950 while(first_stop > 0) | |
| 951 { | |
| 560 | 952 // Next depth |
| 582 | 953 overlay unsigned char next_stop; |
| 954 | |
| 955 // invalidate this stop if we can ascent one more minute without going above minimum required deco depth | |
| 956 if( first_stop <= (unsigned char)min_depth ) goto no_deco_stop; | |
| 560 | 957 |
| 958 // compute depth of next stop | |
| 582 | 959 if ( first_stop <= char_I_depth_last_deco ) next_stop = 0; |
| 960 else if ( first_stop == 6 ) next_stop = char_I_depth_last_deco; | |
| 961 else next_stop = first_stop - 3; | |
| 962 | |
| 963 // compute limit with the GF of the new stop candidate | |
| 964 if( (low_depth == 0.0) || (next_stop > low_depth) ) calc_limit(GF_low); | |
| 965 else calc_limit(GF_high - next_stop * locked_GF_step); | |
| 966 | |
| 967 // check if ascent to the next stop candidate is possible | |
| 968 if( sim_ceiling * BAR_TO_METER >= next_stop ) goto deco_stop_found; // no - ascent to next_stop forbidden | |
| 969 | |
| 970 // else, validate that stop and loop... | |
| 971 first_stop = next_stop; | |
| 972 } | |
| 0 | 973 |
| 974 no_deco_stop: | |
| 582 | 975 need_stop = 0; // set flag for stop needed to 'no' |
| 976 sim_depth_limit = (unsigned char)min_depth; // report depth we can ascent to without stop | |
| 560 | 977 goto done; |
| 0 | 978 |
|
342
7812ec7ef694
Fix low_depth shall be stored as a float (no rounding).
jDG
parents:
324
diff
changeset
|
979 deco_stop_found: |
| 582 | 980 need_stop = 1; // set flag for stop needed to 'yes' |
| 981 sim_depth_limit = (unsigned char)first_stop; // stop depth, in meters | |
| 0 | 982 |
| 983 done: | |
| 582 | 984 ; |
| 985 } | |
| 986 else | |
| 987 { | |
| 560 | 988 //---- ZH-L16 model ------------------------------------------------- |
| 582 | 989 |
| 990 overlay float limit_depth; | |
| 991 | |
| 992 | |
| 993 // calculate minimum depth we can ascent to in bar relative pressure | |
| 994 calc_limit(1.0); | |
| 560 | 995 |
| 996 // check if we can surface directly | |
| 582 | 997 if (sim_ceiling >= 0) |
| 998 { | |
| 560 | 999 // no - set flag for stop needed to 'yes' |
| 582 | 1000 need_stop = 1; |
| 560 | 1001 |
| 1002 // convert stop depth in relative pressure to stop index | |
| 582 | 1003 limit_depth = sim_ceiling * BAR_TO_METER / 3; |
| 560 | 1004 |
| 1005 // convert stop index to depth in meters, rounded to multiple of 3 meters | |
| 582 | 1006 sim_depth_limit = 3 * (short)(limit_depth + 0.99); |
| 1007 | |
| 1008 // correct last stop to 4m/5m/6m | |
| 1009 if( sim_depth_limit == 3 ) sim_depth_limit = char_I_depth_last_deco; | |
| 1010 } | |
| 1011 else | |
| 560 | 1012 { |
| 1013 // yes - set flag for stop needed to 'no' | |
| 582 | 1014 need_stop = 0; |
| 560 | 1015 |
| 1016 // set depth we can ascent to as 0 = surface | |
| 582 | 1017 sim_depth_limit = 0; |
| 560 | 1018 } |
| 582 | 1019 } |
| 1020 | |
| 560 | 1021 // After the first deco stop, gas changes are only done at deco stops now! |
| 582 | 1022 |
| 560 | 1023 // check if a stop is found and there is a better gas to switch to |
| 1024 if( need_stop && gas_find_better() ) | |
| 1025 { | |
| 1026 // set the new calculation ratios for N2, He and O2 | |
| 582 | 1027 gas_set_ratios(); |
| 560 | 1028 |
| 1029 // prime the deco stop with the gas change time | |
| 1030 update_deco_table(char_I_gas_change_time); | |
| 1031 } | |
| 0 | 1032 |
| 582 | 1033 return need_stop; |
| 0 | 1034 } |
| 1035 | |
| 1036 ////////////////////////////////////////////////////////////////////////////// | |
| 582 | 1037 // publish_deco_table |
| 0 | 1038 // |
| 1039 // Buffer the stops, once computed, so we can continue to display them | |
| 1040 // while computing the next set. | |
| 1041 // | |
| 582 | 1042 static void publish_deco_table(void) |
| 0 | 1043 { |
| 582 | 1044 overlay unsigned char x, y; |
| 1045 | |
| 1046 | |
| 1047 // Copy depth of the first (deepest) stop, because when reversing | |
| 1048 // order, it will be hard to find... | |
| 1049 char_O_first_deco_depth = internal_deco_depth[0]; | |
| 1050 char_O_first_deco_time = internal_deco_time [0]; | |
| 1051 | |
| 1052 for(x=0; x<NUM_STOPS; x++) | |
| 1053 { | |
| 1054 char_O_deco_depth[x] = internal_deco_depth[x]; | |
| 1055 char_O_deco_time [x] = internal_deco_time [x]; | |
| 1056 char_O_deco_gas [x] = internal_deco_gas [x]; | |
| 1057 } | |
| 1058 | |
| 1059 //Now fill the char_O_deco_time_for_log array | |
| 1060 //---- First: search the first non-null depth | |
| 1061 for(x=(NUM_STOPS-1); x != 0; --x) | |
| 1062 if( internal_deco_depth[x] != 0 ) break; | |
| 1063 | |
| 1064 //---- Second: copy to output table (in reverse order) | |
| 1065 for(y=0; y<NUM_STOPS; y++, --x) | |
| 1066 { | |
| 1067 char_O_deco_time_for_log[y] = internal_deco_time [x]; | |
| 1068 | |
| 1069 // Stop only once the last transfer is done. | |
| 1070 if( x == 0 ) break; | |
| 1071 } | |
| 1072 | |
| 1073 //---- Third: fill table with null until end | |
| 1074 for(y++; y<NUM_STOPS; y++) | |
| 1075 char_O_deco_time_for_log[y] = 0; | |
| 0 | 1076 } |
| 1077 | |
| 1078 ////////////////////////////////////////////////////////////////////////////// | |
| 560 | 1079 // temp_tissue_safety |
| 0 | 1080 // |
| 1081 // outsourced in v.102 | |
| 1082 // | |
|
521
06e9370c6d75
CHANGE: Apply safety margin parameters to both models (GF and non-GF)
heinrichsweikamp
parents:
519
diff
changeset
|
1083 // Apply safety factors for both ZH-L16 models. |
| 0 | 1084 // |
| 1085 static void temp_tissue_safety(void) | |
| 1086 { | |
| 582 | 1087 assert( 0.0 < float_desaturation_multiplier && float_desaturation_multiplier <= 1.0 ); |
| 1088 assert( 1.0 <= float_saturation_multiplier && float_saturation_multiplier <= 2.0 ); | |
| 0 | 1089 |
| 560 | 1090 if( temp_tissue < 0.0 ) temp_tissue *= float_desaturation_multiplier; |
| 1091 else temp_tissue *= float_saturation_multiplier; | |
| 0 | 1092 } |
| 1093 | |
| 560 | 1094 |
| 1095 | |
| 1096 ////////////////////////////////////////////////////////////////////////////// | |
| 1097 // Find current gas in the list (if any) and get its change depth | |
| 1098 // | |
| 1099 // Input: char_I_current_gas : 1..5 or 6 | |
| 1100 // | |
| 1101 // Output: sim_gas_last_used : 1..6 or 0 if it is the gas set as FIRST | |
| 1102 // sim_gas_last_depth : change depth in meters or 0 if it is the gas set as FIRST | |
| 1103 // | |
| 1104 static void gas_find_current(void) | |
| 1105 { | |
| 582 | 1106 assert( 1 <= char_I_current_gas && char_I_current_gas <= 6 ); |
| 1107 | |
| 1108 if( char_I_current_gas <= NUM_GAS ) // Gas 1-5 | |
| 1109 { | |
| 1110 sim_gas_last_used = sim_gas_first_used = char_I_current_gas; | |
| 1111 | |
| 1112 // If current gas is a deco gas get it's change depth. | |
| 560 | 1113 // Set change depth to 0 if the current gas is the first gas or |
| 1114 // a travel/normal gas, i.e. if it can be breathed at "any" depth. | |
| 582 | 1115 if( char_I_deco_gas_change[sim_gas_last_used-1] ) sim_gas_last_depth = char_I_deco_gas_change[sim_gas_last_used-1]; |
| 560 | 1116 else sim_gas_last_depth = 0; |
| 582 | 1117 } |
| 1118 else | |
| 560 | 1119 { |
| 582 | 1120 sim_gas_last_used = sim_gas_first_used = 0; // Gas 6 (the manually set one) has number 0 here |
| 560 | 1121 sim_gas_last_depth = 0; // handle it as a travel/normal gas |
| 1122 } | |
| 1123 } | |
| 1124 | |
| 1125 | |
| 1126 ////////////////////////////////////////////////////////////////////////////// | |
| 1127 // Find the deco gas with the shallowest change depth beyond current depth | |
| 1128 // | |
| 582 | 1129 // INPUT sim_depth_limit : current depth in meters |
| 560 | 1130 // char_I_deco_gas_change[] : change depths of the deco gases |
| 582 | 1131 // sim_gas_last_depth : change depth of the currently used gas, 0 if on the gas set as FIRST |
| 560 | 1132 // |
| 1133 // OUTPUT sim_gas_last_depth : switch depth - only if return value is true | |
| 1134 // sim_gas_last_used : index of the gas (1..5) - only if return value is true | |
| 1135 // | |
| 1136 // RETURNS TRUE if a better gas is available | |
| 1137 // | |
| 1138 static unsigned char gas_find_better(void) | |
| 1139 { | |
| 1140 overlay unsigned char switch_depth = 255; | |
| 1141 overlay unsigned char switch_gas = 0; | |
| 1142 overlay unsigned char j; | |
| 582 | 1143 |
| 1144 | |
| 560 | 1145 // no automatic gas changes in CCR mode and - as of now - in pSCR mode |
| 1146 if( char_O_deco_status & DECO_MODE_LOOP ) return 0; | |
| 1147 | |
| 1148 // Loop over all deco gases to find the shallowest one below or at current depth. | |
| 1149 for(j=0; j<NUM_GAS; ++j) | |
| 1150 { | |
| 1151 // Is this the gas we are already breathing? | |
| 1152 // If yes, skip this gas. | |
| 1153 if( j+1 == sim_gas_last_used ) continue; | |
| 1154 | |
| 1155 // Is the change depth of the gas shallower than the current depth? | |
| 1156 // If yes, skip this gas as it is not to be used yet. | |
| 1157 // Remark: this check will also skip all disabled gases and the gas set | |
| 1158 // as 'first' because these have their change depth set to 0. | |
| 582 | 1159 if( sim_depth_limit > char_I_deco_gas_change[j] ) continue; |
| 560 | 1160 |
| 1161 // Is the change depth of the gas deeper than the change depth of the | |
| 1162 // gas we are currently one? | |
| 1163 // If yes, skip this gas as it is not better than the current one. | |
| 1164 // Remark: if there is more than one gas with the same change depth, | |
| 1165 // the last one from the list will be taken. | |
| 1166 if( sim_gas_last_depth && (char_I_deco_gas_change[j] > sim_gas_last_depth) ) continue; | |
| 1167 | |
| 1168 // Is the change depth of the gas shallower or equal to the change depth | |
| 1169 // of the best gas found so far, or is it the first better gas found? | |
| 1170 // If yes, we have a better gas | |
| 1171 if( char_I_deco_gas_change[j] <= switch_depth ) | |
| 1172 { | |
| 1173 switch_gas = j+1; // remember this gas (1..5) | |
| 1174 switch_depth = char_I_deco_gas_change[j]; // remember its change depth | |
| 1175 } | |
| 1176 } // continue looping through all gases to eventually find an even better gas | |
| 1177 | |
| 1178 // has a better gas been found? | |
| 1179 if( switch_gas ) | |
| 1180 { | |
| 1181 // yes | |
| 1182 sim_gas_last_used = switch_gas; // report the index of the better | |
| 1183 sim_gas_last_depth = switch_depth; // report its change depth | |
| 1184 | |
| 1185 assert( sim_gas_last_depth < switch_depth ); | |
| 582 | 1186 |
| 560 | 1187 return 1; // signal a better gas was found |
| 1188 } | |
| 1189 else | |
| 1190 { | |
| 1191 return 0; // signal no better gas was found | |
| 1192 } | |
| 0 | 1193 } |
| 1194 | |
| 1195 ////////////////////////////////////////////////////////////////////////////// | |
| 560 | 1196 // Set calc_N2/He/O2_ratios by sim_gas_last_used |
| 0 | 1197 // |
| 582 | 1198 // Input: sim_gas_last_used : index of gas to use |
| 1199 // N2_ratio, He_ratio : if gas = 0 (the manually set gas) | |
| 1200 // char_I_deco_O2/He_ratio[] : if gas = 1..5 (the configured gases) | |
| 0 | 1201 // |
| 582 | 1202 // Output: sim_N2_ratio, sim_He_ratio : ratios of the inert gases |
| 1203 // sim_pSCR_drop : ppO2 drop in pSCR loop | |
| 0 | 1204 // |
| 582 | 1205 static void gas_set_ratios(void) |
| 0 | 1206 { |
| 582 | 1207 overlay float sim_IG_ratio; |
| 1208 | |
| 560 | 1209 assert( 0 <= sim_gas_last_used <= NUM_GAS ); |
| 1210 | |
| 582 | 1211 |
| 1212 // get gas ratios | |
| 1213 if( sim_gas_last_used == 0 ) | |
| 560 | 1214 { |
| 582 | 1215 sim_O2_ratio = O2_ratio; |
| 1216 sim_He_ratio = He_ratio; | |
| 560 | 1217 } |
| 1218 else | |
| 1219 { | |
| 582 | 1220 sim_O2_ratio = 0.01 * char_I_deco_O2_ratio[sim_gas_last_used-1]; |
| 1221 sim_He_ratio = 0.01 * char_I_deco_He_ratio[sim_gas_last_used-1]; | |
| 560 | 1222 } |
| 1223 | |
| 582 | 1224 // inert gas ratio (local helper variable) |
| 1225 sim_IG_ratio = 1.00 - sim_O2_ratio; | |
| 1226 | |
| 1227 // N2 ratio | |
| 1228 sim_N2_ratio = sim_IG_ratio - sim_He_ratio; | |
| 1229 | |
| 1230 // ppO2 drop in pSCR loop | |
| 1231 sim_pSCR_drop = sim_IG_ratio * float_pSCR_factor; | |
| 1232 | |
| 1233 | |
| 1234 assert( 0.0 <= sim_N2_ratio && sim_N2_ratio <= 0.95 ); | |
| 1235 assert( 0.0 <= sim_He_ratio && sim_He_ratio <= 0.95 ); | |
| 1236 assert( (sim_N2_ratio + sim_He_ratio) <= 0.95 ); | |
| 0 | 1237 } |
| 1238 | |
| 1239 ////////////////////////////////////////////////////////////////////////////// | |
| 582 | 1240 // Compute respired ppN2 and ppHe |
| 0 | 1241 // |
| 582 | 1242 // Input: tissue_increment : selector for targeting simulated or real tissues |
| 1243 // char_O_main_status : breathing mode for real tissues | |
| 1244 // char_O_deco_status : breathing mode for simulated tissues | |
| 1245 // (sim_)O2_ratio : (simulated) O2 ratio breathed | |
| 1246 // (sim_)N2_ratio : (simulated) N2 ratio breathed | |
| 1247 // (sim_)He_ratio : (simulated) He ratio breathed | |
| 1248 // (sim_)pres_respiration : (simulated) respiration pressure | |
| 1249 // char_I_const_ppO2 : ppO2 reported from sensors or setpoint | |
| 1250 // char_I_PSCR_drop : pSCR parameter | |
| 1251 // char_I_PSCR_lungratio : pSCR parameter | |
| 1252 // pres_surface : surface pressure | |
| 1253 // float_deco_distance : safety factor | |
| 1254 // ppWater : water-vapor pressure inside respiratory tract | |
| 0 | 1255 // |
| 582 | 1256 // Output: ppN2 : respired N2 partial pressure |
| 1257 // ppHe : respired He partial pressure | |
| 0 | 1258 // |
| 582 | 1259 void calc_alveolar_pressures(void) |
| 0 | 1260 { |
| 582 | 1261 overlay float pres_diluent; |
| 1262 overlay float calc_O2_ratio; | |
| 1263 overlay float calc_N2_ratio; | |
| 1264 overlay float calc_He_ratio; | |
| 1265 overlay float calc_pSCR_drop; | |
| 1266 | |
| 1267 overlay unsigned char status; | |
| 1268 | |
| 1269 | |
| 1270 assert( 0.00 <= N2_ratio && N2_ratio <= 1.00 ); | |
| 1271 assert( 0.00 <= He_ratio && He_ratio <= 1.00 ); | |
| 1272 assert( (N2_ratio + He_ratio) <= 1.00 ); | |
| 1273 assert( 0.800 < pres_respiration && pres_respiration < 14.0 ); | |
| 1274 | |
| 1275 assert( 0.00 <= sim_N2_ratio && N2_ratio <= 1.00 ); | |
| 1276 assert( 0.00 <= sim_He_ratio && He_ratio <= 1.00 ); | |
| 1277 assert( (sim_N2_ratio + sim_He_ratio) <= 1.00 ); | |
| 1278 assert( 0.800 < sim_pres_respiration && sim_pres_respiration < 14.0 ); | |
| 1279 | |
| 1280 | |
| 1281 // get input data according to context | |
| 1282 if( tissue_increment & TISSUE_FLAG ) | |
| 1283 { | |
| 1284 //---- real tissues ----------------------------------------------------------- | |
| 1285 status = char_O_main_status; | |
| 1286 pres_diluent = pres_respiration; | |
| 1287 calc_pSCR_drop = pSCR_drop; | |
| 1288 | |
| 1289 calc_O2_ratio = O2_ratio; | |
| 1290 calc_N2_ratio = N2_ratio; | |
| 1291 calc_He_ratio = He_ratio; | |
| 1292 } | |
| 1293 else | |
| 1294 { | |
| 1295 //---- simulated tissues ------------------------------------------------------ | |
| 1296 status = char_O_deco_status; | |
| 1297 pres_diluent = sim_pres_respiration; | |
| 1298 calc_pSCR_drop = sim_pSCR_drop; | |
| 1299 | |
| 1300 calc_O2_ratio = sim_O2_ratio; | |
| 1301 calc_N2_ratio = sim_N2_ratio; | |
| 1302 calc_He_ratio = sim_He_ratio; | |
| 1303 | |
| 1304 // take deco offset into account, but not at surface | |
| 1305 if( pres_diluent > pres_surface ) pres_diluent += float_deco_distance; | |
| 1306 } | |
| 1307 | |
| 1308 //---- OC, CCR and Bailout Mode Gas Calculations ----------------------------------- | |
| 1309 | |
| 1310 // calculate ppO2 of pure oxygen | |
| 1311 O2_ppO2 = (pres_diluent - ppWater); | |
| 1312 | |
| 1313 // capture failure condition in case pres_respiration is < ppWater (should never happen...) | |
| 1314 if( O2_ppO2 < 0.0 ) O2_ppO2 = 0.0; | |
| 1315 | |
| 1316 // calculate ppO2 of the pure gas (diluent) | |
| 1317 OC_ppO2 = O2_ppO2 * calc_O2_ratio; | |
| 1318 | |
| 1319 // calculate pSCR ppO2 | |
| 1320 pSCR_ppO2 = OC_ppO2 - calc_pSCR_drop; | |
| 1321 | |
| 1322 // capture failure condition in case pSCR_ppO2 becomes negative | |
| 1323 if( pSCR_ppO2 < 0.0 ) pSCR_ppO2 = 0.0; | |
| 1324 | |
| 1325 | |
| 1326 //---- Loop modes : adjust ppN2 and ppHe for change in ppO2 due to setpoint (CCR) or drop (pSCR) --- | |
| 1327 if( status & DECO_MODE_LOOP ) | |
| 1328 { | |
| 1329 overlay float const_ppO2; | |
| 1330 | |
| 1331 // get the current sensor reading (CCR / pSCR if fitted) or the fixed setpoint (CCR) / a zero (pSCR) | |
| 1332 const_ppO2 = 0.01 * char_I_const_ppO2; | |
| 1333 | |
| 1334 // Limit the setpoint to the maximum physically possible ppO2. This prevents for | |
| 1335 // example calculating with a setpoint of 1.3 bar in only 2 meters of depth. | |
| 1336 // Additionally, if limiting occurs, the ppO2 can be further reduced to account | |
| 1337 // for residual inert gases by the user-adjustable setting char_I_cc_max_frac_o2. | |
| 1338 | |
| 1339 if( const_ppO2 > pres_diluent ) // no ppWater subtracted here to give some margin for | |
| 1340 { // sensors delivering data a little bit over target | |
| 1341 const_ppO2 = 0.01 * char_I_cc_max_frac_o2 * (pres_diluent - ppWater); | |
| 1342 } | |
| 1343 | |
| 1344 // check which kind of loop we are on | |
| 1345 if( status & DECO_MODE_PSCR ) | |
| 560 | 1346 { |
| 582 | 1347 //---- pSCR Mode -------------------------------------------------------------------------- |
| 1348 | |
| 1349 // Use the sensor value if available, but only in real tissue context! | |
| 1350 // In all other cases use calculated ppO2. | |
| 1351 if( char_I_const_ppO2 && (tissue_increment & TISSUE_FLAG)) ppO2 = const_ppO2; | |
| 1352 else ppO2 = pSCR_ppO2; | |
| 1353 } | |
| 560 | 1354 else |
| 1355 { | |
| 582 | 1356 //---- CCR Mode --------------------------------------------------------------------------- |
| 1357 | |
| 1358 // derive breathed ppO2 from (char_I_)const_ppO2, | |
| 1359 // which holds sensor reading or fixed setpoint | |
| 1360 ppO2 = const_ppO2; | |
| 560 | 1361 } |
| 1362 | |
| 582 | 1363 // adjust diluent pressure (ppN2 + ppHe) for change |
| 1364 // in ppO2 due to setpoint (CCR) or drop (pSCR) | |
| 1365 pres_diluent -= const_ppO2; | |
| 1366 pres_diluent /= calc_N2_ratio + calc_He_ratio; | |
| 1367 | |
| 1368 // capture all failure conditions, including div/0 | |
| 1369 // in case diluent is pure O2 | |
| 1370 if( (pres_diluent < 0.0) || (calc_O2_ratio > 99.5) ) | |
| 560 | 1371 { |
| 582 | 1372 pres_diluent = 0.0; |
| 1373 ppO2 = OC_ppO2; | |
| 560 | 1374 } |
| 582 | 1375 } |
| 1376 else | |
| 1377 { //---- OC mode --------------------------------------------------------------------------------- | |
| 1378 | |
| 1379 // breathed ppO2 is ppO2 of pure gas | |
| 1380 ppO2 = OC_ppO2; | |
| 560 | 1381 } |
| 1382 | |
| 582 | 1383 |
| 1384 // derive char_ppO2 in [cbar], used for calculating CNS% | |
| 1385 if ( ppO2 < 0.01 ) char_ppO2 = 0; | |
| 1386 else if ( ppO2 >= 2.545 ) char_ppO2 = 255; | |
| 1387 else char_ppO2 = (unsigned char)(100 * ppO2 + 0.5); | |
| 1388 | |
| 1389 | |
| 1390 //---- calculate ppN2 and ppHe --------------------------------------------------------------------- | |
| 1391 | |
| 1392 if( pres_diluent > ppWater ) | |
| 1393 { | |
| 1394 ppN2 = calc_N2_ratio * (pres_diluent - ppWater); | |
| 1395 ppHe = calc_He_ratio * (pres_diluent - ppWater); | |
| 1396 } | |
| 1397 else | |
| 1398 { | |
| 1399 ppN2 = 0.0; | |
| 1400 ppHe = 0.0; | |
| 1401 } | |
| 0 | 1402 } |
| 1403 | |
| 1404 ////////////////////////////////////////////////////////////////////////////// | |
| 1405 // clear_tissue | |
| 1406 // | |
| 1407 // optimized in v.101 (var_N2_a) | |
| 1408 // | |
| 1409 // preload tissues with standard pressure for the given ambient pressure. | |
| 1410 // | |
| 1411 static void clear_tissue(void) | |
| 1412 { | |
| 560 | 1413 pres_respiration = 0.001 * int_I_pres_respiration; |
| 1414 N2_equilibrium = 0.7902 * (pres_respiration - ppWater); | |
| 582 | 1415 |
| 1416 for(ci=0; ci<NUM_COMP; ci++) | |
| 1417 { | |
| 1418 // cycle through the 16 Buhlmann N2 tissues | |
| 1419 pres_tissue_N2[ci] = N2_equilibrium; // initialize data for "real" tissue | |
| 560 | 1420 char_O_tissue_N2_saturation[ci] = 11; // initialize data for tissue graphics |
| 582 | 1421 |
| 1422 // cycle through the 16 Buhlmann He tissues | |
| 1423 pres_tissue_He[ci] = 0.0; // initialize data for "real" tissue | |
| 560 | 1424 char_O_tissue_He_saturation[ci] = 0; // initialize data for tissue graphics |
| 582 | 1425 } |
| 1426 | |
| 1427 // reset CNS values | |
| 1428 CNS_fraction = 0.0; | |
| 1429 int_O_CNS_fraction = int_O_normal_CNS_fraction = int_O_alternate_CNS_fraction = 0; | |
| 1430 | |
| 1431 | |
| 1432 // reset any warnings | |
| 1433 char_O_deco_warnings = 0; | |
| 1434 | |
| 1435 // reset some more vars to their defaults | |
| 1436 char_O_nullzeit = 240; | |
| 1437 int_O_ascenttime = 0; | |
| 1438 int_O_alternate_ascenttime = 0; | |
| 1439 int_O_gradient_factor = 0; | |
| 0 | 1440 } |
| 1441 | |
| 582 | 1442 |
| 0 | 1443 ////////////////////////////////////////////////////////////////////////////// |
| 1444 // calc_hauptroutine | |
| 1445 // | |
| 1446 // this is the major code in dive mode calculates: | |
| 582 | 1447 // the tissues, |
| 1448 // the bottom time, | |
| 1449 // and simulates the ascend with all deco stops. | |
| 0 | 1450 // |
| 1451 static void calc_hauptroutine(void) | |
| 1452 { | |
| 582 | 1453 overlay unsigned int int_ppO2_min; |
| 1454 overlay unsigned int int_ppO2_max; | |
| 1455 overlay unsigned int int_ppO2_max_dil; | |
| 560 | 1456 |
| 1457 //--- set-up part -------------------------------------------------------------------------------- | |
| 582 | 1458 |
| 560 | 1459 // twosectimer: |
| 1460 // calc_hauptroutine is now invoked every second to speed up the deco planning. | |
| 1461 // Because the tissue and CNS calculations are based on a 2 seconds period, the | |
| 1462 // the following toggle-timer will be used by the respective routines to skip | |
| 1463 // every 2nd invocation. | |
| 1464 twosectimer = (twosectimer) ? 0 : 1; // toggle the toggle-timer | |
| 582 | 1465 |
| 560 | 1466 |
| 1467 // set up normal tissue updating or "fast forward" updating for simulator sim+5' function | |
| 1468 // and deco calculator bottom time calculation | |
| 1469 if( char_I_sim_advance_time > 0 ) | |
| 1470 { | |
| 1471 // configure char_I_sim_advance_time minutes of tissue updating | |
| 1472 tissue_increment = char_I_sim_advance_time // given number of minutes, limited to 127 | |
| 582 | 1473 | TISSUE_FLAG; // set flag for updating the "real" tissues & CNS |
| 560 | 1474 |
| 1475 char_I_sim_advance_time = 0; // clear "mailbox" | |
| 1476 } | |
| 1477 else | |
| 1478 { | |
| 1479 // configure 2 seconds of tissue updating | |
| 1480 tissue_increment = 0 // encoding for 2 seconds update | |
| 582 | 1481 | TISSUE_FLAG; // set flag for updating the "real" tissues & CNS |
| 560 | 1482 } |
| 1483 | |
| 582 | 1484 |
| 560 | 1485 //---- calculate the real tissue's data ----------------------------------------------------------------- |
| 582 | 1486 |
| 1487 // acquire current environment data | |
| 1488 calc_hauptroutine_data_input(); | |
| 1489 | |
| 1490 // update tissue pressures, also sets char_ppO2 for calc_CNS_increment() | |
| 1491 calc_hauptroutine_update_tissues(); | |
| 1492 | |
| 1493 // calculate CNS value increment for the real tissues | |
| 1494 calc_CNS_increment(); | |
| 1495 | |
| 1496 // update the CNS value for the real tissues | |
| 1497 CNS_fraction += CNS_fraction_inc; | |
| 1498 | |
| 1499 // compute integer copy of CNS value for display purpose | |
| 1500 convert_CNS_for_display(); | |
| 560 | 1501 |
| 1502 | |
| 1503 //---- compute ppO2 warnings ------------------------------------------------------------------------------ | |
| 582 | 1504 |
| 560 | 1505 // compute conditional min/max values |
| 1506 int_ppO2_min = (char_O_main_status & DECO_MODE_LOOP) ? (unsigned int)char_I_ppO2_min_loop : (unsigned int)char_I_ppO2_min; | |
| 1507 int_ppO2_max = (char_O_deco_warnings & DECO_FLAG ) ? (unsigned int)char_I_ppO2_max_deco : (unsigned int)char_I_ppO2_max; | |
| 1508 | |
| 582 | 1509 // default value for the upper diluent ppO2 warning threshold is the normal upper warning threshold |
| 1510 int_ppO2_max_dil = int_ppO2_max; | |
| 1511 | |
| 1512 // when in CCR mode, the upper diluent warning threshold gets adjust according to the current setpoint | |
| 1513 if( (char_O_main_status & DECO_MODE_MASK) == DECO_MODE_CCR ) | |
| 1514 { | |
| 1515 overlay unsigned int max_dil; | |
| 1516 | |
| 1517 // The upper diluent ppO2 threshold is ppO2_GAP_TO_SETPOINT below the setpoint... | |
| 1518 // (the condition protects from negative numbers which would cause a wrap-around) | |
| 1519 max_dil = (char_I_const_ppO2 > ppO2_GAP_TO_SETPOINT) ? (unsigned int)(char_I_const_ppO2 - ppO2_GAP_TO_SETPOINT) : 0; | |
| 1520 | |
| 1521 // ...but never above int_ppO2_max. | |
| 1522 if( max_dil < int_ppO2_max ) int_ppO2_max_dil = max_dil; | |
| 1523 | |
| 1524 // We do not need to guard int_ppO2_max_dil against becoming lower than char_I_ppO2_min because the check | |
| 1525 // against char_I_ppO2_min is done first and will then raise a low warning and inhibit further checks. | |
| 1526 } | |
| 1527 | |
| 560 | 1528 // check for safe range of pure oxygen |
| 582 | 1529 if ( int_O_O2_ppO2 >= int_ppO2_max ) int_O_O2_ppO2 |= INT_FLAG_WARNING + INT_FLAG_HIGH; |
| 560 | 1530 |
| 1531 // check for safe range of breathed gas | |
| 582 | 1532 if ( int_O_breathed_ppO2 <= int_ppO2_min ) int_O_breathed_ppO2 |= INT_FLAG_WARNING + INT_FLAG_LOW; |
| 1533 else if ( int_O_breathed_ppO2 >= int_ppO2_max ) int_O_breathed_ppO2 |= INT_FLAG_WARNING + INT_FLAG_HIGH; | |
| 1534 else if ( char_O_main_status & DECO_MODE_LOOP ) ; // no attention generated in loop modes | |
| 1535 else if ( int_O_breathed_ppO2 >= ppO2_ATTENTION_THRESHOLD ) int_O_breathed_ppO2 |= INT_FLAG_ATTENTION; | |
| 1536 | |
| 560 | 1537 // check for safe range of pure diluent |
| 582 | 1538 if ( int_O_pure_ppO2 <= (unsigned int)char_I_ppO2_min ) int_O_pure_ppO2 |= INT_FLAG_WARNING + INT_FLAG_LOW; |
| 1539 else if ( int_O_pure_ppO2 >= int_ppO2_max ) int_O_pure_ppO2 |= INT_FLAG_WARNING + INT_FLAG_HIGH; | |
| 1540 else if ( int_O_pure_ppO2 >= int_ppO2_max_dil ) int_O_pure_ppO2 |= INT_FLAG_ATTENTION; | |
| 1541 | |
| 560 | 1542 // check for safe range of calculated pSCR loop gas |
| 582 | 1543 if ( int_O_pSCR_ppO2 <= int_ppO2_min ) int_O_pSCR_ppO2 |= INT_FLAG_WARNING + INT_FLAG_LOW; |
| 1544 else if ( int_O_pSCR_ppO2 >= int_ppO2_max ) int_O_pSCR_ppO2 |= INT_FLAG_WARNING + INT_FLAG_HIGH; | |
| 1545 | |
| 1546 | |
| 1547 | |
| 1548 //---- toggle between calculation for NDL (bottom time), ------ | |
| 1549 //---- deco stops and more deco stops (continue) ------ | |
| 1550 | |
| 1551 | |
| 1552 // done with the real tissues, all following operations | |
| 1553 // target the simulated tissues so clear flag in bit 7 | |
| 1554 tissue_increment = 0; | |
| 1555 | |
| 1556 // branch to the code for the current phase the deco calculations are in | |
| 560 | 1557 switch( char_O_deco_status & DECO_STATUS_MASK ) |
| 582 | 1558 { |
| 560 | 1559 overlay unsigned char i; |
| 1560 | |
| 582 | 1561 case DECO_STATUS_INIT: //---- At surface: Start a new dive --------------------- |
| 1562 | |
| 1563 // clear the internal stops table from remains lasting from the last dive | |
| 560 | 1564 clear_deco_table(); |
| 582 | 1565 |
| 1566 // publish the cleared stops table to the display functions | |
| 1567 publish_deco_table(); | |
| 1568 | |
| 1569 // clear the gas needs table | |
| 560 | 1570 for(i=0; i<NUM_GAS; ++i) |
| 1571 { | |
| 1572 int_O_gas_volumes[i] = 0; | |
| 582 | 1573 int_O_tank_pres_need[i] = 0 + INT_FLAG_ZERO; |
| 560 | 1574 } |
| 1575 | |
| 582 | 1576 // initialize the balancing between N2 and He for later no-fly time calculation |
| 560 | 1577 for(i=0; i<NUM_COMP; ++i) |
| 582 | 1578 { |
| 1579 split_N2_He[i] = 90; // assumes 90% of total tissue pressure will be needed for N2 | |
| 560 | 1580 } |
| 1581 | |
| 582 | 1582 // ** UNDER CONSTRUCTION - temporary code only ** |
| 1583 char_I_gas_change_time = 1; // TODO: validate proper operation before enabling this options-table parameter | |
| 1584 char_I_ascent_speed = 10; // TODO: validate proper operation before enabling this options-table parameter, | |
| 1585 // caution: values < 10 may have an impact on the deco calculation run-times! | |
| 1586 | |
| 1587 // initialize values that are constant during the course of the dive | |
| 1588 float_ascent_speed = 1.00 * char_I_ascent_speed; | |
| 1589 float_desaturation_multiplier = 0.01 * char_I_desaturation_multiplier; | |
| 1590 float_saturation_multiplier = 0.01 * char_I_saturation_multiplier; | |
| 1591 float_deco_distance = 0.01 * char_I_deco_distance; | |
| 1592 | |
| 1593 // initialize values that will be recalculated later on periodically | |
| 1594 char_O_nullzeit = 0; // reset NDL time for the normal plan | |
| 1595 char_O_alternate_nullzeit = 0; // reset NDL time for the alternative plan | |
| 1596 int_O_ascenttime = 0; // reset ascent time for the normal plan | |
| 1597 int_O_alternate_ascenttime = 0; // reset ascent time for the alternative plan | |
| 1598 char_O_deco_warnings = 0; // reset all deco warnings | |
| 1599 deco_tissue_vector = 0; // reset tissue deco vector | |
| 1600 IBCD_tissue_vector = 0; // reset tissue IBCD vector | |
| 1601 NDL_lead_tissue = 0; // reset first tissue to look at during NDL calculation | |
| 1602 | |
| 1603 // tag desaturation time as invalid (it will not be computed during a dive) | |
| 1604 int_O_desaturation_time = 65535; | |
| 1605 | |
| 1606 // initialize CNS values | |
| 1607 int_O_normal_CNS_fraction = int_O_alternate_CNS_fraction = int_O_CNS_fraction; | |
| 1608 | |
| 1609 // Values that should be reset just once for the full real dive. | |
| 1610 // This is used to record the lowest stop for the whole dive, | |
| 1611 // including ACCROSS all simulated ascents. | |
| 1612 low_depth_norm = low_depth_alt = 0.0; | |
| 1613 locked_GF_step_norm = locked_GF_step_alt = 0.0; | |
| 1614 | |
| 1615 // | |
| 1616 // --> code execution continues in state DECO_STATUS_START | |
| 1617 // | |
| 1618 | |
| 1619 case DECO_STATUS_START: //---- Bottom Time & initial Ascent -------------------- | |
| 1620 default: | |
| 560 | 1621 |
| 1622 // clear the internal(!) stops table | |
| 582 | 1623 clear_deco_table(); |
| 560 | 1624 |
| 1625 // initialize the simulated tissues with the current state of the real tissues | |
| 582 | 1626 for(i=0; i<NUM_COMP; i++) |
| 560 | 1627 { |
| 582 | 1628 sim_pres_tissue_N2[i] = pres_tissue_N2[i]; |
| 1629 sim_pres_tissue_He[i] = pres_tissue_He[i]; | |
| 1630 } | |
| 1631 | |
| 1632 // Lookup the current gas and store it also as the first gas used. | |
| 1633 // This gas will be used for the bottom segment of the dive and for | |
| 1634 // the period of delayed ascent when calculating fTTS or bailout. | |
| 1635 gas_find_current(); | |
| 1636 | |
| 1637 // setup the calculation ratio's for N2, He and O2 (sim_N2/He/O2_ratio) | |
| 1638 gas_set_ratios(); | |
| 1639 | |
| 1640 // initialize depth in absolute pressure, it is needed by | |
| 1641 // - calc_alveolar_pressures(), | |
| 1642 // - calc_ascent_to_first_stop(), and | |
| 1643 // - calc_hauptroutine_calc_deco() | |
| 1644 sim_pres_respiration = pres_respiration; | |
| 1645 | |
| 1646 // calculate ppN2 and ppHe from sim_N2/He_ratio (<- tissue_increment has been set to 0) | |
| 1647 calc_alveolar_pressures(); | |
| 1648 | |
| 1649 // calculate the effect of extended bottom time due to delayed ascent | |
| 1650 if( char_O_deco_status & DECO_ASCENT_DELAYED ) | |
| 1651 { | |
| 1652 // program interval on simulated tissues (flag bit 7 = 0) | |
| 1653 tissue_increment = char_I_extra_time; | |
| 1654 | |
| 1655 // update the tissues | |
| 1656 calc_tissues(); | |
| 1657 } | |
| 1658 | |
| 1659 // calculate if we are within no decompression limit (NDL) | |
| 1660 calc_NDL_time(); | |
| 1661 | |
| 1662 // Calculate the initial ascent if in deco. calc_NDL_time() is very fast | |
| 1663 // in detecting being beyond NDL, so there is enough time left in this | |
| 1664 // phase to do the initial ascent calculation. | |
| 1665 if( NDL_time == 0 ) | |
| 1666 { | |
| 1667 //--- in deco -------------------------------------------------------- | |
| 1668 | |
| 1669 // calculate ascent to first stop | |
| 1670 calc_ascent_to_first_stop(); | |
| 1671 | |
| 1672 // continue with calculating the stops | |
| 1673 char_O_deco_status &= ~DECO_STATUS_MASK; // clear status bits and set status bits for | |
| 1674 char_O_deco_status |= DECO_STATUS_STOPS; // calculation of stops on next invocation | |
| 560 | 1675 } |
| 1676 else | |
| 1677 { | |
| 582 | 1678 //--- within NDL ----------------------------------------------------- |
| 1679 | |
| 1680 // continue with gathering all results | |
| 1681 char_O_deco_status &= ~DECO_STATUS_MASK; | |
| 1682 char_O_deco_status |= DECO_STATUS_RESULTS; | |
| 1683 } | |
| 1684 | |
| 1685 break; | |
| 1686 | |
| 1687 | |
| 1688 case DECO_STATUS_STOPS: //---- Calculate Stops --------------------------------- | |
| 1689 | |
| 1690 // calculate the stops | |
| 1691 calc_hauptroutine_calc_deco(); | |
| 1692 | |
| 1693 // calc_hauptroutine_calc_deco iterates in this phase as long as it is | |
| 1694 // calculating the stops. Once done, it will set the status to doing the | |
| 1695 // results gathering. | |
| 1696 | |
| 1697 break; | |
| 1698 | |
| 1699 | |
| 1700 case DECO_STATUS_RESULTS: //--- Gathering of all Results ----------------------- | |
| 1701 | |
| 1702 // if in normal plan, publish the stops table to the display functions | |
| 1703 if( !(char_O_deco_status & DECO_PLAN_ALTERNATE) ) publish_deco_table(); | |
| 1704 | |
| 1705 // The current depth is needed by calc_CNS_planning() and gas_volumes(). | |
| 1706 // As it may be needed in different code blocks below but we don't want | |
| 1707 // it to be in the code multiple times, it's done here on stockpile. | |
| 1708 bottom_depth = (unsigned char)((pres_respiration - pres_surface) * BAR_TO_METER); | |
| 1709 | |
| 1710 // Calculate the ascent time. | |
| 1711 // When within NDL, potential gas switches will be treated as done "on the fly". | |
| 1712 calc_ascenttime(); | |
| 1713 | |
| 1714 // results to publish depend whether within NDL or in deco | |
| 1715 if( NDL_time ) | |
| 1716 { | |
| 1717 //---- within NDL ---------------------------------------------- | |
| 1718 | |
| 1719 // Calculate the initial ascent (not yet done when within NDL) - | |
| 1720 // just to get potential gas switches into the stops table for use | |
| 1721 // by gas_volumes(). The stops table can be polluted by now because | |
| 1722 // the clean table has already been published to the display | |
| 1723 // functions before. | |
| 1724 calc_ascent_to_first_stop(); | |
| 1725 | |
| 1726 // check which plan we are on | |
| 1727 if( char_O_deco_status & DECO_PLAN_ALTERNATE ) | |
| 560 | 1728 { |
| 582 | 1729 //---- alternate dive plan --------------------------------- |
| 1730 | |
| 1731 // As we are in no stop, CNS at end of dive is more or less | |
| 1732 // the same CNS as we have right now. It's so simple that we | |
| 1733 // don't check if it requested to be computed or not... | |
| 1734 int_O_alternate_CNS_fraction = int_O_CNS_fraction; | |
| 1735 | |
| 1736 // output NDL time | |
| 1737 char_O_alternate_nullzeit = NDL_time; | |
| 1738 | |
| 1739 // clear ascent time | |
| 1740 int_O_alternate_ascenttime = 0; | |
| 560 | 1741 } |
| 1742 else | |
| 1743 { | |
| 582 | 1744 //---- normal dive plan ------------------------------------ |
| 1745 | |
| 1746 // As we are in no stop, CNS at end of dive is more or less | |
| 1747 // the same CNS as we have right now. It's so simple that we | |
| 1748 // don't check if it requested to be computed or not... | |
| 1749 int_O_normal_CNS_fraction = int_O_CNS_fraction; | |
| 1750 | |
| 1751 // output NDL time | |
| 1752 char_O_nullzeit = NDL_time; | |
| 1753 | |
| 1754 // clear ascent time | |
| 1755 int_O_ascenttime = 0; | |
| 560 | 1756 } |
| 582 | 1757 } // NDL |
| 1758 else | |
| 1759 { | |
| 1760 //---- in DECO ------------------------------------------------- | |
| 1761 | |
| 1762 // check which plan we are on | |
| 1763 if( char_O_deco_status & DECO_PLAN_ALTERNATE ) | |
| 560 | 1764 { |
| 1765 //---- alternative plan ---------------------------------------------------- | |
| 1766 | |
| 582 | 1767 // shall the CNS at the end of the dive be calculated? |
| 560 | 1768 if( char_O_deco_status & DECO_CNS_CALCULATE ) |
| 1769 { | |
| 582 | 1770 // calculate the CNS for the predicted ascent, result in sim_CNS_fraction |
| 1771 calc_CNS_planning(); | |
| 1772 | |
| 1773 // add current CNS value | |
| 1774 sim_CNS_fraction += CNS_fraction; | |
| 1775 | |
| 1776 // convert to integer value | |
| 1777 convert_sim_CNS_for_display(); | |
| 1778 | |
| 1779 // export result | |
| 1780 int_O_alternate_CNS_fraction = int_sim_CNS_fraction; | |
| 560 | 1781 } |
| 582 | 1782 |
| 1783 // clear NDL time | |
| 1784 char_O_alternate_nullzeit = 0; | |
| 1785 | |
| 1786 // output ascent time | |
| 1787 int_O_alternate_ascenttime = ascent_time; | |
| 1788 | |
| 1789 } // alternative plan | |
| 560 | 1790 else |
| 1791 { | |
| 1792 //---- normal plan --------------------------------------------------------- | |
| 1793 | |
| 582 | 1794 // shall the CNS at the end of the dive be calculated? |
| 560 | 1795 if( char_O_deco_status & DECO_CNS_CALCULATE ) |
| 1796 { | |
| 582 | 1797 // calculate the CNS for the predicted ascent, result in sim_CNS_fraction |
| 1798 calc_CNS_planning(); | |
| 1799 | |
| 1800 // add current CNS value | |
| 1801 sim_CNS_fraction += CNS_fraction; | |
| 1802 | |
| 1803 // convert to integer value | |
| 1804 convert_sim_CNS_for_display(); | |
| 1805 | |
| 1806 // export result | |
| 1807 int_O_normal_CNS_fraction = int_sim_CNS_fraction; | |
| 560 | 1808 } |
| 582 | 1809 |
| 1810 // clear NDL time | |
| 1811 char_O_nullzeit = 0; | |
| 1812 | |
| 1813 // output ascent time | |
| 1814 int_O_ascenttime = ascent_time; | |
| 1815 | |
| 1816 } // normal plan | |
| 1817 } // DECO | |
| 1818 | |
| 1819 // if requested, calculate the required gas volumes and tank pressures at the end of the dive | |
| 1820 if( char_O_deco_status & DECO_VOLUME_CALCULATE ) gas_volumes(); | |
| 1821 | |
| 1822 // signal that the computation cycle is finished | |
| 1823 char_O_deco_status &= ~DECO_STATUS_MASK; | |
| 1824 | |
| 1825 break; | |
| 1826 | |
| 1827 } // switch | |
| 0 | 1828 } |
| 1829 | |
| 1830 ////////////////////////////////////////////////////////////////////////////// | |
| 1831 // calc_hauptroutine_data_input | |
| 1832 // | |
| 582 | 1833 // Set all C-code dive parameters from their ASM-code values. |
| 0 | 1834 // Detect gas change condition. |
| 1835 // | |
| 1836 void calc_hauptroutine_data_input(void) | |
| 1837 { | |
| 582 | 1838 overlay float IG_ratio; |
| 1839 | |
| 560 | 1840 // get the current pressures |
| 582 | 1841 pres_surface = 0.001 * int_I_pres_surface; |
| 1842 pres_respiration = 0.001 * int_I_pres_respiration; | |
| 1843 | |
| 1844 // N2 tissue pressure at surface equilibrium, used for tissue graphics scaling | |
| 1845 N2_equilibrium = 0.7902 * (pres_surface - ppWater); | |
| 1846 | |
| 1847 // read the GF settings (they may have been switch between GF/aGF) | |
| 1848 GF_high = 0.01 * char_I_GF_High_percentage; | |
| 1849 GF_low = 0.01 * char_I_GF_Low_percentage; | |
| 1850 GF_delta = GF_high - GF_low; | |
| 560 | 1851 |
| 1852 // get the currently breathed gas mixture | |
| 582 | 1853 O2_ratio = 0.01 * char_I_O2_ratio; |
| 1854 He_ratio = 0.01 * char_I_He_ratio; | |
| 1855 | |
| 1856 // inert gas ratio (local helper variable) | |
| 1857 IG_ratio = 1.00 - O2_ratio; | |
| 1858 | |
| 1859 // N2 ratio | |
| 1860 N2_ratio = IG_ratio - He_ratio; | |
| 1861 | |
| 1862 // precomputed values for ppO2 drop in pSCR loop | |
| 1863 float_pSCR_factor = 0.01 * char_I_PSCR_drop * char_I_PSCR_lungratio; | |
| 1864 pSCR_drop = IG_ratio * float_pSCR_factor; | |
| 0 | 1865 } |
| 1866 | |
| 1867 ////////////////////////////////////////////////////////////////////////////// | |
| 1868 // | |
| 1869 // | |
| 1870 void calc_hauptroutine_update_tissues(void) | |
| 1871 { | |
| 582 | 1872 overlay float EAD, END; |
| 1873 | |
| 1874 //---- calculations part ---------------------------------------------------------------------- | |
| 1875 | |
| 1876 // calculate ppN2 and ppHe | |
| 1877 calc_alveolar_pressures(); | |
| 1878 | |
| 1879 // calculate the tissues | |
| 1880 calc_tissues(); | |
| 1881 | |
| 1882 // calculate ceiling (at GF_high) and current GF | |
| 1883 calc_limit(GF_high); | |
| 1884 | |
| 1885 // calculate EAD (Equivalent Air Depth): equivalent depth for the same N2 level with plain air | |
| 1886 EAD = (ppN2 / 0.7902 + ppWater - pres_surface) * BAR_TO_METER; | |
| 1887 | |
| 1888 // calculate END (Equivalent Narcotic Depth): here O2 is treated as narcotic, too | |
| 1889 // Source cited: The Physiology and Medicine of Diving by Peter Bennett and David Elliott, | |
| 1890 // 4th edition, 1993, W.B.Saunders Company Ltd, London. | |
| 1891 END = (pres_respiration - ppHe - pres_surface) * BAR_TO_METER; | |
| 1892 | |
| 1893 | |
| 1894 //---- export ppO2 values in [cbar] for warning generation and display purpose ---------------- | |
| 560 | 1895 |
| 1896 // pure oxygen ppO2 | |
| 1897 if ( O2_ppO2 < 0.01 ) int_O_O2_ppO2 = 0; | |
| 1898 else if ( O2_ppO2 >= 9.995 ) int_O_O2_ppO2 = 999; | |
| 582 | 1899 else int_O_O2_ppO2 = (unsigned int)(100 * O2_ppO2 + 0.5); |
| 560 | 1900 |
| 1901 // pure gas ppO2 | |
| 582 | 1902 if ( OC_ppO2 < 0.01 ) int_O_pure_ppO2 = 0; |
| 1903 else if ( OC_ppO2 >= 9.995 ) int_O_pure_ppO2 = 999; | |
| 1904 else int_O_pure_ppO2 = (unsigned int)(100 * OC_ppO2 + 0.5); | |
| 560 | 1905 |
| 1906 // calculated pSCR ppO2 | |
| 1907 if ( pSCR_ppO2 < 0.01 ) int_O_pSCR_ppO2 = 0; | |
| 1908 else if ( pSCR_ppO2 >= 9.995 ) int_O_pSCR_ppO2 = 999; | |
| 582 | 1909 else int_O_pSCR_ppO2 = (unsigned int)(100 * pSCR_ppO2 + 0.5); |
| 560 | 1910 |
| 1911 // breathed ppO2 | |
| 582 | 1912 if ( ppO2 < 0.01 ) int_O_breathed_ppO2 = 0; |
| 1913 else if ( ppO2 >= 9.995 ) int_O_breathed_ppO2 = 999; | |
| 1914 else int_O_breathed_ppO2 = (unsigned int)(100 * ppO2 + 0.5); | |
| 1915 | |
| 1916 | |
| 1917 //---- export EAD and END --------------------------------------------------------------------- | |
| 1918 | |
| 1919 // EAD | |
| 1920 if( (EAD < 0.0) || (EAD > 245.5) ) char_O_EAD = 0; | |
| 1921 else char_O_EAD = (unsigned char)(EAD + 0.5); | |
| 1922 | |
| 1923 // END | |
| 1924 if( (END < 0.0) || (END > 245.5) ) char_O_END = 0; | |
| 1925 else char_O_END = (unsigned char)(END + 0.5); | |
| 0 | 1926 } |
| 1927 | |
| 1928 | |
| 1929 ////////////////////////////////////////////////////////////////////////////// | |
| 1930 // Compute stops. | |
| 1931 // | |
| 1932 // Note: because this can be very long, break on 16 iterations, and set state | |
| 560 | 1933 // to DECO_STATUS_FINISHED when finished, or to DECO_STATUS_STOPS when |
| 1934 // needing to continue. | |
| 0 | 1935 // Note: because each iteration might be very long too (~ 66 ms in 1.84beta), |
| 560 | 1936 // break the loop when elapsed time exceeds 512 milliseconds. |
| 0 | 1937 // |
| 1938 void calc_hauptroutine_calc_deco(void) | |
| 1939 { | |
| 560 | 1940 overlay unsigned char loop; |
| 1941 | |
| 582 | 1942 |
| 560 | 1943 for(loop = 0; loop < 16; ++loop) |
| 1944 { | |
| 1945 // limit loops to 512ms, using timer 5 | |
| 1946 if( tmr5() & (512*32) ) break; | |
| 1947 | |
| 1948 // calc_nextdecodepth() | |
| 1949 // | |
| 582 | 1950 // INPUT sim_pres_respiration : current depth in absolute pressure |
| 1951 // OUTPUT sim_depth_limit : depth of next stop in meters | |
| 560 | 1952 // RETURN true if a stop is needed |
| 1953 // | |
| 1954 // The function manages gas changes by itself, including priming | |
| 1955 // the deco stop with the configured gas change time. | |
| 1956 // | |
| 1957 if( calc_nextdecodepth() ) | |
| 1958 { | |
| 582 | 1959 if( sim_depth_limit == 0 ) goto Surface; // this check should not bee needed as in |
| 560 | 1960 // this case the RETURN value will be false |
| 1961 | |
| 582 | 1962 //---- stop required at sim_depth_limit ------------------------------------- |
| 560 | 1963 |
| 1964 // convert stop depth in meters to absolute pressure | |
| 582 | 1965 sim_pres_respiration = sim_depth_limit * METER_TO_BAR + pres_surface; |
| 560 | 1966 |
| 1967 // add one minute to the current stop, or add a new stop, | |
| 1968 // or abort deco calculation if the deco table is full. | |
| 1969 if( !update_deco_table(1) ) goto Surface; | |
| 1970 } | |
| 1971 else | |
| 1972 { | |
| 1973 //---- no stop required -------------------------------------- | |
| 582 | 1974 |
| 560 | 1975 // ascend by float_ascent_speed for 1 minute |
| 582 | 1976 sim_pres_respiration -= float_ascent_speed * METER_TO_BAR; |
| 560 | 1977 |
| 1978 // finish deco calculation if surface is reached | |
| 582 | 1979 if( sim_pres_respiration <= pres_surface ) |
| 560 | 1980 { |
| 0 | 1981 Surface: |
| 582 | 1982 // continue with gathering all results in the next calculation phase |
| 560 | 1983 char_O_deco_status &= ~DECO_STATUS_MASK; |
| 582 | 1984 char_O_deco_status |= DECO_STATUS_RESULTS; |
| 1985 | |
| 560 | 1986 return; |
| 1987 } | |
| 1988 } | |
| 1989 | |
| 1990 | |
| 1991 //---- as one minute as passed now, update the tissues ---------------------- | |
| 1992 | |
| 1993 // program 1 minute interval on simulated tissues (Flagbit 7 = 0) | |
| 1994 tissue_increment = 1; | |
| 582 | 1995 |
| 560 | 1996 // compute current ppN2 and ppHe |
| 582 | 1997 calc_alveolar_pressures(); |
| 1998 | |
| 560 | 1999 // update the tissues |
| 582 | 2000 calc_tissues(); |
| 560 | 2001 } |
| 0 | 2002 } |
| 2003 | |
| 2004 | |
| 2005 ////////////////////////////////////////////////////////////////////////////// | |
| 582 | 2006 // Calculate ascent to first deco stop. |
| 0 | 2007 // |
| 2008 // | |
| 582 | 2009 // Modified: sim_pres_respiration : current depth in ascent and deco simulation, in bar absolute pressure |
| 0 | 2010 // |
| 582 | 2011 void calc_ascent_to_first_stop(void) |
| 0 | 2012 { |
| 560 | 2013 overlay unsigned char fast = 1; // 1 = 1 minute steps, 0 = 2 seconds steps |
| 2014 overlay unsigned char gaschange = 0; // 1 = do a gas change, 0 = no better gas available | |
| 582 | 2015 |
| 2016 | |
| 560 | 2017 //---- Loop until first deco stop or surface is reached ---------- |
| 2018 for(;;) | |
| 2019 { | |
| 2020 // depth in absolute pressure we came from | |
| 582 | 2021 overlay float old_deco = sim_pres_respiration; |
| 2022 | |
| 560 | 2023 // try ascending 1 full minute (fast) or 2 seconds (!fast) |
| 582 | 2024 if ( fast ) sim_pres_respiration -= float_ascent_speed * METER_TO_BAR; // 1 min at float_ascent_speed ( 5 .. 10 m/min) |
| 2025 else sim_pres_respiration -= (float_ascent_speed/30.0) * METER_TO_BAR; // 2 sec at float_ascent_speed (17 .. 33 cm/min) | |
| 560 | 2026 |
| 2027 // but don't go over surface | |
| 582 | 2028 if( sim_pres_respiration < pres_surface ) sim_pres_respiration = pres_surface; |
| 2029 | |
| 2030 // compute current ceiling of the simulated tissues | |
| 2031 if ( char_I_deco_model != 0 ) calc_limit(GF_low); | |
| 2032 else calc_limit(1.0); | |
| 560 | 2033 |
| 2034 // did we overshoot the first deco stop? | |
| 582 | 2035 if( sim_pres_respiration < (sim_ceiling + pres_surface) ) |
| 560 | 2036 { |
| 2037 // YES - back to last depth below first stop | |
| 582 | 2038 sim_pres_respiration = old_deco; |
| 560 | 2039 |
| 2040 // switch to 2 seconds ascent if not yet in, else done | |
| 2041 if( fast ) | |
| 2042 { | |
| 2043 fast = 0; // retry with 2 seconds ascent steps | |
| 2044 continue; | |
| 2045 } | |
| 2046 else | |
| 2047 { | |
| 2048 break; // done... | |
| 2049 } | |
| 2050 } | |
| 2051 | |
| 2052 // If code execution passes along here, we did not overshoot the first stop. | |
| 582 | 2053 |
| 560 | 2054 // did we reach the surface? if yes, done! |
| 582 | 2055 if( sim_pres_respiration == pres_surface ) break; |
| 560 | 2056 |
| 2057 // depth in meters where we are now (no round-up) | |
| 582 | 2058 sim_depth_limit = (unsigned char)((sim_pres_respiration - pres_surface) * BAR_TO_METER); |
| 2059 | |
| 560 | 2060 // Check if there is a better gas to switch to, but only in alternative plan mode |
| 2061 // or if override is set. If yes, introduce a stop for the gas change. | |
| 2062 if( ((char_O_deco_status & DECO_PLAN_ALTERNATE) || (char_O_main_status & DECO_GASCHANGE_OVRD)) | |
| 2063 && gas_find_better() ) | |
| 2064 { | |
| 2065 // depth in meters we came from | |
| 2066 overlay unsigned char old_depth_limit = (unsigned char)((old_deco - pres_surface) * BAR_TO_METER); | |
| 582 | 2067 |
| 2068 // adjust sim_depth_limit to the gas change depth, but not deeper than the depth we came from | |
| 2069 sim_depth_limit = (sim_gas_last_depth < old_depth_limit) ? sim_gas_last_depth : old_depth_limit; | |
| 2070 | |
| 560 | 2071 // create a stop for the gas change |
| 2072 update_deco_table(char_I_gas_change_time); | |
| 2073 | |
| 2074 // set the new calculation values for N2, He and O2 | |
| 582 | 2075 gas_set_ratios(); |
| 2076 | |
| 560 | 2077 // signal to create a stop for the gas change and update the tissues |
| 2078 gaschange = char_I_gas_change_time; | |
| 582 | 2079 |
| 560 | 2080 // Adjust the depth for the tissue update to the stop depth. In case of fast mode, this |
| 2081 // imposes that the ascent from the 'old_deco' depth to this stop took 1 minute although | |
| 2082 // we might have only ascended one or two meters... | |
| 582 | 2083 sim_pres_respiration = sim_depth_limit * METER_TO_BAR + pres_surface; |
| 2084 } | |
| 2085 | |
| 560 | 2086 // Did one minute pass by and/or do we have a gas change? |
| 2087 // Remark: The 2 seconds ascent iterations towards the first deco stop in !fast speed may take | |
| 2088 // up to 28 seconds in total - for this rough half of a minute no tissue updates will be computed. | |
| 2089 // Well, it could be done by setting tissue_increment = 0 in !fast condition and making calls to | |
| 582 | 2090 // calc_alveolar_pressures() and calc_tissues() - see code commented out below. |
| 560 | 2091 if( fast || gaschange ) |
| 2092 { | |
| 2093 // program interval on simulated tissues (flag bit 7 = 0) | |
| 2094 tissue_increment = fast + gaschange; | |
| 582 | 2095 |
| 560 | 2096 // clear gas change signal |
| 2097 gaschange = 0; | |
| 2098 // } | |
| 2099 // else | |
| 2100 // { | |
| 2101 // // program 2 seconds interval on simulated tissues (flag bit 7 = 0) | |
| 2102 // tissue_increment = 0; | |
| 2103 // } | |
| 2104 // { | |
| 582 | 2105 // compute ppN2/ppHe for current depth from sim_pres_respiration |
| 2106 calc_alveolar_pressures(); | |
| 560 | 2107 |
| 2108 // update the tissues | |
| 582 | 2109 calc_tissues(); |
| 560 | 2110 } |
| 2111 } | |
| 0 | 2112 } |
| 2113 | |
| 2114 | |
| 2115 ////////////////////////////////////////////////////////////////////////////// | |
| 582 | 2116 // calc_tissues |
| 0 | 2117 // |
| 582 | 2118 // INPUT: ppN2 : partial pressure of inspired N2 |
| 2119 // ppHe : partial pressure of inspired He | |
| 2120 // tissue_increment : integration time and tissue selector (real or simulated) | |
| 0 | 2121 // |
| 582 | 2122 // MODIFIED: pres_tissue_N2[] : tissue N2 pressures (in real tissues context) |
| 2123 // pres_tissue_He[] : tissue He pressures (in real tissues context) | |
| 2124 // sim_pres_tissue_N2[] : tissue N2 pressures (in simulated tissues context) | |
| 2125 // sim_pres_tissue_He[] : tissue He pressures (in simulated tissues context) | |
| 560 | 2126 // |
| 582 | 2127 // OUTPUT: char_O_tissue_N2_saturation[] : tissue N2 pressures scaled for display purpose (in real tissues context) |
| 2128 // char_O_tissue_He_saturation[] : tissue He pressures scaled for display purpose (in real tissues context) | |
| 2129 // | |
| 2130 static void calc_tissues() | |
| 0 | 2131 { |
| 560 | 2132 overlay float temp_tissue_N2; |
| 2133 overlay float temp_tissue_He; | |
| 2134 overlay unsigned char period; | |
| 2135 overlay unsigned char i; | |
| 582 | 2136 |
| 2137 | |
| 2138 assert( 0.00 <= ppN2 && ppN2 < 11.2 ); // 80% N2 at 130m | |
| 2139 assert( 0.00 <= ppHe && ppHe < 12.6 ); // 90% He at 130m | |
| 2140 | |
| 2141 | |
| 2142 for (ci=0;ci<NUM_COMP;ci++) // iterate through all compartments | |
| 2143 { | |
| 2144 i = tissue_increment & TIME_MASK; // extract number of minutes to do (if i > 0) | |
| 2145 // or if one 2 second period is to do (if i = 0) | |
| 2146 | |
| 2147 if( i == 0 ) // check if we shall do one 2-seconds period | |
| 560 | 2148 { |
| 582 | 2149 read_Buhlmann_times(0); // YES, program coefficients for a 2 seconds period |
| 2150 period = 1; // set period length (in cycles) | |
| 2151 i = 1; // and one cycle to do | |
| 560 | 2152 } |
| 582 | 2153 else if( i > 9 ) // check if we can start with 10 minutes periods |
| 560 | 2154 { |
| 582 | 2155 read_Buhlmann_times(2); // YES, program coefficients for 10 minutes periods |
| 2156 period = 10; // set period length (in cycles) to ten | |
| 560 | 2157 } |
| 582 | 2158 else // we shall do 1 to 9 minutes |
| 560 | 2159 { |
| 582 | 2160 read_Buhlmann_times(1); // program coefficients for 1 minute periods |
| 2161 period = 1; // set period length (in cycles) to one | |
| 560 | 2162 } |
| 2163 | |
| 2164 do | |
| 2165 { | |
| 2166 //---- N2 ------------------------------------------------------------------------------- | |
| 2167 | |
| 582 | 2168 temp_tissue = (tissue_increment & TISSUE_FLAG) ? pres_tissue_N2[ci] : sim_pres_tissue_N2[ci]; |
| 560 | 2169 |
| 2170 temp_tissue = (ppN2 - temp_tissue) * var_N2_e; | |
| 2171 | |
| 2172 temp_tissue_safety(); | |
| 2173 | |
| 582 | 2174 if( tissue_increment & TISSUE_FLAG ) |
| 560 | 2175 { |
| 2176 // The temp variable takes on purpose just the tissue increment from the last loop's iteration. | |
| 2177 temp_tissue_N2 = temp_tissue; | |
| 2178 | |
| 2179 // Update the real tissues if either we are on the 2 seconds interval, | |
| 2180 // or if we shall advance the tissues on a one or several minutes basis. | |
| 582 | 2181 if( twosectimer || (tissue_increment & TIME_MASK) ) pres_tissue_N2[ci] += temp_tissue; |
| 560 | 2182 } |
| 2183 else | |
| 2184 { | |
| 2185 // Updates of the sim-tissues always comes on a 1 minutes basis, | |
| 2186 // so we do not need to check of the 2 seconds interval. | |
| 2187 sim_pres_tissue_N2[ci] += temp_tissue; | |
| 2188 } | |
| 2189 | |
| 2190 | |
| 2191 //---- He ------------------------------------------------------------------------------- | |
| 582 | 2192 |
| 2193 temp_tissue = (tissue_increment & TISSUE_FLAG) ? pres_tissue_He[ci] : sim_pres_tissue_He[ci]; | |
| 560 | 2194 |
| 2195 temp_tissue = (ppHe - temp_tissue) * var_He_e; | |
| 2196 | |
| 2197 temp_tissue_safety(); | |
| 2198 | |
| 582 | 2199 if( tissue_increment & TISSUE_FLAG ) |
| 560 | 2200 { |
| 2201 // The temp variable takes on purpose just the tissue increment from the last loop's iteration. | |
| 2202 temp_tissue_He = temp_tissue; | |
| 2203 | |
| 2204 // Update the real tissues if either we are on the 2 seconds interval, | |
| 2205 // or if we shall advance the tissues on a one or several minutes basis. | |
| 582 | 2206 if( twosectimer || (tissue_increment & TIME_MASK) ) pres_tissue_He[ci] += temp_tissue; |
| 560 | 2207 } |
| 2208 else | |
| 2209 { | |
| 2210 // Updates of the sim-tissues always comes on a 1 minutes basis, | |
| 2211 // so we do not need to check of the 2 seconds interval. | |
| 2212 sim_pres_tissue_He[ci] += temp_tissue; | |
| 2213 } | |
| 2214 | |
| 2215 // decrement loop counter | |
| 2216 i -= period; | |
| 582 | 2217 |
| 560 | 2218 // check if we need to switch from 10 minute periods to 1 minute periods |
| 2219 if( (i > 0) && (period = 10) && (i < 10) ) | |
| 2220 { | |
| 582 | 2221 read_Buhlmann_times(1); // program coefficients for 1 minute periods |
| 560 | 2222 period = 1; // set period length (in cycles) to one |
| 2223 } | |
| 2224 } | |
| 2225 while( i ); | |
| 582 | 2226 |
| 2227 | |
| 560 | 2228 // have the computations been done for the "real" tissues? |
| 582 | 2229 if( (tissue_increment & TISSUE_FLAG) && (twosectimer || (tissue_increment & TIME_MASK)) ) |
| 560 | 2230 { |
| 2231 // net tissue balance | |
| 2232 temp_tissue = temp_tissue_N2 + temp_tissue_He; | |
| 582 | 2233 |
| 560 | 2234 // check tissue on-/off-gassing and IBCD with applying a threshold of +/-HYST |
| 2235 // | |
| 582 | 2236 if ( temp_tissue < -HYST ) // Check if the tissue is off-gassing |
| 560 | 2237 { |
| 582 | 2238 deco_tissue_vector |= (1 << ci); // tag tissue as being in decompression |
| 2239 IBCD_tissue_vector &= ~(1 << ci); // tag tissue as not experiencing mentionable IBCD | |
| 560 | 2240 } |
| 2241 else if ( temp_tissue > +HYST ) // check if the tissue in on-gassing | |
| 2242 { | |
| 582 | 2243 deco_tissue_vector &= ~(1 << ci); // tag tissue as not being in decompression |
| 2244 | |
| 560 | 2245 if( ((temp_tissue_N2 > 0.0) && (temp_tissue_He < 0.0)) // check for counter diffusion |
| 2246 || ((temp_tissue_N2 < 0.0) && (temp_tissue_He > 0.0)) ) | |
| 2247 { | |
| 2248 IBCD_tissue_vector |= (1 << ci); // tag tissue as experiencing mentionable IBCD | |
| 2249 } | |
| 2250 } | |
| 2251 | |
| 582 | 2252 |
| 560 | 2253 // keep the saturating / desaturating flags from last invocation |
| 2254 char_O_tissue_N2_saturation[ci] &= 128; | |
| 2255 char_O_tissue_He_saturation[ci] &= 128; | |
| 582 | 2256 |
| 560 | 2257 // flip the flags applying a hysteresis of HYST (actual value: see #define of HYST) |
| 2258 if( temp_tissue_N2 > +HYST ) char_O_tissue_N2_saturation[ci] = 128; // set flag for tissue pressure is increasing | |
| 2259 else if( temp_tissue_N2 < -HYST ) char_O_tissue_N2_saturation[ci] = 0; // clear flag (-> tissue pressure is decreasing) | |
| 2260 | |
| 2261 if( temp_tissue_He > +HYST ) char_O_tissue_He_saturation[ci] = 128; // set flag for tissue pressure is increasing | |
| 2262 else if( temp_tissue_He < -HYST ) char_O_tissue_He_saturation[ci] = 0; // clear flag (-> tissue pressure is decreasing) | |
| 582 | 2263 |
| 2264 | |
| 560 | 2265 // For N2 tissue display purpose: |
| 2266 // Scale tissue press so that saturation in 70m on AIR gives a value of approx. 80. | |
| 2267 // The surface steady-state tissue loading of [0.7902 * (pres_respiration - ppWater)] bar | |
| 2268 // gives then a 10. If N2 is completely washed out of the tissue, result will be 0. | |
| 2269 // This scaling is adapted to the capabilities of the tissue graphics in the custom views. | |
| 2270 temp_tissue = (pres_tissue_N2[ci] / N2_equilibrium) * 10; | |
| 2271 | |
| 582 | 2272 // limit to 127 to leave space for sat/desat flag |
| 560 | 2273 if (temp_tissue > 127) temp_tissue = 127; |
| 2274 | |
| 2275 // export as integer | |
| 2276 char_O_tissue_N2_saturation[ci] += (unsigned char)temp_tissue; | |
| 2277 | |
| 582 | 2278 |
| 560 | 2279 // For H2 tissue display purpose: |
| 2280 // Scale tissue press so that saturation in 120m on TMX 10/70 gives a value of approx. 70. | |
| 2281 // With no He in a tissue, result will be 0. | |
| 2282 // This scaling is adapted to the capabilities of the tissue graphics in the custom views. | |
| 2283 temp_tissue = pres_tissue_He[ci] * 7.7; | |
| 2284 | |
| 2285 // limit to 127 to leave space for sat/desat flag | |
| 2286 if (temp_tissue > 127) temp_tissue = 127; | |
| 582 | 2287 |
| 560 | 2288 // export as integer |
| 2289 char_O_tissue_He_saturation[ci] += (unsigned char)temp_tissue; | |
| 582 | 2290 } //if |
| 2291 | |
| 2292 } // for | |
| 2293 | |
| 2294 | |
| 2295 // set deco flag if we are in deco and at least one of the real tissues is off-gassing | |
| 2296 // clear deco flag if all of the real tissues are on-gassing | |
| 2297 if ( (char_O_nullzeit == 0) && deco_tissue_vector ) char_O_deco_warnings |= DECO_FLAG; | |
| 2298 else if ( !deco_tissue_vector ) char_O_deco_warnings &= ~DECO_FLAG; | |
| 0 | 2299 } |
| 2300 | |
| 2301 ////////////////////////////////////////////////////////////////////////////// | |
| 2302 // calc_limit | |
| 2303 // | |
| 582 | 2304 // Input: |
| 2305 // tissue_increment : selector for context: real or simulated tissues | |
| 2306 // sim_pres_tissue_N2/_He : tissue pressures (used in simulated tissues context) | |
| 2307 // pres_tissue_N2/_He : tissue pressures (used in real tissues context) | |
| 0 | 2308 // |
| 582 | 2309 // Output: |
| 2310 // sim_ceiling : ceiling in bar relative pressure (only in simulated tissues context) | |
| 2311 // ceiling : ceiling in bar relative pressure (only in real tissues context) | |
| 2312 // int_O_ceiling : ceiling in mbar relative pressure (only in real tissues context) | |
| 2313 // int_O_gradient_factor : gradient factor in % (only in real tissues context) | |
| 2314 // | |
| 2315 // Modified: | |
| 2316 // char_O_deco_warnings : for IBCD, microbubbles and outside warning (only in real tissues context) | |
| 2317 // | |
| 2318 static void calc_limit(PARAMETER float GF_parameter) | |
| 0 | 2319 { |
| 582 | 2320 overlay float lead_tissue_limit = 0.0; |
| 2321 overlay float lead_supersat = 0.0; | |
| 2322 | |
| 2323 overlay unsigned char lead_tissue_no = 0; | |
| 2324 | |
| 2325 | |
| 2326 // check context | |
| 2327 if( tissue_increment & TISSUE_FLAG ) | |
| 2328 { | |
| 2329 // clear IBCD, microbubbles and outside warning flags (locked warnings will be preserved) | |
| 2330 char_O_deco_warnings &= ~(DECO_WARNING_IBCD + DECO_WARNING_MBUBBLES + DECO_WARNING_OUTSIDE); | |
| 2331 } | |
| 2332 | |
| 2333 | |
| 2334 // loop over all tissues | |
| 2335 for(ci=0; ci<NUM_COMP; ci++) | |
| 2336 { | |
| 2337 overlay float calc_pres_tissue_N2; | |
| 2338 overlay float calc_pres_tissue_He; | |
| 2339 overlay float pres_tissue; | |
| 560 | 2340 overlay float pres_min; |
| 582 | 2341 |
| 2342 // get the tissue pressures | |
| 2343 if( tissue_increment & TISSUE_FLAG ) | |
| 560 | 2344 { |
| 582 | 2345 // context is real tissues |
| 2346 calc_pres_tissue_N2 = pres_tissue_N2[ci]; | |
| 2347 calc_pres_tissue_He = pres_tissue_He[ci]; | |
| 560 | 2348 } |
| 2349 else | |
| 2350 { | |
| 582 | 2351 // context is simulated tissues |
| 2352 calc_pres_tissue_N2 = sim_pres_tissue_N2[ci]; | |
| 2353 calc_pres_tissue_He = sim_pres_tissue_He[ci]; | |
| 2354 } | |
| 2355 | |
| 2356 // overall tissue pressure | |
| 2357 pres_tissue = calc_pres_tissue_N2 + calc_pres_tissue_He; | |
| 2358 | |
| 2359 // get the coefficients for tissue ci | |
| 2360 read_Buhlmann_coefficients(); | |
| 2361 | |
| 2362 // adapt the coefficients according to the N2/He ratio in the tissue | |
| 2363 var_N2_a = (var_N2_a * calc_pres_tissue_N2 + var_He_a * calc_pres_tissue_He) / pres_tissue; | |
| 2364 var_N2_b = (var_N2_b * calc_pres_tissue_N2 + var_He_b * calc_pres_tissue_He) / pres_tissue; | |
| 2365 | |
| 2366 // calculate minimum ambient pressure that the tissue can withstand according to straight Buhlmann | |
| 2367 pres_min = (pres_tissue - var_N2_a) * var_N2_b; | |
| 2368 | |
| 2369 // next calculations are only relevant when invoked on the real tissues | |
| 2370 if( tissue_increment & TISSUE_FLAG ) | |
| 2371 { | |
| 2372 overlay float supersat; | |
| 2373 overlay float threshold; | |
| 560 | 2374 |
| 582 | 2375 // calculate current supersaturation value (1.0 = 100%) of this tissue |
| 2376 supersat = (pres_tissue - pres_respiration) / (pres_tissue - pres_min); | |
| 2377 | |
| 2378 // check if tissue is in supersaturation | |
| 2379 if( supersat > 0.0 ) | |
| 2380 { | |
| 2381 // memorize highest supersaturation found | |
| 2382 if( supersat > lead_supersat ) lead_supersat = supersat; | |
| 2383 | |
| 2384 // set a threshold value for the microbubbles and outside warnings | |
| 2385 // ToDo: finalize the definition of the threshold | |
| 2386 threshold = 0.02 * ci + 0.9; | |
| 2387 | |
| 2388 // check if this tissue is likely to develop microbubbles | |
| 2389 // and/or if this tissue is outside of the Buhlmann model | |
| 2390 if( ci <= 5 ) | |
| 560 | 2391 { |
| 582 | 2392 if( supersat >= threshold ) |
| 2393 { | |
| 2394 char_O_deco_warnings |= (DECO_WARNING_MBUBBLES + DECO_WARNING_MBUBBLES_lock); | |
| 2395 | |
| 2396 if( supersat >= 1.0 ) | |
| 2397 { | |
| 2398 char_O_deco_warnings |= (DECO_WARNING_OUTSIDE + DECO_WARNING_OUTSIDE_lock); | |
| 2399 } | |
| 2400 } | |
| 2401 } | |
| 2402 else // ci > 5 | |
| 2403 { | |
| 2404 if( supersat >= 1.0 ) | |
| 2405 { | |
| 2406 char_O_deco_warnings |= (DECO_WARNING_MBUBBLES + DECO_WARNING_MBUBBLES_lock); | |
| 2407 | |
| 2408 if( supersat >= threshold ) | |
| 2409 { | |
| 2410 char_O_deco_warnings |= (DECO_WARNING_OUTSIDE + DECO_WARNING_OUTSIDE_lock); | |
| 2411 } | |
| 2412 } | |
| 560 | 2413 } |
| 2414 } | |
| 2415 } | |
| 582 | 2416 |
| 2417 // Apply the Eric Baker's varying gradient factor correction if the GF-Model is selected. | |
| 2418 // Note: the correction factor depends both on GF and b, so that can change who is the | |
| 2419 // leading gas... | |
| 2420 if( char_I_deco_model != 0 ) pres_min = ( pres_tissue - (var_N2_a * GF_parameter) ) | |
| 2421 / ( 1.0 - GF_parameter + (GF_parameter / var_N2_b ) ); | |
| 560 | 2422 |
| 2423 // check if this tissue requires a higher ambient pressure than was found to be needed up to now | |
| 582 | 2424 if( pres_min > lead_tissue_limit ) |
| 2425 { | |
| 2426 lead_tissue_limit = pres_min; | |
| 2427 lead_tissue_no = ci; | |
| 2428 } | |
| 2429 } // for | |
| 2430 | |
| 2431 | |
| 2432 // compile outputs | |
| 2433 if( tissue_increment & TISSUE_FLAG ) | |
| 560 | 2434 { |
| 582 | 2435 //--- real tissues ----------------------------------------------------- |
| 2436 | |
| 2437 // check if leading tissue is in IBCD condition | |
| 2438 if( (IBCD_tissue_vector & (1 << lead_tissue_no)) | |
| 2439 && ((pres_tissue_N2[lead_tissue_no] + pres_tissue_He[lead_tissue_no]) > pres_respiration) ) | |
| 2440 { | |
| 2441 // leading tissue is in IBCD condition and in super-saturation, so issue a warning. | |
| 2442 char_O_deco_warnings |= (DECO_WARNING_IBCD + DECO_WARNING_IBCD_lock); | |
| 2443 } | |
| 2444 | |
| 2445 | |
| 2446 // compute ceiling in bar relative pressure | |
| 2447 ceiling = lead_tissue_limit - pres_surface; | |
| 2448 | |
| 2449 // convert ceiling to int_O_ceiling in mbar | |
| 2450 if ( ceiling <= 0 ) int_O_ceiling = 0; | |
| 2451 else if ( ceiling > 16 ) int_O_ceiling = 16000; | |
| 2452 // Compatibility version | |
| 2453 else int_O_ceiling = (short)(ceiling * 1000); | |
| 2454 | |
| 2455 // New version: Rounds up to next 10 cm so that the ceiling disappears on the display only when the | |
| 2456 // ceiling limit is really zero. This will coincident then with TTS switching back to NDL time. | |
| 2457 // else int_O_ceiling = (short)(ceiling * 1000 + 9); | |
| 2458 | |
| 2459 | |
| 2460 // convert highest supersaturation found to int_O_gradient_factor in % (1.0 = 100%) | |
| 2461 // limit to 255 because of constraints in ghostwriter code | |
| 2462 if ( lead_supersat <= 0.0 ) int_O_gradient_factor = 0; | |
| 2463 else if( lead_supersat > 2.545 ) int_O_gradient_factor = 255 + INT_FLAG_WARNING; | |
| 2464 else | |
| 2465 { | |
| 2466 int_O_gradient_factor = (unsigned int)(100 * lead_supersat + 0.5); | |
| 2467 | |
| 2468 if ( int_O_gradient_factor >= GF_WARNING_THRESHOLD ) | |
| 2469 int_O_gradient_factor |= INT_FLAG_WARNING; | |
| 2470 | |
| 2471 else if ( int_O_gradient_factor >= char_I_GF_High_percentage ) | |
| 2472 int_O_gradient_factor |= INT_FLAG_ATTENTION; | |
| 2473 } | |
| 560 | 2474 } |
| 582 | 2475 else |
| 560 | 2476 { |
| 582 | 2477 //--- simulated tissues ------------------------------------------------ |
| 2478 | |
| 2479 // compute ceiling for the simulated tissues in bar relative pressure | |
| 2480 sim_ceiling = lead_tissue_limit - pres_surface; | |
| 560 | 2481 } |
| 0 | 2482 } |
| 2483 | |
| 2484 ////////////////////////////////////////////////////////////////////////////// | |
| 582 | 2485 // calc_NDL_time |
| 0 | 2486 // |
| 2487 // calculates the remaining bottom time | |
| 2488 // | |
| 2489 // NOTE: Erik Baker's closed formula works for Nitroxes. Trimix adds a second | |
| 2490 // exponential term to the M-value equation, making it impossible to | |
| 2491 // invert... So we have to make a fast-simu until we find a better way. | |
| 2492 // | |
| 582 | 2493 // Input: ppN2 |
| 2494 // ppHe | |
| 0 | 2495 // |
| 582 | 2496 // Output: NDL_time |
| 2497 // | |
| 2498 static void calc_NDL_time(void) | |
| 0 | 2499 { |
| 582 | 2500 overlay unsigned char new_NDL_lead_tissue = 0; |
| 2501 overlay unsigned char i; | |
| 2502 | |
| 2503 | |
| 2504 // initialize NDL_time to 240 minutes | |
| 2505 NDL_time = 240; | |
| 2506 | |
| 2507 for(i=0; i<NUM_COMP; i++) | |
| 2508 { | |
| 2509 overlay float calc_pres_tissue_N2; | |
| 2510 overlay float calc_pres_tissue_He; | |
| 2511 overlay float pres_tissue; | |
| 2512 | |
| 2513 overlay unsigned char NDL_tissue; | |
| 2514 overlay unsigned char period = 10; // start with 10 minute periods | |
| 2515 | |
| 2516 | |
| 2517 // check lead tissue from last NDL computation first | |
| 2518 ci = i + NDL_lead_tissue; | |
| 2519 | |
| 2520 // wrap around after the 16th tissue | |
| 2521 if( ci >= NUM_COMP ) ci -= NUM_COMP; | |
| 2522 | |
| 2523 // read Buhlmann a and b coefficients for tissue ci | |
| 2524 read_Buhlmann_coefficients(); | |
| 2525 | |
| 2526 // read the loading factors for 10 minute periods | |
| 2527 read_Buhlmann_times(2); | |
| 560 | 2528 |
| 582 | 2529 // get the tissue pressures for N2 and He |
| 2530 calc_pres_tissue_N2 = sim_pres_tissue_N2[ci]; | |
| 2531 calc_pres_tissue_He = sim_pres_tissue_He[ci]; | |
| 2532 | |
| 2533 // calculate the total pressure tissue | |
| 2534 pres_tissue = calc_pres_tissue_N2 + calc_pres_tissue_He; | |
| 2535 | |
| 2536 | |
| 2537 // simulate an increasing bottom time and check when we hit the NDL ------------------------ | |
| 2538 for( NDL_tissue = 0; NDL_tissue < NDL_time; ) // not needed to simulate for longer than the already found NDL | |
| 2539 { | |
| 2540 overlay float var_a; | |
| 2541 overlay float var_b; | |
| 2542 overlay float pres_limit; | |
| 2543 overlay float delta_pres_tissue_N2; | |
| 2544 overlay float delta_pres_tissue_He; | |
| 2545 | |
| 2546 | |
| 2547 // adopt a and b coefficients to current N2/He ratio inside the tissue | |
| 2548 var_a = (var_N2_a * calc_pres_tissue_N2 + var_He_a * calc_pres_tissue_He) / pres_tissue; | |
| 2549 var_b = (var_N2_b * calc_pres_tissue_N2 + var_He_b * calc_pres_tissue_He) / pres_tissue; | |
| 2550 | |
| 2551 // compute pressure limit for tissues under surface pressure conditions | |
| 2552 pres_limit = (var_a + pres_surface / var_b); | |
| 2553 | |
| 2554 // adopt pressure limit when using the GF extension | |
| 2555 if (char_I_deco_model != 0 ) pres_limit = GF_high * (pres_limit - pres_surface) + pres_surface; | |
| 2556 | |
| 2557 //---- Check if this tissue is already beyond the NDL | |
| 2558 if( pres_tissue > pres_limit) | |
| 2559 { | |
| 2560 // NO - finish the outer loop, | |
| 2561 i = NUM_COMP; | |
| 2562 | |
| 2563 // and finish the inner loop | |
| 2564 break; | |
| 2565 } | |
| 2566 | |
| 2567 // compute delta to tissue pressures in 10 or 1 minutes of time ahead | |
| 2568 delta_pres_tissue_N2 = (ppN2 - calc_pres_tissue_N2) * var_N2_e; | |
| 2569 delta_pres_tissue_He = (ppHe - calc_pres_tissue_He) * var_He_e; | |
| 2570 | |
| 2571 // apply safety factors to the pressure deltas | |
| 2572 // NDL can be computed while ascending, so we have to check if we are saturating or desaturating | |
| 2573 if( delta_pres_tissue_N2 > 0.0 ) delta_pres_tissue_N2 *= float_saturation_multiplier; | |
| 2574 else delta_pres_tissue_N2 *= float_desaturation_multiplier; | |
| 2575 | |
| 2576 if( delta_pres_tissue_He > 0.0 ) delta_pres_tissue_He *= float_saturation_multiplier; | |
| 2577 else delta_pres_tissue_He *= float_saturation_multiplier; | |
| 2578 | |
| 2579 // Simulate off-gassing while going to surface | |
| 2580 // TODO ! | |
| 2581 // delta_pres_tissue_N2 -= exp( ... ascent time ... ppN2...) | |
| 2582 // delta_pres_tissue_He -= exp( ... ascent time ... ppHe...) | |
| 2583 | |
| 2584 // within NDL now, but still within in 10 or 1 minutes from now? | |
| 2585 if( pres_tissue + delta_pres_tissue_N2 + delta_pres_tissue_He <= pres_limit ) | |
| 2586 { | |
| 2587 // YES - apply the pressure deltas to tissues | |
| 2588 calc_pres_tissue_N2 += delta_pres_tissue_N2; | |
| 2589 calc_pres_tissue_He += delta_pres_tissue_He; | |
| 560 | 2590 |
| 582 | 2591 // update the overall tissue pressure |
| 2592 pres_tissue = calc_pres_tissue_N2 + calc_pres_tissue_He; | |
| 2593 | |
| 2594 // increment the NDL | |
| 2595 NDL_tissue += period; | |
| 2596 | |
| 2597 // do next loop | |
| 2598 continue; | |
| 2599 } | |
| 2600 | |
| 2601 // NO - if delta pressures were for 10 minutes of time ahead, try with 1 minute ahead | |
| 2602 if( period == 10 ) | |
| 2603 { | |
| 2604 // reduce period to 1 minute | |
| 2605 period = 1; | |
| 2606 | |
| 2607 // read the loading factors for 1 minute periods | |
| 2608 read_Buhlmann_times(1); | |
| 2609 | |
| 2610 // do next loop | |
| 2611 continue; | |
| 2612 } | |
| 2613 | |
| 2614 // NO - not even within NDL in just one more minute, so make a linear approx for the last minute | |
| 2615 // (make a meaningful rounding of NDL, but ONLY if positive: negative casted to unsigned is bad) | |
| 2616 if( pres_limit > pres_tissue ) | |
| 2617 NDL_tissue += (unsigned char)(0.5 + (pres_limit - pres_tissue ) | |
| 2618 / (delta_pres_tissue_N2 + delta_pres_tissue_He) ); | |
| 2619 | |
| 2620 // finish the inner loop | |
| 2621 break; | |
| 2622 } | |
| 2623 | |
| 2624 // is the current NDL short than the shortest so far? | |
| 2625 if ( NDL_tissue < NDL_time ) | |
| 2626 { | |
| 2627 // keep the current's tissue NDL as the new shortest NDL | |
| 2628 NDL_time = NDL_tissue; | |
| 2629 | |
| 2630 // store the causing tissue | |
| 2631 new_NDL_lead_tissue = ci; | |
| 2632 } | |
| 2633 | |
| 2634 // if NDL is > 0 the outer loop will continues with the next tissue | |
| 2635 // if NDL found to be overrun, outer loop will be terminated through i = NUM_COMP statement | |
| 2636 } | |
| 2637 | |
| 2638 // store the NDL dominating tissue for to start with in the next NDL calculation | |
| 2639 NDL_lead_tissue = new_NDL_lead_tissue; | |
| 0 | 2640 } |
| 2641 | |
| 2642 ////////////////////////////////////////////////////////////////////////////// | |
| 2643 // calc_ascenttime | |
| 2644 // | |
| 560 | 2645 // Sum up ascent from bottom to surface at float_ascent_speed, |
| 2646 // but 1 minute per meter for the final ascent, and all stops. | |
| 0 | 2647 // |
| 582 | 2648 // Input: char_I_depth_last_deco |
| 2649 // pres_respiration | |
| 2650 // pres_surface | |
| 2651 // float_ascent_speed | |
| 2652 // internal_deco_depth[] | |
| 2653 // | |
| 2654 // Output: ascent_time | |
| 560 | 2655 // |
| 0 | 2656 static void calc_ascenttime(void) |
| 2657 { | |
| 582 | 2658 overlay unsigned char x; |
| 2659 | |
| 2660 | |
| 560 | 2661 // preset final ascent |
| 2662 overlay float final = (float)char_I_depth_last_deco; | |
| 2663 | |
| 582 | 2664 // calculate depth |
| 2665 overlay float ascent = (pres_respiration - pres_surface) * BAR_TO_METER; | |
| 2666 | |
| 560 | 2667 // check if we are already in final ascent |
| 582 | 2668 if (ascent <= final) |
| 560 | 2669 { |
| 2670 // yes - all ascent is final ascent | |
| 2671 final = ascent; | |
| 2672 ascent = 0.0; | |
| 2673 } | |
| 2674 else | |
| 2675 { | |
| 2676 // no - subtract final ascent part from overall ascent | |
| 2677 ascent -= final; | |
| 582 | 2678 |
| 560 | 2679 // compute time for ascent part without final ascent |
| 582 | 2680 ascent /= float_ascent_speed; |
| 560 | 2681 } |
| 582 | 2682 |
| 2683 // add 1 minute for each meter of final ascent | |
| 560 | 2684 ascent += final; |
| 582 | 2685 |
| 560 | 2686 // convert to integer |
| 582 | 2687 ascent_time = (unsigned short)(ascent + 0.5); |
| 560 | 2688 |
| 2689 // add all stop times | |
| 582 | 2690 for(x=0; x<NUM_STOPS && internal_deco_depth[x]; x++) |
| 2691 ascent_time += (unsigned short)internal_deco_time[x]; | |
| 0 | 2692 |
| 560 | 2693 // limit result to display max. |
| 582 | 2694 if( ascent_time > 999) ascent_time = 999; |
| 2695 | |
| 560 | 2696 // tag result as invalid if there is an overflow in the stops table |
| 582 | 2697 if( char_O_deco_warnings & DECO_WARNING_STOPTABLE_OVERFLOW ) ascent_time |= INT_FLAG_INVALID; |
| 0 | 2698 } |
| 2699 | |
| 2700 | |
| 2701 ////////////////////////////////////////////////////////////////////////////// | |
| 2702 // clear_deco_table | |
| 2703 // | |
| 2704 // | |
| 2705 static void clear_deco_table(void) | |
| 2706 { | |
| 582 | 2707 overlay unsigned char x; |
| 2708 | |
| 2709 for(x=0; x<NUM_STOPS; ++x) | |
| 2710 { | |
| 2711 internal_deco_time [x] = 0; | |
| 2712 internal_deco_depth[x] = 0; | |
| 2713 } | |
| 2714 | |
| 560 | 2715 // clear stop table overflow warning |
| 2716 char_O_deco_warnings &= ~DECO_WARNING_STOPTABLE_OVERFLOW; | |
| 0 | 2717 } |
| 2718 | |
| 2719 ////////////////////////////////////////////////////////////////////////////// | |
| 2720 // update_deco_table | |
| 2721 // | |
| 582 | 2722 // Add time to a stop at sim_depth_limit |
| 560 | 2723 // |
| 2724 // It is possible to create stops with a duration of 0 minutes, e.g. to | |
| 2725 // note a gas change "on the fly" while ascending. Therefore the criteria | |
| 2726 // to have reached the end of the list needs always to be depth == 0. | |
| 0 | 2727 // |
| 582 | 2728 // Input: sim_depth_limit : stop's depth, in meters. |
| 560 | 2729 // sim_gas_last_used : gas used at stop, as index 1..5 or 0 for gas 6 |
| 582 | 2730 // PARAMETER time_increment : number of minutes to add to the stop |
| 0 | 2731 // |
| 560 | 2732 // Updated: internal_deco_depth[] : depth (in meters) of each stop |
| 2733 // internal_deco_time [] : time (in minutes) of each stop | |
| 2734 // internal_deco_gas [] : gas used (index 1-5) at each stop | |
| 2735 // | |
| 2736 static unsigned char update_deco_table(PARAMETER unsigned char time_increment) | |
| 0 | 2737 { |
| 560 | 2738 overlay unsigned char x; |
| 2739 | |
| 582 | 2740 assert( sim_depth_limit > 0 ); // No stop at surface... |
| 560 | 2741 |
| 2742 // loop through internal deco table | |
| 2743 for(x=0; x<NUM_STOPS; ++x) | |
| 2744 { | |
| 2745 // Make sure deco-stops are recorded in order: | |
| 582 | 2746 assert( !internal_deco_depth[x] || sim_depth_limit <= internal_deco_depth[x] ); |
| 560 | 2747 |
| 2748 // Is there already a stop entry for our current depth? | |
| 582 | 2749 if( internal_deco_depth[x] == sim_depth_limit ) |
| 560 | 2750 { |
| 2751 // Yes - increment stop time if possible | |
| 2752 // Stop time entries are limited to 99 minutes because of display constraints. | |
| 2753 // Else a limit of 254 would account because of constrains in calc_CNS_planning(). | |
| 2754 if( internal_deco_time[x] < (100 - time_increment) ) | |
| 2755 { | |
| 2756 internal_deco_time[x] += time_increment; // increment stop time | |
| 2757 return 1; // return with status 'success' | |
| 2758 } | |
| 2759 } | |
| 2760 | |
| 2761 // If program flow passes here, there is either no stop entry for the current depth yet, or | |
| 2762 // the existing entry is saturated with 99 minutes. So we are looking for the next unused | |
| 2763 // table entry. | |
| 2764 if( internal_deco_depth[x] == 0 ) | |
| 2765 { | |
| 2766 internal_deco_time[x] = time_increment; // initialize entry with first stop's time, | |
| 582 | 2767 internal_deco_depth[x] = sim_depth_limit; // ... depth, and |
| 560 | 2768 internal_deco_gas[x] = sim_gas_last_used; // ... gas |
| 2769 return 1; // return with status 'success' | |
| 2770 } | |
| 2771 } | |
| 2772 | |
| 2773 // If program flow passes here, all deco table entries are used up. | |
| 582 | 2774 |
| 560 | 2775 // set overflow warning |
| 2776 char_O_deco_warnings |= DECO_WARNING_STOPTABLE_OVERFLOW; | |
| 582 | 2777 |
| 560 | 2778 // return with status 'failed'. |
| 2779 return 0; | |
| 0 | 2780 } |
| 2781 | |
| 2782 | |
| 2783 ////////////////////////////////////////////////////////////////////////////// | |
| 560 | 2784 // calc_desaturation_time |
| 0 | 2785 // |
| 2786 // Inputs: int_I_pres_surface, ppWater, char_I_desaturation_multiplier | |
| 560 | 2787 // Outputs: int_O_desaturation_time, int_O_nofly_time |
| 0 | 2788 // |
| 560 | 2789 // Helper function |
| 2790 // | |
| 2791 void calc_desaturation_time_helper(void) | |
| 0 | 2792 { |
| 582 | 2793 if( pres_actual > pres_target ) // check if actual pressure is higher then target pressure |
| 2794 { // YES - compute remaining time | |
| 560 | 2795 overlay float pres_ratio; |
| 582 | 2796 |
| 560 | 2797 pres_ratio = pres_actual / pres_target; |
| 2798 | |
| 2799 // Compute desaturation time with result rounded up to multiples of 10 minutes. | |
| 582 | 2800 // Main purpose is to avoid confusion, because the times do not clock down in |
| 2801 // one minute steps any more but get constantly re-computed according to current | |
| 2802 // ambient pressure and may therefor make steps of several minutes forwards and | |
| 2803 // backwards as ambient pressure rises and falls. | |
| 2804 int_time = (unsigned int)( (var_ht * log(pres_ratio) / desat_factor) + 0.9 ); | |
| 560 | 2805 } |
| 2806 else | |
| 582 | 2807 { // NO - desaturation state reached, no remaining time |
| 2808 int_time = 0; | |
| 560 | 2809 } |
| 2810 } | |
| 2811 | |
| 2812 ///////////////////////////////////////////////////////////////////////////// | |
| 2813 // Main function | |
| 2814 // | |
| 2815 void calc_desaturation_time(void) | |
| 2816 { | |
| 582 | 2817 assert( 800 < int_I_pres_surface && int_I_pres_surface < 1100 ); |
| 2818 assert( 0 < char_I_desaturation_multiplier && char_I_desaturation_multiplier <= 100 ); | |
| 2819 | |
| 2820 // fraction of inert gases in respired air | |
| 2821 N2_ratio = 0.7902; | |
| 2822 He_ratio = 0.0; | |
| 2823 | |
| 2824 // surface pressure in bar | |
| 2825 pres_surface = 0.001 * int_I_pres_surface; | |
| 2826 | |
| 2827 // partial pressure of N2 in respired air | |
| 2828 N2_equilibrium = N2_ratio * (pres_surface - ppWater); | |
| 2829 | |
| 2830 // pre-computed term for later use: 10 [Min] * 0.01 [%] * 0.6931 [=log(2)] * ... | |
| 2831 desat_factor = 0.06931 * char_I_desaturation_multiplier * SURFACE_DESAT_FACTOR; | |
| 2832 | |
| 2833 // initialize vars | |
| 560 | 2834 int_O_desaturation_time = 0; |
| 582 | 2835 int_O_nofly_time = 0; |
| 2836 | |
| 2837 | |
| 2838 for(ci=NUM_COMP; ci>0;) | |
| 2839 { | |
| 2840 overlay float pres_tissue_max; | |
| 2841 overlay float P_ambient_altitude; | |
| 2842 overlay signed char search_direction; | |
| 2843 overlay unsigned int nofly_N2 = 0; | |
| 2844 overlay unsigned int nofly_He = 0; | |
| 2845 overlay unsigned int nofly_last = ~0; | |
| 2846 | |
| 2847 | |
| 560 | 2848 ci -= 1; |
| 582 | 2849 |
| 2850 read_Buhlmann_ht(); | |
| 560 | 2851 read_Buhlmann_coefficients(); |
| 582 | 2852 |
| 560 | 2853 // get selected target altitude |
| 2854 switch( char_I_altitude_wait ) | |
| 2855 { | |
| 2856 case 1: P_ambient_altitude = P_ambient_1000m; break; | |
| 2857 case 2: P_ambient_altitude = P_ambient_2000m; break; | |
| 2858 case 3: P_ambient_altitude = P_ambient_3000m; break; | |
| 2859 default: P_ambient_altitude = P_ambient_fly; break; | |
| 2860 } | |
| 582 | 2861 |
| 560 | 2862 // Target pressure for the tissue is the Buhlmann limit. We use the Buhlmann |
| 2863 // coefficients for N2 also for He because it is easier to calculate and the | |
| 2864 // N2 coefficients are more conservative than those for He, so we are on the | |
| 2865 // safe side, too. | |
| 582 | 2866 pres_tissue_max = (P_ambient_altitude/var_N2_b + var_N2_a); |
| 2867 | |
| 560 | 2868 // Adjust target pressure in case the GF model is in use by GF-high |
| 2869 if( char_I_deco_model != 0 ) | |
| 582 | 2870 pres_tissue_max = P_ambient_altitude + |
| 2871 0.01 * char_I_GF_High_percentage * (pres_tissue_max - P_ambient_altitude); | |
| 2872 | |
| 560 | 2873 |
| 2874 // | |
| 2875 // Desaturation time | |
| 2876 // | |
| 2877 | |
| 2878 // N2: actual amount of tissue pressure above equilibrium. | |
| 2879 pres_actual = pres_tissue_N2[ci] - N2_equilibrium; | |
| 2880 | |
| 2881 // N2: half-time of the current tissue | |
| 582 | 2882 var_ht = var_N2_ht; |
| 560 | 2883 |
| 2884 // Calculate desaturation time for N2 in tissue. | |
| 2885 // Desaturated state is defined as residual tissue pressure <= 1.05 x ppN2 respired | |
| 2886 | |
| 2887 pres_target = 0.05 * N2_equilibrium; | |
| 2888 | |
| 2889 calc_desaturation_time_helper(); | |
| 2890 | |
| 582 | 2891 if( int_time > int_O_desaturation_time) int_O_desaturation_time = int_time; |
| 2892 | |
| 2893 | |
| 2894 // He: actual amount of tissue pressure above equilibrium: equilibrium for He is 0 bar | |
| 2895 pres_actual = pres_tissue_He[ci]; | |
| 560 | 2896 |
| 2897 // He: half-time of the current tissue | |
| 582 | 2898 var_ht = var_He_ht; |
| 2899 | |
| 560 | 2900 // Calculate desaturation time for He in the tissue. |
| 2901 // Desaturated state is defined as residual tissue pressure <= 0.05 x ppN2 respired | |
| 2902 | |
| 2903 pres_target = 0.05 * N2_equilibrium; | |
| 2904 | |
| 2905 calc_desaturation_time_helper(); | |
| 2906 | |
| 582 | 2907 if( int_time > int_O_desaturation_time) int_O_desaturation_time = int_time; |
| 560 | 2908 |
| 2909 | |
| 2910 // | |
| 2911 // no-fly time | |
| 2912 // | |
| 2913 | |
| 2914 // initialize search direction | |
| 2915 search_direction = 0; | |
| 582 | 2916 |
| 560 | 2917 for(;;) |
| 2918 { | |
| 2919 // N2: actual amount of tissue pressure above equilibrium. | |
| 2920 pres_actual = pres_tissue_N2[ci] - N2_equilibrium; | |
| 582 | 2921 |
| 560 | 2922 // N2: half-time of the current tissue |
| 582 | 2923 var_ht = var_N2_ht; |
| 2924 | |
| 560 | 2925 // Calculate no-fly time for N2 in the tissue. |
| 2926 // Flying is permitted when the N2 pressure fits into the assigned fraction above equilibrium. | |
| 2927 | |
| 2928 pres_target = (split_N2_He[ci] * 0.01) * (pres_tissue_max - N2_equilibrium); | |
| 2929 | |
| 2930 if( pres_target < 0.0 ) // check if desaturation to fly target is possible | |
| 2931 { | |
| 2932 int_O_nofly_time = 288; // NO - set no-fly time to 288 * 10 min = 48 h | |
| 2933 break; // done for this compartment | |
| 2934 } | |
| 2935 else | |
| 2936 { | |
| 2937 calc_desaturation_time_helper(); | |
| 582 | 2938 nofly_N2 = int_time; |
| 560 | 2939 } |
| 582 | 2940 |
| 560 | 2941 // He: actual amount of tissue pressure above equilibrium - equilibrium for He is 0 bar. |
| 2942 pres_actual = pres_tissue_He[ci]; | |
| 2943 | |
| 2944 // He: half-time of the current tissue | |
| 582 | 2945 var_ht = var_He_ht; |
| 2946 | |
| 560 | 2947 // Calculate no-fly time for He in the tissue. |
| 2948 // Flying is permitted when the He pressure fits into the assigned fraction. | |
| 2949 | |
| 582 | 2950 pres_target = (0.01 * (100 - split_N2_He[ci])) * (pres_tissue_max - N2_equilibrium); |
| 560 | 2951 |
| 2952 calc_desaturation_time_helper(); | |
| 582 | 2953 nofly_He = int_time; |
| 560 | 2954 |
| 2955 | |
| 2956 // Because the sum of N2 and He tissue pressures needs to fit into the Buhlmann limit for | |
| 2957 // no-fly time calculation, each gas gets assigned a fraction of the available total pressure | |
| 2958 // limit. The optimum split between the two gases can not be computed by a single formular, | |
| 2959 // because this would require the inversion of a function with two exponential terms, which is | |
| 2960 // not possible. We do not want to do a computational complex simulation here like it is done | |
| 2961 // in the deco calculation code (although we tackle the same base problem here), so we just let | |
| 2962 // the computer try out which split will balance the no-fly times induced by the N2 and the He | |
| 2963 // at best. | |
| 582 | 2964 |
| 560 | 2965 // first of all, skip any optimization in case the current compartment is not the leading one |
| 2966 if( (nofly_N2 <= int_O_nofly_time) && (nofly_He <= int_O_nofly_time) ) break; | |
| 2967 | |
| 2968 // check if the N2 requires more waiting time than the He | |
| 582 | 2969 if( nofly_N2 >= nofly_He ) |
| 560 | 2970 { |
| 2971 // check if the search direction has changed, which means we are beyond the | |
| 2972 // optimum now, or if we are at the upper stop limit of split_N2_He | |
| 2973 if( (search_direction < 0) || (split_N2_He[ci] == 99) ) | |
| 2974 { | |
| 2975 // Either the just completed iteration was more close to the optimum or the one before | |
| 2976 // was, so we take the best (i.e. shortest) time of both as the final no-fly time. | |
| 2977 int_O_nofly_time = (nofly_N2 < nofly_last) ? nofly_N2 : nofly_last; | |
| 2978 break; | |
| 2979 } | |
| 2980 | |
| 2981 // store the no-fly time found in this iteration | |
| 582 | 2982 nofly_last = nofly_N2; |
| 2983 | |
| 560 | 2984 // increase the N2 fraction of the split and set search direction towards more N2 |
| 2985 split_N2_He[ci] += 1; | |
| 2986 search_direction = +1; | |
| 2987 } | |
| 2988 else | |
| 2989 { | |
| 2990 // check if the search direction has changed, which means we are beyond the | |
| 2991 // optimum now, or if we are at the lower stop limit of split_N2_He | |
| 2992 if( (search_direction > 0) || (split_N2_He[ci] == 1) ) | |
| 582 | 2993 { |
| 560 | 2994 // Either the just completed iteration was more close to the optimum or the one before |
| 2995 // was, so we take the best (i.e. shortest) time of both as the final no-fly time. | |
| 2996 int_O_nofly_time = (nofly_He < nofly_last) ? nofly_He : nofly_last; | |
| 2997 break; | |
| 2998 } | |
| 2999 | |
| 3000 // store the no-fly time found in this iteration | |
| 582 | 3001 nofly_last = nofly_He; |
| 3002 | |
| 560 | 3003 // decrease the N2 fraction of the split and set search direction towards less N2 |
| 3004 split_N2_He[ci] -= 1; | |
| 3005 search_direction = -1; | |
| 3006 } | |
| 582 | 3007 |
| 560 | 3008 } // for(;;) |
| 3009 | |
| 3010 } // for(compartments) | |
| 3011 | |
| 582 | 3012 |
| 560 | 3013 // Rescale int_O_desaturation_time and int_O_nofly_time to full minutes for display purpose |
| 3014 int_O_desaturation_time *= 10; | |
| 3015 int_O_nofly_time *= 10; | |
| 582 | 3016 |
| 560 | 3017 // Limit int_O_desaturation_time and int_O_nofly_time to 5999 = 99 hours + 59 minutes |
| 3018 // because of display space constraints and rounding done above. | |
| 3019 if( int_O_desaturation_time > 5999 ) int_O_desaturation_time = 5999; | |
| 3020 if( int_O_nofly_time > 5999 ) int_O_nofly_time = 5999; | |
| 3021 | |
| 3022 | |
| 582 | 3023 // Clear the microbubbles warning when the current gradient factor is < GF_WARNING_THRESHOLD. |
| 560 | 3024 // As the locked warning will stay set, this will cause the warning be be displayed in attention |
| 3025 // color instead of warning color. | |
| 582 | 3026 if( int_O_gradient_factor < GF_WARNING_THRESHOLD ) |
| 3027 char_O_deco_warnings &= ~DECO_WARNING_MBUBBLES; | |
| 3028 | |
| 560 | 3029 // clear some warnings when the desaturation time has become zero |
| 582 | 3030 if( int_O_desaturation_time == 0 ) |
| 3031 char_O_deco_warnings &= ~( DECO_WARNING_IBCD + DECO_WARNING_IBCD_lock | |
| 3032 + DECO_WARNING_MBUBBLES + DECO_WARNING_MBUBBLES_lock | |
| 3033 + DECO_WARNING_OUTSIDE + DECO_WARNING_OUTSIDE_lock ); | |
| 560 | 3034 |
| 0 | 3035 } |
| 3036 | |
| 3037 ////////////////////////////////////////////////////////////////////////////// | |
| 582 | 3038 // Calculate desaturation of the real tissues for a given time interval |
| 0 | 3039 // |
| 582 | 3040 // Caution: Works on the real tissues! |
| 3041 // If in doubt, use this function only inside a context surrounded with | |
| 3042 // push_tissues_to_vault() / pull_tissues_from_vault() ! | |
| 3043 // | |
| 3044 // Input: int_I_pres_surface : surface pressure in mbar | |
| 3045 // time_interval : time interval in minutes, must be limited to 254 at max | |
| 0 | 3046 // |
| 582 | 3047 // Modified: tissue pressures |
| 3048 // CNS value | |
| 3049 // ceiling and current GF | |
| 560 | 3050 // |
| 582 | 3051 static void calc_interval(PARAMETER unsigned char time_interval) |
| 0 | 3052 { |
| 582 | 3053 overlay unsigned char time; |
| 3054 | |
| 3055 | |
| 3056 assert( 800 < int_I_pres_surface && int_I_pres_surface < 1100 ); | |
| 3057 assert( 100 <= char_I_saturation_multiplier && char_I_saturation_multiplier < 200 ); | |
| 3058 assert( 0 < char_I_desaturation_multiplier && char_I_desaturation_multiplier <= 100 ); | |
| 3059 | |
| 560 | 3060 |
| 3061 // setup input data for deco routines | |
| 582 | 3062 pres_respiration = pres_surface = 0.001 * int_I_pres_surface ; |
| 3063 | |
| 3064 N2_ratio = 0.7902; // according to Buhlmann | |
| 560 | 3065 N2_equilibrium = N2_ratio * (pres_surface - ppWater); // used for N2 tissue graphics scaling |
| 582 | 3066 ppN2 = N2_ratio * (pres_respiration - ppWater); |
| 3067 ppHe = 0.0; | |
| 3068 | |
| 3069 float_desaturation_multiplier = 0.01 * char_I_desaturation_multiplier * SURFACE_DESAT_FACTOR; | |
| 3070 float_saturation_multiplier = 0.01 * char_I_saturation_multiplier; | |
| 3071 | |
| 3072 | |
| 3073 // Calculate the tissues: | |
| 3074 // Because calc_tissues() can calculate for 127 minutes at max, | |
| 3075 // the tissue updating may need to be done in two chunks. | |
| 3076 | |
| 3077 time = time_interval; | |
| 3078 | |
| 3079 // first chunk for the part exceeding 127 minutes | |
| 3080 if( time > 127) | |
| 560 | 3081 { |
| 582 | 3082 // do a full 127 minutes on the real tissues |
| 3083 tissue_increment = 127 | TISSUE_FLAG; | |
| 3084 calc_tissues(); | |
| 3085 | |
| 3086 // determine the remaining part | |
| 3087 time -= 127; | |
| 560 | 3088 } |
| 3089 | |
| 582 | 3090 // program the remaining part (or full part if not exceeding 127 minutes) |
| 3091 tissue_increment = time | TISSUE_FLAG; | |
| 3092 | |
| 3093 // update the N2 and He pressures in the tissues for the remaining part of the time interval | |
| 3094 calc_tissues(); | |
| 3095 | |
| 560 | 3096 |
| 3097 // Calculate CNS: | |
| 3098 // To speed up things and because on most invocations of this code char_I_dive_interval | |
| 3099 // is a multiple of 10 minutes, we loop the loop-counter down using two speeds. | |
| 3100 | |
| 582 | 3101 time = time_interval; |
| 3102 | |
| 3103 while ( time ) | |
| 560 | 3104 { |
| 582 | 3105 if( time > 9 ) |
| 560 | 3106 { |
| 3107 CNS_fraction *= 0.925874712; // Half-time = 90min -> 10 min: (1/2)^(1/9) | |
| 582 | 3108 time -= 10; // fast speed looping |
| 560 | 3109 } |
| 3110 else | |
| 3111 { | |
| 3112 CNS_fraction *= 0.992327946; // Half-time = 90min -> 1 min: (1/2)^(1/90) | |
| 582 | 3113 time -= 1; // slow speed looping |
| 560 | 3114 } |
| 582 | 3115 } |
| 560 | 3116 |
| 3117 // compute integer copy of CNS value | |
| 582 | 3118 convert_CNS_for_display(); |
| 3119 | |
| 3120 | |
| 3121 // calculate ceiling (for a GF high of 100%) and gradient factor | |
| 3122 calc_limit(1.0); | |
| 0 | 3123 } |
| 3124 | |
| 560 | 3125 |
| 3126 ////////////////////////////////////////////////////////////////////////////// | |
| 582 | 3127 // calc_CNS_increment |
| 560 | 3128 // |
| 582 | 3129 // Input: char_ppO2 : current ppO2 [decibars] |
| 3130 // tissue_increment : time increment and tissue selector | |
| 3131 // | |
| 3132 // Output: CNS_fraction_inc : increment of the CNS value | |
| 560 | 3133 // |
| 582 | 3134 void calc_CNS_increment(void) |
| 560 | 3135 { |
| 582 | 3136 overlay float time_factor = 1.0; // default is 2sec |
| 3137 | |
| 3138 assert( char_ppO2 > 15 ); | |
| 3139 | |
| 560 | 3140 // All deco code is now invoked every second. But as the CNS update is based on |
| 3141 // 2 seconds periods, we skip every 2nd seconds-based invocation of this function. | |
| 582 | 3142 // TISSUE_FLAG = 128 (flag for "real" CNS) + 0 (2 seconds period) |
| 560 | 3143 // To distribute computational load, the CNS% is calculated in "the other second" |
| 3144 // than the tissues. | |
| 582 | 3145 if( (tissue_increment == TISSUE_FLAG) && (twosectimer) ) return; |
| 3146 | |
| 560 | 3147 // adjust time factor if minute-based stepping is commanded, mask out flag bit |
| 582 | 3148 if( tissue_increment & TIME_MASK ) time_factor = 30.0 * (float)(tissue_increment & TIME_MASK); |
| 3149 | |
| 3150 | |
| 3151 //------------------------------------------------------------------------ | |
| 3152 // Don't increase CNS below 0.5 bar, but keep it steady. | |
| 3153 if (char_ppO2 < 50) CNS_fraction_inc = 0; // no CNS increase below 0.5 bar ppO2 | |
| 3154 //------------------------------------------------------------------------ | |
| 3155 // Below (and including) 1.60 bar | |
| 3156 else if (char_ppO2 < 61) CNS_fraction_inc = time_factor/(-533.07 * char_ppO2 + 54000.0); | |
| 3157 else if (char_ppO2 < 71) CNS_fraction_inc = time_factor/(-444.22 * char_ppO2 + 48600.0); | |
| 3158 else if (char_ppO2 < 81) CNS_fraction_inc = time_factor/(-355.38 * char_ppO2 + 42300.0); | |
| 3159 else if (char_ppO2 < 91) CNS_fraction_inc = time_factor/(-266.53 * char_ppO2 + 35100.0); | |
| 3160 else if (char_ppO2 < 111) CNS_fraction_inc = time_factor/(-177.69 * char_ppO2 + 27000.0); | |
| 3161 else if (char_ppO2 < 152) CNS_fraction_inc = time_factor/( -88.84 * char_ppO2 + 17100.0); | |
| 3162 else if (char_ppO2 < 167) CNS_fraction_inc = time_factor/(-222.11 * char_ppO2 + 37350.0); | |
| 3163 //------------------------------------------------------------------------ | |
| 3164 // Arieli et all.(2002): Modeling pulmonary and CNS O2 toxicity: | |
| 3165 // J Appl Physiol 92: 248--256, 2002, doi:10.1152/japplphysiol.00434.2001 | |
| 3166 // Formula (A1) based on value for 1.55 and c=20 | |
| 3167 // example calculation: Sqrt((1.7/1.55)^20)*0.000404 | |
| 3168 else if (char_ppO2 < 172) CNS_fraction_inc = time_factor*0.00102; | |
| 3169 else if (char_ppO2 < 177) CNS_fraction_inc = time_factor*0.00136; | |
| 3170 else if (char_ppO2 < 182) CNS_fraction_inc = time_factor*0.00180; | |
| 3171 else if (char_ppO2 < 187) CNS_fraction_inc = time_factor*0.00237; | |
| 3172 else if (char_ppO2 < 192) CNS_fraction_inc = time_factor*0.00310; | |
| 3173 else if (char_ppO2 < 198) CNS_fraction_inc = time_factor*0.00401; | |
| 3174 else if (char_ppO2 < 203) CNS_fraction_inc = time_factor*0.00517; | |
| 3175 else if (char_ppO2 < 233) CNS_fraction_inc = time_factor*0.0209; | |
| 3176 else CNS_fraction_inc = time_factor*0.0482; // value for 2.5 bar, used for 2.33 bar and above | |
| 0 | 3177 } |
| 3178 | |
| 3179 ////////////////////////////////////////////////////////////////////////////// | |
| 560 | 3180 // calc_CNS_planning |
| 0 | 3181 // |
| 582 | 3182 // Compute CNS increase during predicted ascent |
| 0 | 3183 // |
| 582 | 3184 // Input: internal_deco_time[], internal_deco_depth[], internal_deco_gas[] |
| 3185 // Output: sim_CNS_fraction | |
| 0 | 3186 // |
| 560 | 3187 void calc_CNS_planning(void) |
| 0 | 3188 { |
| 582 | 3189 // null sim_CNS_fraction |
| 3190 sim_CNS_fraction = 0.0; | |
| 3191 | |
| 3192 //---- CCR mode : do the full TTS at once --------------------------------- | |
| 560 | 3193 |
| 3194 if( ((char_O_deco_status & DECO_MODE_MASK) == DECO_MODE_CCR) ) | |
| 582 | 3195 { |
| 3196 overlay unsigned short t; // needs 16 bits here ! | |
| 560 | 3197 |
| 3198 // get current ppO2 from sensors or setpoint | |
| 582 | 3199 char_ppO2 = char_I_const_ppO2; |
| 560 | 3200 |
| 3201 // calculate CNS% for the period of additional staying at bottom depth (fTTS / delayed ascent) | |
| 3202 if( char_O_deco_status & DECO_ASCENT_DELAYED) | |
| 3203 { | |
| 582 | 3204 tissue_increment = char_I_extra_time; // must be limited to 127, is limited by range of char_I_extra_time |
| 3205 calc_CNS_increment(); // calculate the CNS increment | |
| 3206 sim_CNS_fraction += CNS_fraction_inc; // sum up | |
| 560 | 3207 } |
| 582 | 3208 |
| 560 | 3209 // get the ascent time dependent on the current plan |
| 3210 t = (char_O_deco_status & DECO_PLAN_ALTERNATE) ? int_O_alternate_ascenttime : int_O_ascenttime; | |
| 582 | 3211 |
| 560 | 3212 // start simulating CNS% in chunks of 127 minutes |
| 3213 tissue_increment = 127; | |
| 3214 | |
| 3215 while( t > 127 ) | |
| 3216 { | |
| 3217 t -= 127; // tissue_increment is limited to 127 minutes because of flag in bit 7 | |
| 582 | 3218 calc_CNS_increment(); // calculate CNS in chunks of full 127 minutes |
| 3219 sim_CNS_fraction += CNS_fraction_inc; // sum up | |
| 560 | 3220 } |
| 3221 | |
| 3222 tissue_increment = (char)t; // get the remaining minutes <= 127 | |
| 582 | 3223 calc_CNS_increment(); // calculate CNS for the remaining minutes |
| 3224 sim_CNS_fraction += CNS_fraction_inc; // sum up | |
| 3225 } | |
| 560 | 3226 else //---- OC mode and pSCR without sensors: have to follow all gas switches... ----- |
| 582 | 3227 { |
| 560 | 3228 overlay float float_actual_ppO2; |
| 3229 overlay float abs_pres; | |
| 3230 | |
| 3231 overlay unsigned char stop_depth; | |
| 3232 overlay unsigned char last_gas; | |
| 582 | 3233 overlay unsigned char i; // stop table index |
| 3234 | |
| 3235 | |
| 560 | 3236 // retrieve bottom gas: 1-5 for the configured gases or 0 for the manually set gas |
| 3237 last_gas = sim_gas_last_used = sim_gas_first_used; | |
| 3238 | |
| 3239 // get the calc_N2/He/O2_ratios of the bottom gas | |
| 582 | 3240 gas_set_ratios(); |
| 560 | 3241 |
| 3242 // calculate absolute pressure | |
| 3243 abs_pres = pres_surface + bottom_depth * METER_TO_BAR; | |
| 582 | 3244 |
| 3245 // calculate OC ppO2 (ppWater omitted here on purpose) | |
| 3246 float_actual_ppO2 = abs_pres * sim_O2_ratio; | |
| 3247 | |
| 3248 // correct ppO2 in case of pSCR mode by drop | |
| 3249 if( char_O_deco_status & DECO_MODE_PSCR ) float_actual_ppO2 -= sim_pSCR_drop; | |
| 3250 | |
| 3251 // convert ppO2 from float to char | |
| 3252 if ( float_actual_ppO2 < 0.0 ) char_ppO2 = 0; | |
| 3253 else if ( float_actual_ppO2 > 2.545 ) char_ppO2 = 255; | |
| 3254 else char_ppO2 = (unsigned char)(100 * float_actual_ppO2 + 0.5); | |
| 3255 | |
| 560 | 3256 |
| 3257 // simulate extended bottom time (fTTS) / delay before ascent (bailout) if configured | |
| 3258 if( char_O_deco_status & DECO_ASCENT_DELAYED ) | |
| 3259 { | |
| 582 | 3260 tissue_increment = char_I_extra_time; // must be limited to 127, is limited by range of char_I_extra_time |
| 3261 calc_CNS_increment(); // calculate the CNS increment | |
| 3262 sim_CNS_fraction += CNS_fraction_inc; // sum up | |
| 560 | 3263 } |
| 3264 | |
| 582 | 3265 |
| 560 | 3266 // For simplicity reason (non-linearity of the relation between ppO2 and CNS increments), the |
| 3267 // whole ascent is calculated with bottom ppO2. This errs, but it does so to the safe side. | |
| 582 | 3268 |
| 560 | 3269 // calculate ascent time (integer division and generous round-up) |
| 3270 tissue_increment = bottom_depth / char_I_ascent_speed + 1; | |
| 582 | 3271 |
| 3272 // ** commented out - not needed when char_I_ascent_speed is limited to a minimum | |
| 3273 // ** of 2.something, it is indeed limited to a minimum of 5. | |
| 560 | 3274 // |
| 3275 // // limit tissue_increment to 127 minutes | |
| 582 | 3276 // if( tissue_increment > 127 ) tissue_increment = 127; |
| 560 | 3277 |
| 3278 // simulate the CNS increase | |
| 582 | 3279 calc_CNS_increment(); // calculate the CNS increment |
| 3280 sim_CNS_fraction += CNS_fraction_inc; // sum up | |
| 3281 | |
| 3282 | |
| 3283 //---- Stops --------------------------------------------------------- | |
| 560 | 3284 |
| 582 | 3285 for(i=0; i<NUM_STOPS; ++i) |
| 3286 { | |
| 560 | 3287 // get the depth of the stop |
| 3288 stop_depth = internal_deco_depth[i]; | |
| 3289 | |
| 3290 // did we reach the last entry (depth = 0)? if yes, done | |
| 3291 if (stop_depth == 0) break; | |
| 3292 | |
| 3293 // get the duration of the stop and the gas breathed | |
| 3294 tissue_increment = internal_deco_time[i]; | |
| 582 | 3295 sim_gas_last_used = internal_deco_gas[i]; |
| 3296 | |
| 3297 // do we have a gas switch? | |
| 3298 if( sim_gas_last_used != last_gas ) | |
| 3299 { | |
| 3300 // yes - get new calculation ratios | |
| 3301 gas_set_ratios(); | |
| 560 | 3302 |
| 3303 // remember new gas as last gas | |
| 3304 last_gas = sim_gas_last_used; | |
| 3305 } | |
| 3306 | |
| 582 | 3307 // calculate absolute pressure at stop depth |
| 560 | 3308 abs_pres = pres_surface + stop_depth * METER_TO_BAR; |
| 582 | 3309 |
| 3310 // calculate OC ppO2 (ppWater omitted here on purpose) | |
| 3311 float_actual_ppO2 = abs_pres * sim_O2_ratio; | |
| 3312 | |
| 3313 // correct ppO2 in case of pSCR mode by drop | |
| 3314 if( char_O_deco_status & DECO_MODE_PSCR ) float_actual_ppO2 -= sim_pSCR_drop; | |
| 3315 | |
| 3316 // convert ppO2 from float to char | |
| 3317 if ( float_actual_ppO2 < 0.0 ) char_ppO2 = 0; | |
| 3318 else if ( float_actual_ppO2 > 2.545 ) char_ppO2 = 255; | |
| 3319 else char_ppO2 = (unsigned char)(100 * float_actual_ppO2 + 0.5); | |
| 3320 | |
| 560 | 3321 // ** Currently, stop times per stop entry are limited to 99 minutes in update_deco_table(), |
| 3322 // ** so the following code block is not needed at times. | |
| 3323 // | |
| 582 | 3324 // // tissue_increment is limited to 127 when fed to calc_CNS_increment(), |
| 560 | 3325 // // so if the stop is longer than 127 minutes (but not longer than 254 minutes!) |
| 3326 // // we need to calculate the CNS in two chunks. | |
| 3327 // if( tissue_increment > 127) | |
| 3328 // { | |
| 582 | 3329 // tissue_increment -= 127; // subtract full 127 minutes and do the "remaining" minutes first |
| 3330 // calc_CNS_increment(); // calculate the CNS increment | |
| 3331 // sim_CNS_fraction += CNS_fraction_inc; // sum up | |
| 3332 // tissue_increment = 127; // catch up with the previously subtracted full 127 minutes | |
| 560 | 3333 // } |
| 3334 | |
| 582 | 3335 // calculate CNS% for the stop |
| 3336 calc_CNS_increment(); // calculate the CNS increment | |
| 3337 sim_CNS_fraction += CNS_fraction_inc; // sum up | |
| 3338 } | |
| 3339 } | |
| 0 | 3340 } |
| 3341 | |
| 560 | 3342 |
| 0 | 3343 ////////////////////////////////////////////////////////////////////////////// |
| 560 | 3344 // gas_volumes |
| 3345 // | |
| 3346 // calculates volumes and required tank fill pressures for each gas. | |
| 0 | 3347 // |
| 582 | 3348 // Input: bottom_depth depth of the bottom segment |
| 3349 // char_I_bottom_time duration of the bottom segment | |
| 3350 // char_I_extra_time extra bottom time for fTTS / delayed ascent | |
| 3351 // float_ascent_speed ascent speed, in meters/minute | |
| 3352 // sim_gas_first_used the bottom gas (1-5 for configured gases, 0 for the manual gas) | |
| 3353 // internal_deco_depth[] depth of the stops | |
| 3354 // internal_deco_time[] duration of the stops | |
| 3355 // internal_deco_gas[] gas breathed at the stops | |
| 3356 // char_I_bottom_usage gas consumption during bottom part and initial ascent, in liters/minute | |
| 3357 // char_I_deco_usage gas consumption during stops and following ascents, in liters/minute | |
| 3358 // char_I_tank_size[] size of the tanks for gas 1-5, in liters | |
| 3359 // char_I_tank_pres_fill[] fill pressure of the tanks | |
| 0 | 3360 // |
| 582 | 3361 // Output: int_O_gas_volumes[] amount of gas needed, in liters |
| 3362 // int_O_tank_pres_need[] in bar, + flags for fast evaluation by dive mode warnings: | |
| 3363 // 2^15: pres_need >= pres_fill | |
| 3364 // 2^14: pres_need >= press_fill * GAS_NEEDS_ATTENTION_THRESHOLD | |
| 3365 // 2^11: pres_need == 0 | |
| 3366 // 2^10: pres_need invalid | |
| 0 | 3367 // |
| 560 | 3368 void gas_volumes_helper(void) |
| 3369 { | |
| 3370 // Calculate the gas volume needed at a given depth, time and usage (SAC rate). | |
| 3371 // We use 1.0 for the surface pressure to have stable results when used through | |
| 3372 // the deco calculator (simulation mode). | |
| 3373 volume = (float_depth * METER_TO_BAR + 1.0) * float_time * usage; | |
| 582 | 3374 |
| 560 | 3375 return; |
| 3376 } | |
| 3377 | |
| 3378 void gas_volumes(void) | |
| 0 | 3379 { |
| 560 | 3380 overlay float volumes[NUM_GAS]; |
| 3381 | |
| 3382 overlay unsigned char stop_gas; | |
| 3383 overlay unsigned char stop_gas_last; | |
| 3384 overlay unsigned char stop_time; | |
| 3385 overlay unsigned char stop_depth; | |
| 3386 overlay unsigned char stop_depth_last; | |
| 3387 overlay unsigned char i; | |
| 3388 | |
| 582 | 3389 |
| 3390 //---- initialization ---------------------------------------------------- | |
| 3391 | |
| 560 | 3392 // null the volume accumulators |
| 582 | 3393 for(i=0; i<NUM_GAS; ++i) volumes[i] = 0.0; |
| 560 | 3394 |
| 3395 // quit for CCR and pSCR mode | |
| 3396 if( char_O_deco_status & DECO_MODE_LOOP ) goto done; | |
| 3397 | |
| 3398 | |
| 582 | 3399 //---- bottom demand ----------------------------------------------------- |
| 3400 | |
| 560 | 3401 // sim_gas_first_used : gas used during bottom segment (0, 1-5) |
| 3402 // bottom_depth: depth of the bottom segment | |
| 582 | 3403 |
| 560 | 3404 assert(0 <= sim_gas_first_used && sim_gas_first_used <= NUM_GAS); |
| 3405 | |
| 3406 // get the gas used during bottom segment | |
| 3407 stop_gas_last = stop_gas = sim_gas_first_used; | |
| 582 | 3408 |
| 560 | 3409 // set the usage (SAC rate) to bottom usage rate for bottom part and initial ascent |
| 3410 usage = char_I_bottom_usage; | |
| 582 | 3411 |
| 560 | 3412 // volumes are only calculated for gases 1-5, but not the manually configured one |
| 3413 if( stop_gas ) | |
| 3414 { | |
| 3415 // set the bottom depth | |
| 3416 float_depth = (float)bottom_depth; | |
| 582 | 3417 |
| 560 | 3418 // calculate either bottom segment or just the fTTS/bailout delayed part |
| 3419 if( char_O_main_status & DECO_BOTTOM_CALCULATE ) | |
| 3420 { | |
| 3421 // duration of bottom segment | |
| 3422 float_time = (float)char_I_bottom_time; | |
| 3423 } | |
| 3424 else | |
| 3425 { | |
| 3426 // duration of delayed ascent | |
| 3427 float_time = (float)char_I_extra_time; | |
| 3428 } | |
| 582 | 3429 |
| 560 | 3430 // calculate gas demand |
| 3431 gas_volumes_helper(); | |
| 582 | 3432 |
| 560 | 3433 // take result |
| 3434 volumes[stop_gas-1] = volume; | |
| 3435 } | |
| 582 | 3436 |
| 560 | 3437 // initialize stop index with first stop |
| 3438 i = 0; | |
| 3439 | |
| 3440 //---- initial ascent demand --------------------------------------------- | |
| 582 | 3441 |
| 560 | 3442 // stop_gas : gas from bottom segment |
| 582 | 3443 // bottom_depth : depth of the bottom segment |
| 560 | 3444 // internal_deco_depth[i=0]: depth of the first stop, may be 0 if no stop exists |
| 582 | 3445 |
| 560 | 3446 // get the data of the first stop |
| 3447 stop_depth = internal_deco_depth[i]; | |
| 3448 stop_time = internal_deco_time[i]; | |
| 582 | 3449 |
| 560 | 3450 // volumes are only calculated for gases 1-5, but not the manually configured one |
| 3451 if( stop_gas ) | |
| 3452 { | |
| 3453 // compute distance between bottom and first stop | |
| 3454 float_depth = (float)bottom_depth - (float)stop_depth; | |
| 582 | 3455 |
| 560 | 3456 // initial ascent exists only if ascent distance is > 0 |
| 3457 if( float_depth > 0.0 ) | |
| 3458 { | |
| 3459 // compute ascent time | |
| 3460 float_time = float_depth / float_ascent_speed; | |
| 582 | 3461 |
| 560 | 3462 // compute average depth between bottom and first stop |
| 3463 float_depth = (float)bottom_depth - float_depth * 0.5; | |
| 3464 | |
| 3465 // calculate gas demand | |
| 3466 gas_volumes_helper(); | |
| 3467 | |
| 3468 // add result | |
| 3469 volumes[stop_gas-1] += volume; | |
| 3470 } | |
| 3471 } | |
| 3472 | |
| 3473 // switch the usage (SAC rate) to deco usage rate | |
| 3474 // for stops, intermediate and final ascent | |
| 3475 usage = char_I_deco_usage; | |
| 582 | 3476 |
| 560 | 3477 // is there a (first) stop? if yes, goto stops processing |
| 3478 if( stop_depth ) goto stops; | |
| 582 | 3479 |
| 560 | 3480 // add demand of a 3 minutes safety stop at 5 meters, at least for contingency... |
| 3481 float_time = 3.0; | |
| 3482 float_depth = 5.0; | |
| 3483 | |
| 3484 // calculate gas demand | |
| 3485 gas_volumes_helper(); | |
| 3486 | |
| 3487 // add result | |
| 3488 volumes[stop_gas-1] += volume; | |
| 3489 | |
| 3490 // proceed to volume conversion and pressure calculations | |
| 582 | 3491 goto done; |
| 3492 | |
| 3493 | |
| 560 | 3494 //---- intermediate ascent demand --------------------------------------- |
| 3495 inter_ascents: | |
| 3496 | |
| 3497 // store last stop depth and gas | |
| 3498 stop_depth_last = stop_depth; | |
| 3499 stop_gas_last = stop_gas; | |
| 582 | 3500 |
| 560 | 3501 // check if we are at the end of the stops table |
| 3502 if( i < NUM_STOPS-1 ) | |
| 3503 { | |
| 3504 // there are more entries - get the next stop data | |
| 3505 i++; | |
| 3506 | |
| 3507 // get the next stop depth | |
| 3508 stop_depth = internal_deco_depth[i]; | |
| 3509 | |
| 3510 // check if there is indeed another stop, | |
| 3511 // if not (depth = 0) treat as end of table | |
| 3512 if( stop_depth == 0 ) goto end_of_table; | |
| 3513 | |
| 3514 // get the next stop duration | |
| 3515 stop_time = internal_deco_time[i]; | |
| 3516 } | |
| 3517 else | |
| 3518 { | |
| 3519 end_of_table: | |
| 3520 | |
| 3521 // End of the stops table reached or no more stops: Split the remaining | |
| 3522 // ascent into an intermediate ascent and a final ascent by creating a | |
| 3523 // dummy stop at the usual last deco stop depth. Stop gas doesn't change. | |
| 3524 stop_time = 0; | |
| 3525 stop_depth = char_I_depth_last_deco; | |
| 3526 } | |
| 3527 | |
| 3528 // volumes are only calculated for gases 1-5, but not the manually configured one | |
| 3529 if( stop_gas_last ) | |
| 3530 { | |
| 3531 // compute distance between the two stops: | |
| 3532 // last stop will always be deeper than current stop | |
| 3533 float_depth = (float)(stop_depth_last - stop_depth); | |
| 3534 | |
| 3535 // compute ascent time | |
| 3536 float_time = float_depth / float_ascent_speed; | |
| 582 | 3537 |
| 560 | 3538 // compute average depth between the two stops |
| 3539 float_depth = (float)stop_depth_last - float_depth * 0.5; | |
| 3540 | |
| 3541 // calculate gas demand | |
| 3542 gas_volumes_helper(); | |
| 3543 | |
| 3544 // add result | |
| 3545 volumes[stop_gas_last-1] += volume; | |
| 3546 } | |
| 3547 | |
| 3548 | |
| 3549 //---- next stop demand ------------------------------------------------- | |
| 3550 stops: | |
| 582 | 3551 |
| 560 | 3552 // convert depth of the stop |
| 3553 float_depth = (float)stop_depth; | |
| 582 | 3554 |
| 560 | 3555 // get the next gas |
| 3556 stop_gas = internal_deco_gas[i]; | |
| 582 | 3557 |
| 560 | 3558 // do we we have a gas change? |
| 3559 if( stop_gas_last && (stop_gas != stop_gas_last) ) | |
| 3560 { | |
| 3561 // yes - spend an additional char_I_gas_change_time on the old gas | |
| 3562 float_time = (float)char_I_gas_change_time; | |
| 582 | 3563 |
| 560 | 3564 // calculate gas demand |
| 3565 gas_volumes_helper(); | |
| 3566 | |
| 3567 // add result | |
| 3568 volumes[stop_gas_last-1] += volume; | |
| 3569 } | |
| 582 | 3570 |
| 560 | 3571 // calculate and add demand on new gas for the full stop duration |
| 3572 if( stop_gas ) | |
| 3573 { | |
| 3574 // get the duration of the stop | |
| 3575 float_time = (float)stop_time; | |
| 582 | 3576 |
| 560 | 3577 // calculate gas demand |
| 3578 gas_volumes_helper(); | |
| 3579 | |
| 3580 // add result to last gas | |
| 3581 volumes[stop_gas-1] += volume; | |
| 3582 } | |
| 3583 | |
| 3584 // continue with the next intermediate ascent if this was not the last stop | |
| 3585 if( stop_depth > char_I_depth_last_deco ) goto inter_ascents; | |
| 3586 | |
| 3587 | |
| 3588 //---- final ascent demand ----------------------------------------------- | |
| 3589 final_ascent: | |
| 3590 | |
| 3591 // float_depth: depth of last stop | |
| 3592 // stop_gas : gas from last stop (0 or 1-5) | |
| 582 | 3593 |
| 560 | 3594 // volumes are only calculated for gases 1-5, but not the manually configured one |
| 3595 if( stop_gas ) | |
| 3596 { | |
| 3597 // set ascent time according to an ascent speed of 1 meter per minute | |
| 3598 float_time = float_depth; | |
| 582 | 3599 |
| 560 | 3600 // set half-way depth |
| 3601 float_depth *= 0.5; | |
| 582 | 3602 |
| 560 | 3603 // calculate gas demand |
| 3604 gas_volumes_helper(); | |
| 3605 | |
| 3606 // add result | |
| 3607 volumes[stop_gas-1] += volume; | |
| 3608 } | |
| 3609 | |
| 3610 | |
| 582 | 3611 //---- convert results for the assembler interface ----------------------------- |
| 560 | 3612 done: |
| 3613 | |
| 582 | 3614 for(i=0; i<NUM_GAS; ++i) |
| 560 | 3615 { |
| 582 | 3616 if( volumes[i] >= 65534.5 ) |
| 560 | 3617 { |
| 3618 int_O_gas_volumes[i] = 65535; | |
| 3619 int_O_tank_pres_need[i] = 999 + INT_FLAG_WARNING; // 999 bar + warning flag for > pres_fill | |
| 3620 } | |
| 3621 else | |
| 3622 { | |
| 3623 overlay unsigned short tank_pres_fill = 10.0 * (unsigned short)char_I_tank_pres_fill[i]; | |
| 582 | 3624 |
| 560 | 3625 // No distinct rounding done here because volumes are not accurate to the single liter anyhow |
| 582 | 3626 |
| 560 | 3627 // convert gas volumes to integers |
| 582 | 3628 int_O_gas_volumes[i] = (unsigned short)volumes[i]; |
| 3629 | |
| 560 | 3630 // compute how much pressure in the tank will be needed [in bar] (integer-division) |
| 3631 int_O_tank_pres_need[i] = (unsigned short)(int_O_gas_volumes[i] / char_I_tank_size[i]); | |
| 582 | 3632 |
| 560 | 3633 // limit to 999 bar because of display constraints |
| 3634 if( int_O_tank_pres_need[i] > 999 ) int_O_tank_pres_need[i] = 999; | |
| 582 | 3635 |
| 560 | 3636 // set flags for fast evaluation by divemode check for warnings |
| 3637 if ( int_O_tank_pres_need[i] == 0 ) | |
| 3638 { | |
| 3639 // set flag for 0 bar | |
| 3640 int_O_tank_pres_need[i] |= INT_FLAG_ZERO; | |
| 3641 } | |
| 3642 else if( int_O_tank_pres_need[i] >= tank_pres_fill ) | |
| 3643 { | |
| 3644 // set warning flag | |
| 3645 int_O_tank_pres_need[i] |= INT_FLAG_WARNING; | |
| 3646 | |
| 3647 } | |
| 3648 else if( int_O_tank_pres_need[i] >= tank_pres_fill * GAS_NEEDS_ATTENTION_THRESHOLD ) | |
| 3649 { | |
| 3650 // set pre-warning flag | |
| 582 | 3651 int_O_tank_pres_need[i] |= INT_FLAG_ATTENTION; |
| 3652 } | |
| 560 | 3653 |
| 3654 // set invalid flag if there is an overflow in the stops table | |
| 3655 if( char_O_deco_warnings & DECO_WARNING_STOPTABLE_OVERFLOW ) | |
| 3656 int_O_tank_pres_need[i] |= INT_FLAG_INVALID; | |
| 3657 | |
| 3658 } // if( volumes[i] ) | |
| 3659 } // for | |
| 0 | 3660 } |
| 3661 | |
| 3662 ////////////////////////////////////////////////////////////////////////////// | |
| 560 | 3663 |
| 582 | 3664 void convert_CNS_for_display(void) |
| 0 | 3665 { |
| 560 | 3666 if ( CNS_fraction < 0.01 ) int_O_CNS_fraction = 0; |
| 3667 else if ( CNS_fraction >= 9.985 ) int_O_CNS_fraction = 999 + INT_FLAG_WARNING; | |
| 3668 else | |
| 3669 { | |
| 3670 // convert float to integer | |
| 3671 int_O_CNS_fraction = (unsigned short)(100 * CNS_fraction + 0.5); | |
| 582 | 3672 |
| 3673 // set warnings | |
| 3674 if ( int_O_CNS_fraction >= CNS_WARNING_THRESHOLD ) int_O_CNS_fraction |= INT_FLAG_WARNING; | |
| 3675 else if ( int_O_CNS_fraction >= CNS_ATTENTION_THRESHOLD ) int_O_CNS_fraction |= INT_FLAG_ATTENTION; | |
| 3676 } | |
| 3677 } | |
| 3678 | |
| 3679 ////////////////////////////////////////////////////////////////////////////// | |
| 3680 | |
| 3681 void convert_sim_CNS_for_display(void) | |
| 3682 { | |
| 3683 if ( sim_CNS_fraction < 0.01 ) int_sim_CNS_fraction = 0; | |
| 3684 else if ( sim_CNS_fraction >= 9.985 ) int_sim_CNS_fraction = 999 + INT_FLAG_WARNING; | |
| 3685 else | |
| 3686 { | |
| 3687 // convert float to integer | |
| 3688 int_sim_CNS_fraction = (unsigned short)(100 * sim_CNS_fraction + 0.5); | |
| 3689 | |
| 3690 // set warning flag if CNS is >= 100% | |
| 3691 if ( int_sim_CNS_fraction >= CNS_WARNING_THRESHOLD ) int_sim_CNS_fraction |= INT_FLAG_WARNING; | |
| 3692 else if ( int_sim_CNS_fraction >= CNS_ATTENTION_THRESHOLD ) int_sim_CNS_fraction |= INT_FLAG_ATTENTION; | |
| 3693 | |
| 3694 // set invalid flag if there is an overflow in the stops table | |
| 3695 if( char_O_deco_warnings & DECO_WARNING_STOPTABLE_OVERFLOW ) int_sim_CNS_fraction |= INT_FLAG_INVALID; | |
| 560 | 3696 } |
| 0 | 3697 } |
| 3698 | |
| 3699 ////////////////////////////////////////////////////////////////////////////// | |
| 582 | 3700 // push_tissues_to_vault & pull_tissues_from_vault |
| 3701 // | |
| 3702 // ATTENTION: Do not use from inside the deco engine! | |
| 3703 // The vault is exclusively reserved to back-up and restore the real | |
| 3704 // tissues and related data when entering / leaving simulation mode! | |
| 3705 // | |
| 3706 | |
| 3707 void push_tissues_to_vault(void) | |
| 0 | 3708 { |
| 582 | 3709 overlay unsigned char x; |
| 3710 | |
| 3711 cns_vault_float = CNS_fraction; | |
| 560 | 3712 deco_warnings_vault = char_O_deco_warnings; |
| 0 | 3713 |
| 582 | 3714 for (x=0;x<NUM_COMP;x++) |
| 3715 { | |
| 3716 pres_tissue_N2_vault[x] = pres_tissue_N2[x]; | |
| 3717 pres_tissue_He_vault[x] = pres_tissue_He[x]; | |
| 3718 } | |
| 0 | 3719 } |
| 3720 | |
| 582 | 3721 void pull_tissues_from_vault(void) |
| 0 | 3722 { |
| 582 | 3723 overlay unsigned char x; |
| 3724 | |
| 3725 CNS_fraction = cns_vault_float; | |
| 560 | 3726 char_O_deco_warnings = deco_warnings_vault; |
| 582 | 3727 |
| 3728 convert_CNS_for_display(); | |
| 3729 | |
| 560 | 3730 locked_GF_step_norm = GF_delta / low_depth_norm; |
| 3731 locked_GF_step_alt = GF_delta / low_depth_alt; | |
| 3732 | |
| 582 | 3733 for (x=0; x<NUM_COMP; x++) |
| 3734 { | |
| 3735 pres_tissue_N2[x] = pres_tissue_N2_vault[x]; | |
| 3736 pres_tissue_He[x] = pres_tissue_He_vault[x]; | |
| 3737 } | |
| 0 | 3738 } |
| 3739 | |
| 3740 ////////////////////////////////////////////////////////////////////////////// | |
| 3741 // | |
| 3742 #ifndef CROSS_COMPILE | |
| 3743 void main() {} | |
| 3744 #endif |