annotate code_part1/OSTC_code_c_part2/p2_deco.c @ 275:4310ab395dbe

Keep low_depth in float 32bits (w/o rounding) for a better stability.
author JeanDo
date Mon, 18 Apr 2011 00:10:44 +0200
parents fda90f19486a
children 02303915c199
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1 // **************************************************************
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2 // p2_deco.c
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
3 //
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
4 // Created on: 12.05.2009
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
5 // Author: chsw
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
6 //
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
7 // **************************************************************
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
8
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
9 //////////////////////////////////////////////////////////////////////////////
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
10 // OSTC - diving computer code
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
11 // Copyright (C) 2008 HeinrichsWeikamp GbR
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
12 //
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
13 // This program is free software: you can redistribute it and/or modify
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
14 // it under the terms of the GNU General Public License as published by
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
15 // the Free Software Foundation, either version 3 of the License, or
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
16 // (at your option) any later version.
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
17 //
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
18 // This program is distributed in the hope that it will be useful,
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
19 // but WITHOUT ANY WARRANTY; without even the implied warranty of
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
20 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
21 // GNU General Public License for more details.
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
22 //
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
23 // You should have received a copy of the GNU General Public License
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
24 // along with this program. If not, see <http://www.gnu.org/licenses/>.
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
25 //
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
26 //////////////////////////////////////////////////////////////////////////////
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
27
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
28 // *****************************
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
29 // ** I N T R O D U C T I O N **
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
30 // *****************************
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
31 //
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
32 // OSTC
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
33 //
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
34 // code:
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
35 // p2_deco_main_c_v101.c
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
36 // part2 of the OSTC code
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
37 // code with constant O2 partial pressure routines
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
38 // under construction !!
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
39 //
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
40 // summary:
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
41 // decompression routines
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
42 // for the OSTC experimental project
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
43 // written by Christian Weikamp
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
44 // last revision __________
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
45 // comments added _________
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
46 //
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
47 // additional files:
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
48 // p2_tables_v100.romdata (other files)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
49 // 18f4685_ostc_v100.lkr (linker script)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
50 //
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
51 // history:
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
52 // 01/03/08 v100: first release candidate
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
53 // 03/13/08 v101: start of programming ppO2 code
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
54 // 03/13/25 v101a: backup of interrim version with ppO2 calculation
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
55 // 03/13/25 v101: open circuit gas change during deco
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
56 // 03/13/25 v101: CNS_fraction calculation
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
57 // 03/13/26 v101: optimization of tissue calc routines
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
58 // 07/xx/08 v102a: debug of bottom time routine
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
59 // 09/xx/08 v102d: Gradient Factor Model implemenation
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
60 // 10/10/08 v104: renamed to build v103 for v118 stable
171
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
61 // 10/14/08 v104: integration of char_I_depth_last_deco for Gradient Model
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
62 // 03/31/09 v107: integration of FONT Incon24
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
63 // 05/23/10 v109: 5 gas changes & 1 min timer
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
64 // 07/13/10 v110: cns vault added
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
65 // 12/25/10 v110: split in three files (deco.c, main.c, definitions.h)
163
144822282fa3 Fusion declaration of shared C/ASM variables.
JeanDo
parents: 126
diff changeset
66 // 2011/01/20: [jDG] Create a common file included in ASM and C code.
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
67 // 2011/01/23: [jDG] Added read_custom_function().
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
68 // 2011/01/24: [jDG] Make ascenttime an short. No more overflow!
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
69 // 2011/01/25: [jDG] Fusion deco array for both models.
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
70 // 2011/01/25: [jDG] Use CF(54) to reverse deco order.
193
652e17b6267a Minor fixes.
JeanDo
parents: 192
diff changeset
71 // 2011/02/11: [jDG] Reworked gradient-factor implementation.
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
72 // 2011/02/13: [jDG] CF55 for additional gas switch delay in decoplan.
275
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
73 // 2011/02/15: [jDG] Fixed inconsistencies introduced by gas switch delays.
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
74 // 2011/03/21: [jDG] Added gas consumption (CF56 & CF57) evaluation for OCR mode.
257
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
75 // 2011/04/10: [jDG] Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
275
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
76 // 2011/04/15: [jDG] Store low_depth in 32bits (w/o rounding), for a better stability.
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
77 //
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
78 // TODO:
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
79 // + Allow to abort MD2 calculation (have to restart next time).
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
80 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
81 // Literature:
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
82 // Bühlmann, Albert: Tauchmedizin; 4. Auflage [2002];
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
83 // 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
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
84 // Morrison, Stuart; 2000; DIY DECOMPRESSION; http://www.lizardland.co.uk/DIYDeco.html
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
85 // Balthasar, Steffen; Dekompressionstheorie I: Neo Haldane Modelle; http://www.txfreak.de/dekompressionstheorie_1.pdf
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
86 // Baker, Erik C.; Clearing Up The Confusion About "Deep Stops"
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
87 // Baker, Erik C.; Understanding M-values; http://www.txfreak.de/understanding_m-values.pdf
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
88 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
89 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
90
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
91 // *********************
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
92 // ** I N C L U D E S **
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
93 // *********************
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
94 #include <math.h>
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
95
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
96 // ***********************************************
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
97 // ** V A R I A B L E S D E F I N I T I O N S **
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
98 // ***********************************************
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
99
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
100 #include "p2_definitions.h"
275
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
101 #define TEST_MAIN
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
102 #include "shared_definitions.h"
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
103
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
104 // Water vapour partial pressure in the lumb.
233
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
105 #define ppWVapour 0.0627
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
106
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
107 // *************************
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
108 // ** P R O T O T Y P E S **
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
109 // *************************
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
110
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
111 static void calc_hauptroutine(void);
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
112 static void calc_nullzeit(void);
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
113
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
114 static void calc_tissue(PARAMETER unsigned char period);
258
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
115 static void calc_limit(void);
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
116
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
117 static void clear_tissue(void);
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
118 static void calc_ascenttime(void);
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
119 static void update_startvalues(void);
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
120 static void clear_deco_table(void);
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
121 static void update_deco_table(void);
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
122
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
123 static void backup_sim_pres_tissue(void);
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
124 static void restore_sim_pres_tissue(void);
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
125 static void sim_tissue(PARAMETER unsigned char period);
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
126 static void sim_limit(PARAMETER float GF_current);
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
127 static void calc_gradient_factor(void);
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
128 static void calc_wo_deco_step_1_min(void);
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
129
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
130 static void calc_hauptroutine_data_input(void);
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
131 static void calc_hauptroutine_update_tissues(void);
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
132 static void calc_hauptroutine_calc_deco(void);
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
133 static void sim_ascent_to_first_stop(void);
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
134
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
135 static unsigned char gas_switch_deepest(void);
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
136 static void gas_switch_set(void);
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
137
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
138 static unsigned char calc_nextdecodepth(void);
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
139
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
140 //---- Bank 4 parameters -----------------------------------------------------
163
144822282fa3 Fusion declaration of shared C/ASM variables.
JeanDo
parents: 126
diff changeset
141 #pragma udata bank4=0x400
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
142
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
143 static float temp_limit;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
144 static float GF_low;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
145 static float GF_high;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
146 static float GF_delta;
275
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
147 static float low_depth; // Depth of deepest stop
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
148 static float locked_GF_step; // GF_delta / low_depth
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
149
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
150 static unsigned char temp_depth_limit;
171
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
151
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
152 // Simulation context: used to predict ascent.
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
153 static unsigned char sim_lead_tissue_no; // Leading compatiment number.
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
154 static float sim_lead_tissue_limit; // Buhlmann tolerated pressure.
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
155
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
156 // Real context: what we are doing now.
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
157 static float calc_lead_tissue_limit; //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
158
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
159 static unsigned char internal_deco_time[32];
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
160 static unsigned char internal_deco_depth[32];
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
161
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
162 static float cns_vault;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
163 static float pres_tissue_vault[32];
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
164
163
144822282fa3 Fusion declaration of shared C/ASM variables.
JeanDo
parents: 126
diff changeset
165 //---- Bank 5 parameters -----------------------------------------------------
144822282fa3 Fusion declaration of shared C/ASM variables.
JeanDo
parents: 126
diff changeset
166 #pragma udata bank5=0x500
144822282fa3 Fusion declaration of shared C/ASM variables.
JeanDo
parents: 126
diff changeset
167
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
168 static unsigned char ci;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
169 static float pres_respiration;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
170 static float pres_surface;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
171 static float temp_deco;
236
3dbeacf42e9e BUGFIX missing deko init in reboot code.
JeanDo
parents: 235
diff changeset
172 static float ppN2;
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
173 static float ppHe;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
174 static float temp_tissue;
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
175 static float N2_ratio; // Breathed gas nitrogen ratio.
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
176 static float He_ratio; // Breathed gas helium ratio.
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
177 static float var_N2_a; // Bühlmann a, for current N2 tissue.
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
178 static float var_N2_b; // Bühlmann b, for current N2 tissue.
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
179 static float var_He_a; // Bühlmann a, for current He tissue.
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
180 static float var_He_b; // Bühlmann b, for current He tissue.
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
181 static float var_N2_e; // Exposition, for current N2 tissue.
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
182 static float var_He_e; // Exposition, for current He tissue.
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
183
164
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
184 static float pres_diluent; // new in v.101
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
185 static float const_ppO2; // new in v.101
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
186 static float deco_ppO2_change; // new in v.101
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
187 static float deco_ppO2; // new in v.101
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
188
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
189 static unsigned char sim_gas_last_depth; // Depth of last used gas, to detected a gas switch.
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
190 static unsigned char sim_gas_last_used; // Number of last used gas, to detected a gas switch.
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
191 static unsigned short sim_gas_delay; // Time of gas-switch-stop ends [min on dive].
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
192 static unsigned short sim_dive_mins; // Simulated dive time.
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
193 static float calc_N2_ratio; // Simulated (switched) nitrogen ratio.
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
194 static float calc_He_ratio; // Simulated (switched) helium ratio.
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
195 static float CNS_fraction; // new in v.101
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
196 static float float_saturation_multiplier; // new in v.101
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
197 static float float_desaturation_multiplier; // new in v.101
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
198 static float float_deco_distance; // new in v.101
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
199 static char flag_in_divemode; // new in v.108
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
200
225
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
201 static unsigned char deco_gas_change[5]; // new in v.109
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
202
163
144822282fa3 Fusion declaration of shared C/ASM variables.
JeanDo
parents: 126
diff changeset
203 //---- Bank 6 parameters -----------------------------------------------------
144822282fa3 Fusion declaration of shared C/ASM variables.
JeanDo
parents: 126
diff changeset
204 #pragma udata bank6=0x600
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
205
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
206 float pres_tissue[32];
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
207
163
144822282fa3 Fusion declaration of shared C/ASM variables.
JeanDo
parents: 126
diff changeset
208 //---- Bank 7 parameters -----------------------------------------------------
144822282fa3 Fusion declaration of shared C/ASM variables.
JeanDo
parents: 126
diff changeset
209 #pragma udata bank7=0x700
144822282fa3 Fusion declaration of shared C/ASM variables.
JeanDo
parents: 126
diff changeset
210
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
211 float sim_pres_tissue[32]; // 32 floats = 128 bytes.
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
212 static float sim_pres_tissue_backup[32];
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
213
163
144822282fa3 Fusion declaration of shared C/ASM variables.
JeanDo
parents: 126
diff changeset
214 //---- Bank 8 parameters -----------------------------------------------------
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
215 #pragma udata bank8=0x800
163
144822282fa3 Fusion declaration of shared C/ASM variables.
JeanDo
parents: 126
diff changeset
216
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
217 static char md_pi_subst[256];
122
3003a8040b78 FIX again reset C data stack and frame pointer when entering C code.
JeanDo
parents: 116
diff changeset
218 #define C_STACK md_pi_subst // Overlay C-code data stack here, too.
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
219
163
144822282fa3 Fusion declaration of shared C/ASM variables.
JeanDo
parents: 126
diff changeset
220 //---- Bank 9 parameters -----------------------------------------------------
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
221 #pragma udata bank9=0x900
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
222
163
144822282fa3 Fusion declaration of shared C/ASM variables.
JeanDo
parents: 126
diff changeset
223 static char md_state[48]; // DONT MOVE !! // has to be at the beginning of bank 9 for the asm code!!!
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
224
164
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
225 // internal, dbg:
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
226 static unsigned char DBG_char_I_deco_model; // new in v.108.
164
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
227 static unsigned char DBG_char_I_depth_last_deco; // new in v.108
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
228 static unsigned char DBG_deco_gas_change; // new in v.108
224
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
229 static unsigned char DBG_deco_N2_ratio; // new in v.108
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
230 static unsigned char DBG_deco_He_ratio; // new in v.108
164
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
231 static float DBG_pres_surface; // new in v.108
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
232 static float DBG_GF_low; // new in v.108
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
233 static float DBG_GF_high; // new in v.108
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
234 static float DBG_const_ppO2; // new in v.108
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
235 static float DBG_deco_ppO2_change; // new in v.108
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
236 static float DBG_deco_ppO2; // new in v.108
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
237 static float DBG_float_saturation_multiplier; // new in v.108
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
238 static float DBG_float_desaturation_multiplier; // new in v.108
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
239 static float DBG_float_deco_distance; // new in v.108
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
240 static float DBG_N2_ratio; // new in v.108
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
241 static float DBG_He_ratio; // new in v.108
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
242
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
243 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
244 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
245 ///////////////////////////// THE LOOKUP TABLES //////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
246 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
247 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
248 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
249 // End of PROM code is 17F00, So push tables on PROM top...
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
250 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
251 #pragma romdata buhlmann_tables = 0x017B00 // Needs to be in UPPER bank.
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
252 #include "p2_tables.romdata" // new table for deco_main_v.101 (var_N2_a modified)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
253
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
254 // Magic table to compute the MD2 HASH
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
255 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
256 #pragma romdata hash_tables = 0x017E00 // Address fixed by ASM access...
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
257 rom const rom unsigned short md_pi[] =
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
258 {
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
259 0x292E, 0x43C9, 0xA2D8, 0x7C01, 0x3D36, 0x54A1, 0xECF0, 0x0613
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
260 , 0x62A7, 0x05F3, 0xC0C7, 0x738C, 0x9893, 0x2BD9, 0xBC4C, 0x82CA
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
261 , 0x1E9B, 0x573C, 0xFDD4, 0xE016, 0x6742, 0x6F18, 0x8A17, 0xE512
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
262 , 0xBE4E, 0xC4D6, 0xDA9E, 0xDE49, 0xA0FB, 0xF58E, 0xBB2F, 0xEE7A
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
263 , 0xA968, 0x7991, 0x15B2, 0x073F, 0x94C2, 0x1089, 0x0B22, 0x5F21
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
264 , 0x807F, 0x5D9A, 0x5A90, 0x3227, 0x353E, 0xCCE7, 0xBFF7, 0x9703
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
265 , 0xFF19, 0x30B3, 0x48A5, 0xB5D1, 0xD75E, 0x922A, 0xAC56, 0xAAC6
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
266 , 0x4FB8, 0x38D2, 0x96A4, 0x7DB6, 0x76FC, 0x6BE2, 0x9C74, 0x04F1
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
267 , 0x459D, 0x7059, 0x6471, 0x8720, 0x865B, 0xCF65, 0xE62D, 0xA802
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
268 , 0x1B60, 0x25AD, 0xAEB0, 0xB9F6, 0x1C46, 0x6169, 0x3440, 0x7E0F
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
269 , 0x5547, 0xA323, 0xDD51, 0xAF3A, 0xC35C, 0xF9CE, 0xBAC5, 0xEA26
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
270 , 0x2C53, 0x0D6E, 0x8528, 0x8409, 0xD3DF, 0xCDF4, 0x4181, 0x4D52
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
271 , 0x6ADC, 0x37C8, 0x6CC1, 0xABFA, 0x24E1, 0x7B08, 0x0CBD, 0xB14A
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
272 , 0x7888, 0x958B, 0xE363, 0xE86D, 0xE9CB, 0xD5FE, 0x3B00, 0x1D39
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
273 , 0xF2EF, 0xB70E, 0x6658, 0xD0E4, 0xA677, 0x72F8, 0xEB75, 0x4B0A
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
274 , 0x3144, 0x50B4, 0x8FED, 0x1F1A, 0xDB99, 0x8D33, 0x9F11, 0x8314
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
275 };
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
276
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
277 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
278 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
279 ////////////////////////////// THE SUBROUTINES ///////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
280 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
281 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
282 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
283 // all new in v.102
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
284 // moved from 0x0D000 to 0x0C000 in v.108
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
285
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
286 #pragma code p2_deco = 0x0C000
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
287
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
288 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
289 // DBS - debug on start of dive
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
290 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
291 static void create_dbs_set_dbg_and_ndl20mtr(void)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
292 {
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
293 overlay char i; // Local loop index.
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
294
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
295 //---- Reset DEBUG bit fields --------------------------------------------
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
296 int_O_DBS_bitfield = 0;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
297 int_O_DBS2_bitfield = 0;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
298 if(int_O_DBG_pre_bitfield & DBG_RUN)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
299 int_O_DBG_pre_bitfield = DBG_RESTART;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
300 else
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
301 int_O_DBG_pre_bitfield = DBG_RUN;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
302 int_O_DBG_post_bitfield = 0;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
303
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
304 //---- Set 20meters ND limit ---------------------------------------------
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
305 char_O_NDL_at_20mtr = 255;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
306
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
307 //---- Copy all dive parameters ------------------------------------------
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
308 DBG_N2_ratio = N2_ratio;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
309 DBG_He_ratio = He_ratio;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
310 DBG_char_I_deco_model = char_I_deco_model;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
311 DBG_char_I_depth_last_deco = char_I_depth_last_deco;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
312 DBG_pres_surface = pres_surface;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
313 DBG_GF_low = GF_low;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
314 DBG_GF_high = GF_high;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
315 DBG_const_ppO2 = const_ppO2;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
316 DBG_deco_ppO2_change = deco_ppO2_change;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
317 DBG_deco_ppO2 = deco_ppO2;
224
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
318 DBG_deco_N2_ratio = char_I_deco_N2_ratio[0];
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
319 DBG_deco_He_ratio = char_I_deco_He_ratio[0];
225
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
320 DBG_deco_gas_change = deco_gas_change[0];
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
321 DBG_float_saturation_multiplier = float_saturation_multiplier;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
322 DBG_float_desaturation_multiplier = float_desaturation_multiplier;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
323 DBG_float_deco_distance = float_deco_distance;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
324
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
325 //---- Setup some error (?) conditions -----------------------------------
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
326 if(char_I_deco_model)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
327 int_O_DBS_bitfield |= DBS_mode;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
328 if(const_ppO2)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
329 int_O_DBS_bitfield |= DBS_ppO2;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
330 for(i = 16; i < 32; i++)
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
331 if(pres_tissue[i])
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
332 int_O_DBS_bitfield |= DBS_HE_sat;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
333 if(deco_ppO2_change)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
334 int_O_DBS_bitfield |= DBS_ppO2chg;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
335 if(float_saturation_multiplier < 0.99)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
336 int_O_DBS_bitfield |= DBS_SAT2l;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
337 if(float_saturation_multiplier > 1.3)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
338 int_O_DBS_bitfield |= DBS_SAT2h;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
339 if(GF_low < 0.19)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
340 int_O_DBS_bitfield |= DBS_GFLOW2l;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
341 if(GF_low > 1.01)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
342 int_O_DBS_bitfield |= DBS_GFLOW2h;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
343 if(GF_high < 0.6)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
344 int_O_DBS_bitfield |= DBS_GFHGH2l;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
345 if(GF_high > 1.01)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
346 int_O_DBS_bitfield |= DBS_GFHGH2h;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
347 if((N2_ratio + He_ratio) > 0.95)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
348 int_O_DBS_bitfield |= DBS_GASO22l;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
349 if((N2_ratio + He_ratio) < 0.05)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
350 int_O_DBS_bitfield |= DBS_GASO22h;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
351 if(float_deco_distance > 0.25)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
352 int_O_DBS_bitfield |= DBS_DIST2h;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
353 if(char_I_depth_last_deco > 8)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
354 int_O_DBS_bitfield |= DBS_LAST2h;
224
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
355 if(DBG_deco_gas_change && ((char_I_deco_N2_ratio[0] + char_I_deco_He_ratio[0]) > 95))
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
356 int_O_DBS_bitfield |= DBS_DECOO2l;
224
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
357 if(DBG_deco_gas_change && ((char_I_deco_N2_ratio[0] + char_I_deco_He_ratio[0]) < 5))
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
358 int_O_DBS_bitfield |= DBS_DECOO2h;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
359 if(pres_respiration > 3.0)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
360 int_O_DBS2_bitfield |= DBS2_PRES2h;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
361 if(pres_surface - pres_respiration > 0.2)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
362 int_O_DBS2_bitfield |= DBS2_PRES2l;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
363 if(pres_surface < 0.75)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
364 int_O_DBS2_bitfield |= DBS2_SURF2l;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
365 if(pres_surface > 1.11)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
366 int_O_DBS2_bitfield |= DBS2_SURF2h;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
367 if(float_desaturation_multiplier < 0.70)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
368 int_O_DBS2_bitfield |= DBS2_DESAT2l;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
369 if(float_desaturation_multiplier > 1.01)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
370 int_O_DBS2_bitfield |= DBS2_DESAT2h;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
371 if(GF_low > GF_high)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
372 int_O_DBS2_bitfield |= DBS2_GFDneg;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
373 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
374
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
375 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
376 // DBG - set DBG to end_of_dive
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
377 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
378 static void set_dbg_end_of_dive(void)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
379 {
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
380 int_O_DBG_pre_bitfield &= (~DBG_RUN);
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
381 int_O_DBG_post_bitfield &= (~DBG_RUN);
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
382 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
383
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
384 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
385 // DBG - NDL at first 20 m. hit
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
386 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
387 static void check_ndl(void)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
388 {
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
389 if( char_O_NDL_at_20mtr == 255 // Still in NDL mode ?
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
390 && int_I_pres_respiration > 3000 // And we hit the 20m limit ?
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
391 )
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
392 {
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
393 char_O_NDL_at_20mtr = char_O_nullzeit; // change to max bottom time.
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
394 if( char_O_NDL_at_20mtr == 255) // and avoid confusion.
184
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
395 char_O_NDL_at_20mtr = 254;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
396 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
397 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
398
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
399 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
400 // DBG - multi main during dive
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
401 //
184
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
402 static void check_dbg(PARAMETER char is_post_check)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
403 {
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
404 overlay unsigned short temp_DBS = 0;
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
405 overlay unsigned char i; // Local loop index.
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
406
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
407 if( (DBG_N2_ratio != N2_ratio) || (DBG_He_ratio != He_ratio) )
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
408 temp_DBS |= DBG_c_gas;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
409 if(DBG_const_ppO2 != const_ppO2)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
410 temp_DBS |= DBG_c_ppO2;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
411 if( DBG_float_saturation_multiplier != float_saturation_multiplier
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
412 || DBG_float_desaturation_multiplier != float_desaturation_multiplier
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
413 )
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
414 temp_DBS |= DBG_CdeSAT;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
415 if(DBG_char_I_deco_model != char_I_deco_model)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
416 temp_DBS |= DBG_C_MODE;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
417 if(DBG_pres_surface != pres_surface)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
418 temp_DBS |= DBG_C_SURF;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
419
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
420 if( !DBS_HE_sat && !He_ratio)
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
421 for(i = 16; i < 32; i++)
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
422 if(pres_tissue[i])
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
423 temp_DBS |= DBG_HEwoHE;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
424
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
425 if(DBG_deco_ppO2 != deco_ppO2)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
426 temp_DBS |= DBG_C_DPPO2;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
427
225
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
428 if( DBG_deco_gas_change != deco_gas_change[0]
224
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
429 || DBG_deco_N2_ratio != char_I_deco_N2_ratio[0]
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
430 || DBG_deco_He_ratio != char_I_deco_He_ratio[0] )
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
431 temp_DBS |= DBG_C_DGAS;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
432
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
433 if(DBG_float_deco_distance != float_deco_distance)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
434 temp_DBS |= DBG_C_DIST;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
435 if(DBG_char_I_depth_last_deco != char_I_depth_last_deco)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
436 temp_DBS |= DBG_C_LAST;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
437 if( DBG_GF_low != GF_low
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
438 || DBG_GF_high != GF_high )
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
439 temp_DBS |= DBG_C_GF;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
440 if(pres_respiration > 13.0)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
441 temp_DBS |= DBG_PHIGH;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
442 if(pres_surface - pres_respiration > 0.2)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
443 temp_DBS |= DBG_PLOW;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
444 if(is_post_check)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
445 int_O_DBG_post_bitfield |= temp_DBS;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
446 else
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
447 int_O_DBG_pre_bitfield |= temp_DBS;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
448 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
449
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
450 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
451 // DBG - prior to calc. of dive
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
452 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
453 static void check_pre_dbg(void)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
454 {
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
455 check_dbg(0);
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
456 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
457
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
458 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
459 // DBG - after decocalc of dive
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
460 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
461 static void check_post_dbg(void)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
462 {
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
463 check_dbg(1);
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
464 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
465
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
466 //////////////////////////////////////////////////////////////////////////////
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
467 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
468 /////////////////////// U T I L I T I E S /////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
469 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
470 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
471
235
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
472 //////////////////////////////////////////////////////////////////////////////
257
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
473 // Bump to blue-screen when an assert is wrong
235
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
474 #ifdef __DEBUG
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
475 void assert_failed(PARAMETER short int line)
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
476 {
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
477 extern void PLED_resetdebugger(void);
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
478 extern unsigned short temp10;
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
479
257
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
480 temp10 = line; // Show source line number as stack depth.
235
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
481 PLED_resetdebugger();
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
482 }
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
483 #endif
257
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
484
235
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
485 //////////////////////////////////////////////////////////////////////////////
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
486 // When calling C code from ASM context, the data stack pointer and
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
487 // frames should be reset. Bank8 is used by stack, when not doing hashing.
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
488
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
489 #ifdef CROSS_COMPILE
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
490 # define RESET_C_STACK
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
491 #else
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
492 # ifdef __DEBUG
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
493 # define RESET_C_STACK fillDataStack();
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
494 void fillDataStack(void)
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
495 {
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
496 _asm
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
497 LFSR 1,C_STACK
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
498 MOVLW 0xCC
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
499 loop: MOVWF POSTINC1,0
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
500 TSTFSZ FSR1L,0
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
501 BRA loop
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
502
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
503 LFSR 1,C_STACK
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
504 LFSR 2,C_STACK
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
505 _endasm
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
506 }
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
507 # else
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
508 # define RESET_C_STACK \
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
509 _asm \
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
510 LFSR 1, C_STACK \
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
511 LFSR 2, C_STACK \
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
512 _endasm
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
513 # endif
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
514 #endif
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
515
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
516 //////////////////////////////////////////////////////////////////////////////
257
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
517 // Read CF values from the C code.
235
ade0848c8b8b New runtime asserts when compiled in DEBUG more.
JeanDo
parents: 234
diff changeset
518
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
519 static short read_custom_function(PARAMETER unsigned char cf)
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
520 {
184
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
521 #ifdef CROSS_COMPILE
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
522 extern unsigned short custom_functions[];
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
523 return custom_functions[cf];
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
524 #else
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
525 extern unsigned char hi, lo;
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
526 extern void getcustom15();
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
527 _asm
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
528 movff cf,WREG
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
529 call getcustom15,0
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
530 movff lo,PRODL
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
531 movff hi,PRODH
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
532 _endasm
184
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
533 #endif
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
534 }
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
535
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
536 //////////////////////////////////////////////////////////////////////////////
257
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
537 // Fast subroutine to read RTC timer 3.
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
538 // Note: result is in 1/32 of msecs.
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
539 static unsigned short tmr3(void)
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
540 {
261
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
541 #ifndef CROSS_COMPILE
257
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
542 _asm
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
543 movff 0xfb2,PRODL // TMR3L
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
544 movff 0xfb3,PRODH // TMR3H
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
545 _endasm // result in PRODH:PRODL.
261
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
546 #else
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
547 return 0;
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
548 #endif
257
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
549 }
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
550
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
551 //////////////////////////////////////////////////////////////////////////////
258
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
552 // read buhlmann tables A and B for compatriment ci
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
553 //
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
554 static void read_buhlmann_coefficients(void)
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
555 {
184
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
556 #ifndef CROSS_COMPILE
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
557 // Note: we don't use far rom pointer, because the
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
558 // 24 bits is to complex, hence we have to set
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
559 // the UPPER page ourself...
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
560 // --> Set zero if tables are moved to lower pages !
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
561 _asm
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
562 movlw 1
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
563 movwf TBLPTRU,0
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
564 _endasm
184
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
565 #endif
258
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
566
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
567 assert( 0 <= ci && ci < 16 );
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
568 var_N2_a = buhlmann_a[ci];
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
569 var_N2_b = buhlmann_b[ci];
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
570 var_He_a = (buhlmann_a+16)[ci];
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
571 var_He_b = (buhlmann_b+16)[ci];
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
572
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
573 // Check reading consistency:
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
574 if( (var_N2_a < 0.231)
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
575 || (var_N2_a > 1.27)
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
576 || (var_N2_b < 0.504)
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
577 || (var_N2_b > 0.966)
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
578 || (var_He_a < 0.510)
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
579 || (var_He_a > 1.75)
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
580 || (var_He_b < 0.423)
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
581 || (var_He_b > 0.927)
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
582 )
258
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
583 int_O_DBG_pre_bitfield |= DBG_ZH16ERR;
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
584 }
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
585
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
586 //////////////////////////////////////////////////////////////////////////////
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
587 // read buhlmann tables for compatriment ci
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
588 // If period == 0 : 2sec interval
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
589 // 1 : 1 min interval
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
590 // 2 : 10 min interval.
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
591 static void read_buhlmann_times(PARAMETER char period)
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
592 {
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
593 #ifndef CROSS_COMPILE
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
594 // Note: we don't use far rom pointer, because the
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
595 // 24 bits is to complex, hence we have to set
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
596 // the UPPER page ourself...
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
597 // --> Set zero if tables are moved to lower pages !
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
598 _asm
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
599 movlw 1
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
600 movwf TBLPTRU,0
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
601 _endasm
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
602 #endif
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
603 assert( 0 <= ci && ci < 16 );
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
604
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
605 // Integration intervals.
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
606 switch(period)
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
607 {
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
608 case 0: //---- 2 sec -----------------------------------------------------
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
609 var_N2_e = e2secs[ci];
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
610 var_He_e = (e2secs+16)[ci];
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
611
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
612 // Check reading consistency:
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
613 if( (var_N2_e < 0.0000363)
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
614 || (var_N2_e > 0.00577)
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
615 || (var_He_e < 0.0000961)
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
616 || (var_He_e > 0.150)
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
617 )
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
618 int_O_DBG_pre_bitfield |= DBG_ZH16ERR;
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
619
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
620 break;
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
621
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
622 case 1: //---- 1 min -----------------------------------------------------
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
623 var_N2_e = e1min[ci];
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
624 var_He_e = (e1min+16)[ci];
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
625
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
626 // Check reading consistency:
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
627 if( (var_N2_e < 1.09E-3)
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
628 || (var_N2_e > 0.1592)
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
629 || (var_He_e < 0.00288)
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
630 || (var_He_e > 0.3682)
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
631 )
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
632 int_O_DBG_pre_bitfield |= DBG_ZH16ERR;
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
633
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
634 break;
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
635
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
636 case 2: //---- 10 min ----------------------------------------------------
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
637 var_N2_e = e10min[ci];
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
638 var_He_e = (e10min+16)[ci];
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
639
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
640 // Check reading consistency:
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
641 if( (var_N2_e < 0.01085)
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
642 || (var_N2_e > 0.82323)
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
643 || (var_He_e < 0.02846)
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
644 || (var_He_e > 0.98986)
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
645 )
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
646 int_O_DBG_pre_bitfield |= DBG_ZH16ERR;
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
647
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
648 break;
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
649
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
650 default:
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
651 assert(0); // Never go there...
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
652 }
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
653 }
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
654
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
655 //////////////////////////////////////////////////////////////////////////////
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
656 // calc_next_decodepth_GF
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
657 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
658 // new in v.102
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
659 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
660 // INPUT, changing during dive:
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
661 // low_depth
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
662 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
663 // INPUT, fixed during dive:
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
664 // pres_surface
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
665 // GF_delta
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
666 // GF_high
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
667 // GF_low
171
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
668 // char_I_depth_last_deco
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
669 // float_deco_distance
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
670 //
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
671 // RETURN TRUE iff a stop is needed.
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
672 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
673 // OUTPUT
171
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
674 // locked_GF_step
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
675 // temp_depth_limt
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
676 // low_depth
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
677 //
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
678 static unsigned char calc_nextdecodepth(void)
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
679 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
680 //--- Max ascent speed ---------------------------------------------------
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
681 // Recompute leading gas limit, at current depth:
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
682 overlay float depth = (temp_deco - pres_surface) / 0.09985;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
683
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
684 // At most, ascent 1 minute, at 10m/min == 10.0 m.
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
685 overlay float min_depth = depth - 10.0;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
686
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
687 // Do we need to stop at current depth ?
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
688 overlay unsigned char need_stop = 0;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
689
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
690 assert( depth >= -0.2 ); // Allow for 200mbar of weather change.
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
691
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
692 //---- ZH-L16 + GRADIENT FACTOR model ------------------------------------
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
693 if (char_I_deco_model == 1)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
694 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
695 if( depth >= low_depth )
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
696 sim_limit( GF_low );
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
697 else
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
698 sim_limit( GF_high - depth * locked_GF_step );
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
699
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
700 // Stops are needed ?
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
701 if( sim_lead_tissue_limit > pres_surface )
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
702 {
275
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
703 // Compute tolerated depth, for the leading tissue [metre]:
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
704 overlay float depth_tol = (sim_lead_tissue_limit - pres_surface) / 0.09985;
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
705
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
706 // Deepest stop, in multiples of 3 metres.
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
707 overlay unsigned char first_stop = 3 * (short)(0.99999 + depth_tol * 0.33333 );
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
708 assert( first_stop < 128 );
171
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
709
275
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
710 // Is it a new deepest needed stop ? If yes this is the reference for
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
711 // the varying gradient factor. So reset that:
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
712 if( depth_tol > min_depth && depth_tol > low_depth )
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
713 {
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
714 // Store the deepest stop depth, as reference for GF_low.
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
715 low_depth = depth_tol;
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
716 locked_GF_step = GF_delta / low_depth;
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
717 }
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
718
264
d9593e0f1eea Safer rounding (bug bb29)
JeanDo
parents: 261
diff changeset
719 #if defined(__DEBUG) || defined(CROSS_COMPILE)
261
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
720 {
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
721 // Extra testing code to make sure the first_stop formula
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
722 // and rounding provides correct depth:
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
723 overlay float pres_stop = first_stop * 0.09985 // Meters to bar
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
724 + pres_surface;
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
725
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
726 // Keep GF_low until a first stop depth is found:
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
727 if( first_stop >= low_depth )
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
728 sim_limit( GF_low );
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
729 else
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
730 // current GF is GF_high - alpha (GF_high - GF_low)
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
731 // With alpha = currentDepth / maxDepth, hence in [0..1]
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
732 sim_limit( GF_high - first_stop * locked_GF_step );
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
733
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
734 // upper limit (lowest pressure tolerated):
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
735 assert( sim_lead_tissue_limit < pres_stop );
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
736 }
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
737 #endif
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
738
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
739 // Apply correction for the shallowest stop.
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
740 if( first_stop == 3 ) // new in v104
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
741 first_stop = char_I_depth_last_deco; // Use last 3m..6m instead.
171
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
742
275
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
743 // Because gradient factor at first_stop might be bigger than at
261
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
744 // current depth, we might ascent a bit more.
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
745 // Hence, check all stops until one is indeed higher than tolerated presure:
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
746 while(first_stop > 0)
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
747 {
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
748 overlay unsigned char next_stop; // Next index (0..30)
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
749 overlay float pres_stop; // Next depth (0m..90m)
171
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
750
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
751 // Check max speed, or reaching surface.
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
752 if( first_stop <= min_depth )
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
753 break;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
754
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
755 // So, there is indeed a stop needed:
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
756 need_stop = 1;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
757
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
758 if( first_stop <= char_I_depth_last_deco ) // new in v104
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
759 next_stop = 0;
216
c7e32ff65636 BUGFIX typo when last stop is just below 3m.
JeanDo
parents: 212
diff changeset
760 else if( first_stop == 6 )
c7e32ff65636 BUGFIX typo when last stop is just below 3m.
JeanDo
parents: 212
diff changeset
761 next_stop = char_I_depth_last_deco;
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
762 else
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
763 next_stop = first_stop - 3; // Index of next (upper) stop.
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
764
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
765 pres_stop = next_stop * 0.09985 // Meters to bar
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
766 + pres_surface;
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
767
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
768 // Keep GF_low until a first stop depth is found:
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
769 if( next_stop >= low_depth )
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
770 sim_limit( GF_low );
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
771 else
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
772 // current GF is GF_high - alpha (GF_high - GF_low)
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
773 // With alpha = currentDepth / maxDepth, hence in [0..1]
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
774 sim_limit( GF_high - next_stop * locked_GF_step );
171
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
775
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
776 // upper limit (lowest pressure tolerated):
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
777 if( sim_lead_tissue_limit >= pres_stop ) // check if ascent to next deco stop is ok
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
778 break;
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
779
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
780 // Else, validate that stop and loop...
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
781 first_stop = next_stop;
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
782 }
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
783
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
784 // next stop is the last validated depth found, aka first_stop
275
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
785 temp_depth_limit = first_stop; // Stop depth, in metre.
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
786 }
171
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
787 else
275
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
788 temp_depth_limit = 0; // stop depth, in metre.
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
789 }
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
790 else //---- ZH-L16 model -------------------------------------------------
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
791 {
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
792 overlay float pres_gradient;
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
793
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
794 // Original model
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
795 // optimized in v.101
171
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
796 // char_I_depth_last_deco included in v.101
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
797
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
798 // Compute sim_lead_tissue_limit too, but just once.
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
799 sim_limit(1.0);
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
800
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
801 pres_gradient = sim_lead_tissue_limit - pres_surface;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
802 if (pres_gradient >= 0)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
803 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
804 pres_gradient /= 0.29955; // Bar --> stop number;
275
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
805 temp_depth_limit = 3 * (short) (pres_gradient + 0.99); // --> metre : depth for deco
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
806 need_stop = 1; // Hit.
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
807
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
808 // Implement last stop at 4m/5m/6m...
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
809 if( temp_depth_limit == 3 )
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
810 temp_depth_limit = char_I_depth_last_deco;
171
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
811 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
812 else
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
813 temp_depth_limit = 0;
171
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
814 }
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
815
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
816 //---- Check gas change --------------------------------------------------
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
817 need_stop |= gas_switch_deepest(); // Update temp_depth_limit if there is a change,
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
818
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
819 return need_stop;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
820 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
821
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
822 //////////////////////////////////////////////////////////////////////////////
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
823 // copy_deco_table
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
824 //
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
825 // Buffer the stops, once computed, so we can continue to display them
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
826 // while computing the next set.
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
827 //
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
828 static void copy_deco_table(void)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
829 {
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
830 // Copy depth of the first (deepest) stop, because when reversing
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
831 // order, it will be hard to find...
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
832 char_O_first_deco_depth = internal_deco_depth[0];
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
833 char_O_first_deco_time = internal_deco_time [0];
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
834
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
835 if( read_custom_function(54) & 1 ) //---- Should we reverse table ? ------
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
836 {
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
837 overlay unsigned char x, y;
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
838
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
839 //---- First: search the first non-null depth
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
840 for(x=31; x != 0; --x)
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
841 if( internal_deco_depth[x] != 0 ) break;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
842
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
843 //---- Second: copy to output table (in reverse order)
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
844 for(y=0; y<32; y++, --x)
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
845 {
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
846 char_O_deco_depth[y] = internal_deco_depth[x];
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
847 char_O_deco_time [y] = internal_deco_time [x];
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
848
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
849 // Stop only once the last transfer is done.
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
850 if( x == 0 ) break;
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
851 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
852
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
853 //---- Third: fill table end with null
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
854 for(y++; y<32; y++)
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
855 {
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
856 char_O_deco_time [y] = 0;
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
857 char_O_deco_depth[y] = 0;
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
858 }
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
859 }
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
860 else //---- Straight copy ------------------------------------------------
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
861 {
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
862 overlay unsigned char x;
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
863
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
864 for(x=0; x<32; x++)
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
865 {
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
866 char_O_deco_depth[x] = internal_deco_depth[x];
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
867 char_O_deco_time [x] = internal_deco_time [x];
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
868 }
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
869 }
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
870 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
871
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
872 //////////////////////////////////////////////////////////////////////////////
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
873 // temp_tissue_safety //
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
874 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
875 // outsourced in v.102
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
876 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
877 // Apply safety factors for brand ZH-L16 model.
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
878 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
879 static void temp_tissue_safety(void)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
880 {
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
881 assert( 0.0 < float_desaturation_multiplier && float_desaturation_multiplier <= 1.0 );
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
882 assert( 1.0 <= float_saturation_multiplier && float_saturation_multiplier <= 2.0 );
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
883
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
884 if( char_I_deco_model == 0 )
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
885 {
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
886 if (temp_tissue < 0.0)
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
887 temp_tissue *= float_desaturation_multiplier;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
888 else
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
889 temp_tissue *= float_saturation_multiplier;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
890 }
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
891 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
892
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
893 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
894 //////////////////////////////////////////////////////////////////////////////
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
895 // ** THE JUMP-IN CODE **
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
896 // ** for the asm code **
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
897 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
898 //////////////////////////////////////////////////////////////////////////////
122
3003a8040b78 FIX again reset C data stack and frame pointer when entering C code.
JeanDo
parents: 116
diff changeset
899
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
900 //////////////////////////////////////////////////////////////////////////////
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
901 // Called every 2 seconds during diving.
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
902 // update tissues every time.
184
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
903 //
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
904 // Every 6 seconds (or slower when TTS > 16):
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
905 // - update deco table (char_O_deco_time/depth) with new values.
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
906 // - update ascent time,
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
907 // - set status to zero (so we can check there is new results).
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
908 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
909 void deco_calc_hauptroutine(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
910 {
122
3003a8040b78 FIX again reset C data stack and frame pointer when entering C code.
JeanDo
parents: 116
diff changeset
911 RESET_C_STACK
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
912 calc_hauptroutine();
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
913 int_O_desaturation_time = 65535;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
914 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
915
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
916 //////////////////////////////////////////////////////////////////////////////
184
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
917 // Reset decompression model:
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
918 // + Set all tissues to equilibrium with Air at ambient pressure.
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
919 // + Reset last stop to 0m
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
920 // + Reset all model output.
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
921 void deco_clear_tissue(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
922 {
122
3003a8040b78 FIX again reset C data stack and frame pointer when entering C code.
JeanDo
parents: 116
diff changeset
923 RESET_C_STACK
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
924 clear_tissue();
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
925 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
926
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
927 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
928
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
929 void deco_calc_wo_deco_step_1_min(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
930 {
122
3003a8040b78 FIX again reset C data stack and frame pointer when entering C code.
JeanDo
parents: 116
diff changeset
931 RESET_C_STACK
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
932 calc_wo_deco_step_1_min();
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
933 deco_calc_desaturation_time();
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
934 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
935
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
936 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
937
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
938 void deco_debug(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
939 {
122
3003a8040b78 FIX again reset C data stack and frame pointer when entering C code.
JeanDo
parents: 116
diff changeset
940 RESET_C_STACK
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
941 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
942
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
943
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
944 //////////////////////////////////////////////////////////////////////////////
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
945 // Find current gas in the list (if any).
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
946 //
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
947 // Input: char_I_deco_N2_ratio[] and He, to detect breathed gas.
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
948 //
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
949 // Output: sim_gas_depth_used
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
950 //
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
951 static void gas_switch_find_current(void)
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
952 {
247
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
953 overlay unsigned char j;
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
954 overlay unsigned char N2 = (unsigned char)(N2_ratio * 100 + 0.5);
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
955 overlay unsigned char He = (unsigned char)(He_ratio * 100 + 0.5);
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
956
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
957 for(j=0; j<5; ++j)
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
958 {
247
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
959 // Make sure to detect if we are already breathing some gas in
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
960 // the current list (happends when first gas do have a depth).
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
961 if( N2 == char_I_deco_N2_ratio[j]
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
962 && He == char_I_deco_He_ratio[j]
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
963 )
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
964 {
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
965 temp_depth_limit = sim_gas_last_depth = char_I_deco_gas_change[j];
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
966 sim_gas_last_used = j+1;
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
967 break;
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
968 }
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
969 }
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
970
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
971 // If there is no gas-switch-delay running ?
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
972 if( sim_gas_delay <= sim_dive_mins)
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
973 {
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
974 // Compute current depth:
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
975 overlay unsigned char depth = (unsigned char)((pres_respiration - pres_surface) / 0.09985);
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
976 assert( depth < 130 );
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
977
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
978 // And if I'm above the last decostop (with the 3m margin) ?
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
979 if( (sim_gas_last_depth-3) > depth )
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
980 {
247
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
981 for(j=0; j<5; ++j)
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
982 {
247
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
983 // And If I am in the range of a valide stop ?
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
984 // (again, with the same 3m margin)
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
985 if( char_I_deco_gas_change[j]
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
986 && depth <= char_I_deco_gas_change[j]
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
987 && depth >= (char_I_deco_gas_change[j] - 3)
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
988 )
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
989 {
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
990 // Then start gas-switch timer there,
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
991 sim_gas_delay = sim_dive_mins
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
992 + read_custom_function(55);
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
993
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
994 // And make sure decostop will be recorded at the right depth.
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
995 temp_depth_limit = char_I_deco_gas_change[j];
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
996 break;
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
997 }
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
998 }
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
999 }
247
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1000 else
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1001 // Make clear there is no deay anymore.
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1002 sim_gas_delay = 0;
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1003 }
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1004 }
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1005
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1006 //////////////////////////////////////////////////////////////////////////////
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1007 // Find deepest available gas.
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1008 //
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1009 // Input: temp_depth_limit,
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1010 // deco_gas_change[]
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1011 // sim_gas_delay, sim_gas_depth_used, sim_dive_mins.
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1012 //
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1013 // RETURNS TRUE if a stop is needed for gas switch.
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1014 //
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1015 // Output: temp_depth_limit, sim_gas_delay, sim_gas_depth_used IFF the is a switch.
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1016 //
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1017 // NOTE: might be called from bottom (when sim_gas_delay and sim_gas_depth_used
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1018 // are null), or during the ascent to make sure we are not passing a
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1019 // stop (in which case both can be already set).
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1020 //
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1021 static unsigned char gas_switch_deepest(void)
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1022 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1023 overlay unsigned char switch_deco = 0, switch_last = 0;
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1024
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1025 if (char_I_const_ppO2 == 0)
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1026 {
225
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1027 overlay unsigned char j;
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1028
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1029 // Loop over all enabled gas, to find the deepest one,
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1030 // above las gas, but below temp_depth_limit.
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1031 for(j=0; j<5; ++j)
225
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1032 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1033 // Gas not (yet) allowed ? Skip !
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1034 if( temp_depth_limit > deco_gas_change[j] )
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1035 continue;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1036
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1037 // Gas deeper than the current/previous one ? Skip !
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1038 if( sim_gas_last_depth && deco_gas_change[j] >= sim_gas_last_depth )
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1039 continue;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1040
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1041 // First, or deeper ?
247
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1042 if( switch_deco < deco_gas_change[j] )
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1043 {
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1044 switch_deco = deco_gas_change[j];
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1045 switch_last = j+1;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1046 }
225
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1047 }
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1048 }
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1049
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1050 // If there is a better gas available
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1051 if( switch_deco )
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1052 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1053 assert( !sim_gas_last_depth || sim_gas_last_depth > switch_deco );
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1054
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1055 // Should restart gas-switch delay only when gas do changes...
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1056 assert( sim_gas_delay <= sim_dive_mins );
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1057
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1058 sim_gas_last_depth = switch_deco;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1059 sim_gas_last_used = switch_last;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1060 sim_gas_delay = read_custom_function(55);
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1061
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1062 // Apply depth correction ONLY if CF#55 is not null:
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1063 if( sim_gas_delay > 0 )
225
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1064 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1065 sim_gas_delay += sim_dive_mins;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1066 temp_depth_limit = switch_deco;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1067 return 1;
225
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1068 }
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1069
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1070 return 0;
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1071 }
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1072
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1073 sim_gas_delay = 0;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1074 return 0;
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1075 }
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1076
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1077 //////////////////////////////////////////////////////////////////////////////
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1078 // Calculate gas switches
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1079 //
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1080 //
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1081 // Input: N2_ratio, He_ratio.
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1082 // sim_gas_last_used
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1083 //
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1084 // Output: calc_N2_ratio, calc_He_ratio
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1085 //
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1086 static void gas_switch_set(void)
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1087 {
224
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
1088 assert( 0 <= sim_gas_last_used && sim_gas_last_used <= 5 );
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1089
224
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
1090 if( sim_gas_last_used == 0 )
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
1091 {
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
1092 calc_N2_ratio = N2_ratio;
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
1093 calc_He_ratio = He_ratio;
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
1094 }
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
1095 else
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
1096 {
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
1097 calc_N2_ratio = char_I_deco_N2_ratio[sim_gas_last_used-1] * 0.01;
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
1098 calc_He_ratio = char_I_deco_He_ratio[sim_gas_last_used-1] * 0.01;
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1099 }
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1100
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1101 assert( 0.0 <= calc_N2_ratio && calc_N2_ratio <= 0.95 );
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1102 assert( 0.0 <= calc_He_ratio && calc_He_ratio <= 0.95 );
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1103 assert( (calc_N2_ratio + calc_He_ratio) <= 1.00 );
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1104 }
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1105
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1106 //////////////////////////////////////////////////////////////////////////////
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1107 //
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1108 // Input: calc_N2_ratio, calc_He_ratio : simulated gas mix.
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1109 // temp_deco : simulated respiration pressure + security offset (deco_distance)
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1110 // Water-vapor pressure inside lumbs (ppWVapour).
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1111 //
236
3dbeacf42e9e BUGFIX missing deko init in reboot code.
JeanDo
parents: 235
diff changeset
1112 // Output: ppN2, ppHe.
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1113 //
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1114 static void sim_alveolar_presures(void)
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1115 {
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1116 overlay float deco_diluent = temp_deco; // new in v.101
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1117
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1118 //---- CCR mode : deco gas switch ? --------------------------------------
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1119 if (char_I_const_ppO2 != 0)
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1120 {
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1121 // In CCR mode, calc_XX_ratio == XX_ratio.
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1122 if( temp_deco > deco_ppO2_change )
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1123 deco_diluent = ((temp_deco - const_ppO2)/(calc_N2_ratio + calc_He_ratio));
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1124 else
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1125 deco_diluent = ((temp_deco - deco_ppO2)/(calc_N2_ratio + calc_He_ratio));
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1126
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1127 if (deco_diluent > temp_deco)
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1128 deco_diluent = temp_deco;
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1129 }
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1130
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1131 // Take deco offset into account, but not at surface.
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1132 if( deco_diluent > pres_surface )
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1133 deco_diluent += float_deco_distance;
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1134
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1135 if( deco_diluent > ppWVapour )
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1136 {
236
3dbeacf42e9e BUGFIX missing deko init in reboot code.
JeanDo
parents: 235
diff changeset
1137 ppN2 = calc_N2_ratio * (deco_diluent - ppWVapour);
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1138 ppHe = calc_He_ratio * (deco_diluent - ppWVapour);
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1139 }
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1140 else
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1141 {
236
3dbeacf42e9e BUGFIX missing deko init in reboot code.
JeanDo
parents: 235
diff changeset
1142 ppN2 = 0.0;
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1143 ppHe = 0.0;
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1144 }
236
3dbeacf42e9e BUGFIX missing deko init in reboot code.
JeanDo
parents: 235
diff changeset
1145 assert( 0.0 <= ppN2 && ppN2 < 14.0 );
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1146 assert( 0.0 <= ppHe && ppHe < 14.0 );
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1147 }
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1148
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1149 //////////////////////////////////////////////////////////////////////////////
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1150 // clear_tissue
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1151 //
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
1152 // optimized in v.101 (var_N2_a)
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1153 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1154 // preload tissues with standard pressure for the given ambient pressure.
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1155 // Note: fixed N2_ratio for standard air.
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1156 //
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1157 static void clear_tissue(void)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1158 {
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1159 flag_in_divemode = 0;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1160 int_O_DBS_bitfield = 0;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1161 int_O_DBS2_bitfield = 0;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1162 int_O_DBG_pre_bitfield = 0;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1163 int_O_DBG_post_bitfield = 0;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1164 char_O_NDL_at_20mtr = 255;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1165
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1166 // Kludge: the 0.0002 of 0.7902 are missing with standard air.
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1167 N2_ratio = 0.7902;
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1168 pres_respiration = int_I_pres_respiration * 0.001;
164
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
1169
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1170 for(ci=0; ci<16; ci++)
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1171 {
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1172 // cycle through the 16 Bühlmann tissues
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
1173 overlay float p = N2_ratio * (pres_respiration - ppWVapour);
164
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
1174 pres_tissue[ci] = p;
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1175
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1176 // cycle through the 16 Bühlmann tissues for Helium
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1177 (pres_tissue+16)[ci] = 0.0;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1178 } // for 0 to 16
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1179
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1180 clear_deco_table();
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1181 char_O_deco_status = 0;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1182 char_O_nullzeit = 0;
168
494587193f5d Use 16bits for TTS sum.
JeanDo
parents: 167
diff changeset
1183 int_O_ascenttime = 0;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1184 char_O_gradient_factor = 0;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1185 char_O_relative_gradient_GF = 0;
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1186 char_I_depth_last_deco = 0; // for compatibility with v.101pre_no_last_deco
258
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1187
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1188 calc_lead_tissue_limit = 0.0;
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1189 char_O_gtissue_no = 0;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1190 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1191
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1192 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1193 // calc_hauptroutine
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1194 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1195 // this is the major code in dive mode calculates:
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1196 // the tissues,
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1197 // the bottom time,
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1198 // and simulates the ascend with all deco stops.
171
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1199 //
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1200 // The deco_state sequence is :
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1201 // 3 (at surface)
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1202 // +---> 0 : calc nullzeit
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1203 // | 2 : simulate ascent to first stop (at 10m/min, less that 16x 1min simu)
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1204 // | +-> 1 : simulate up to 16min of stops.
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1205 // | +------< not finished
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1206 // +--------< finish
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1207 //
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1208 static void calc_hauptroutine(void)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1209 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1210 static unsigned char backup_gas_used = 0;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1211 static unsigned char backup_gas_depth = 0;
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1212 static unsigned char backup_gas_delay = 0;
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1213
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1214 calc_hauptroutine_data_input();
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1215
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1216 if(!flag_in_divemode)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1217 {
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1218 flag_in_divemode = 1;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1219 create_dbs_set_dbg_and_ndl20mtr();
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1220 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1221 else
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1222 check_pre_dbg();
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1223
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1224 calc_hauptroutine_update_tissues();
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1225 calc_gradient_factor();
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1226
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1227 // toggle between calculation for nullzeit (bottom time),
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1228 // deco stops
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1229 // and more deco stops (continue)
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1230 switch( char_O_deco_status )
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1231 {
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1232 case 3: //---- At surface: start a new dive ------------------------------
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1233 clear_deco_table();
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1234 copy_deco_table();
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
1235 int_O_ascenttime = 0; // Reset DTR.
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
1236 char_O_nullzeit = 0; // Reset bottom time.
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
1237 char_O_deco_status = 0; // Calc bottom-time/nullzeit next iteration.
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1238
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1239 // Values that should be reset just once for the full real dive.
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1240 // This is used to record the lowest stop for the whole dive,
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1241 // Including ACCROSS all simulated ascent.
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1242 low_depth = 0;
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1243
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1244 // Reset gas switch history.
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1245 backup_gas_used = sim_gas_last_used = 0;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1246 backup_gas_depth = sim_gas_last_depth = 0;
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1247 backup_gas_delay = sim_gas_delay = 0;
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1248 sim_dive_mins = 0;
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1249 break;
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1250
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1251 case 0: //---- bottom time -----------------------------------------------
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1252 calc_nullzeit();
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1253 check_ndl();
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1254 char_O_deco_status = 2; // calc ascent next time.
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1255 break;
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1256
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1257 case 2: //---- Simulate ascent to first stop -----------------------------
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1258 // Check proposed gas at begin of ascent simulation
247
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1259 sim_dive_mins = int_I_divemins; // Init current time.
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1260
247
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1261 gas_switch_find_current(); // Lookup for current gas & time.
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1262 gas_switch_set(); // setup calc_ratio's
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1263
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1264 backup_gas_used = sim_gas_last_used; // And save for later simu steps.
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1265 backup_gas_depth = sim_gas_last_depth; // And save for later simu steps.
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1266 backup_gas_delay = sim_gas_delay;
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1267
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1268 sim_ascent_to_first_stop();
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1269
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1270 char_O_deco_status = 1; // Calc stops next time (deco or gas switch).
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1271 break;
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1272
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1273 case 1: //---- Simulate stops --------------------------------------------
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1274 calc_hauptroutine_calc_deco();
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1275
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1276 // If simulation is finished, restore the GF low reference, so that
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1277 // next ascent simulation is done from the current depth:
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1278 if( char_O_deco_status == 0 )
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1279 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1280 sim_gas_last_used = backup_gas_used;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1281 sim_gas_last_depth = backup_gas_depth;
247
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1282 sim_gas_delay = backup_gas_delay;
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1283 }
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1284 break;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1285 }
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1286
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1287 check_post_dbg();
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1288 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1289
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1290 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1291 // calc_hauptroutine_data_input
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1292 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1293 // Reset all C-code dive parameters from their ASM-code values.
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1294 // Detect gas change condition.
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1295 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1296 void calc_hauptroutine_data_input(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1297 {
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1298 overlay short int_temp;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1299
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1300 pres_respiration = int_I_pres_respiration * 0.001;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1301 pres_surface = int_I_pres_surface * 0.001;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1302 N2_ratio = char_I_N2_ratio * 0.01;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1303 He_ratio = char_I_He_ratio * 0.01;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1304 float_deco_distance = char_I_deco_distance * 0.01; // Get offset is in mbar.
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1305
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1306 // ____________________________________________________
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1307 //
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1308 // _____________ G A S _ C H A N G E S ________________
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1309 // ____________________________________________________
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1310
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1311 // Keep a margin of 150mbar = 1.50m
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1312 int_temp = (int_I_pres_respiration - int_I_pres_surface)
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1313 + MBAR_REACH_GASCHANGE_AUTO_CHANGE_OFF;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1314
225
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1315 deco_gas_change[0] = 0;
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1316 deco_gas_change[1] = 0;
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1317 deco_gas_change[2] = 0;
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1318 deco_gas_change[3] = 0;
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1319 deco_gas_change[4] = 0;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1320
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1321 // Gas are selectable if we did not pass the change depth by more than 1.50m:
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
1322 if(char_I_deco_gas_change[0])
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1323 {
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
1324 if( int_temp > 100 *(short)char_I_deco_gas_change[0] )
225
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1325 deco_gas_change[0] = char_I_deco_gas_change[0];
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1326 }
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
1327 if(char_I_deco_gas_change[1])
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1328 {
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
1329 if( int_temp > 100 *(short)char_I_deco_gas_change[1] )
225
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1330 deco_gas_change[1] = char_I_deco_gas_change[1];
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1331 }
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
1332 if(char_I_deco_gas_change[2])
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1333 {
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
1334 if( int_temp > 100 *(short)char_I_deco_gas_change[2] )
225
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1335 deco_gas_change[2] = char_I_deco_gas_change[2];
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1336 }
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
1337 if(char_I_deco_gas_change[3])
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1338 {
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
1339 if( int_temp > 100 *(short)char_I_deco_gas_change[3] )
225
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1340 deco_gas_change[3] = char_I_deco_gas_change[3];
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1341 }
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
1342 if(char_I_deco_gas_change[4])
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1343 {
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
1344 if( int_temp > 100 *(short)char_I_deco_gas_change[4] )
225
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1345 deco_gas_change[4] = char_I_deco_gas_change[4];
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1346 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1347
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1348 const_ppO2 = char_I_const_ppO2 * 0.01;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1349 deco_ppO2_change = char_I_deco_ppO2_change / 99.95
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1350 + pres_surface
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1351 + float_deco_distance;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1352 deco_ppO2 = char_I_deco_ppO2 * 0.01;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1353 float_desaturation_multiplier = char_I_desaturation_multiplier * 0.01;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1354 float_saturation_multiplier = char_I_saturation_multiplier * 0.01;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1355 GF_low = char_I_GF_Low_percentage * 0.01;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1356 GF_high = char_I_GF_High_percentage * 0.01;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1357 GF_delta = GF_high - GF_low;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1358 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1359
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1360 //////////////////////////////////////////////////////////////////////////////
171
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1361 //
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1362 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1363 void calc_hauptroutine_update_tissues(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1364 {
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1365 assert( 0.00 <= N2_ratio && N2_ratio <= 1.00 );
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1366 assert( 0.00 <= He_ratio && He_ratio <= 1.00 );
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1367 assert( (N2_ratio + He_ratio) <= 0.95 );
237
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
1368 assert( 0.800 < pres_respiration && pres_respiration < 14.0 );
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1369
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1370 if (char_I_const_ppO2 == 0) // new in v.101
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1371 pres_diluent = pres_respiration; // new in v.101
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1372 else
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1373 {
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1374 pres_diluent = ((pres_respiration - const_ppO2)/(N2_ratio + He_ratio)); // new in v.101
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1375 if (pres_diluent > pres_respiration) // new in v.101
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1376 pres_diluent = pres_respiration; // new in v.101
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1377 }
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
1378 if (pres_diluent > ppWVapour) // new in v.101
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1379 {
236
3dbeacf42e9e BUGFIX missing deko init in reboot code.
JeanDo
parents: 235
diff changeset
1380 ppN2 = N2_ratio * (pres_diluent - ppWVapour); // changed in v.101
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
1381 ppHe = He_ratio * (pres_diluent - ppWVapour); // changed in v.101
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1382 char_O_diluent = (char)(pres_diluent/pres_respiration*100.0);
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1383 }
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1384 else // new in v.101
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1385 {
236
3dbeacf42e9e BUGFIX missing deko init in reboot code.
JeanDo
parents: 235
diff changeset
1386 ppN2 = 0.0; // new in v.101
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
1387 ppHe = 0.0; // new in v.101
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1388 char_O_diluent = 0;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1389 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1390
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1391 if(!char_I_step_is_1min)
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1392 calc_tissue(0);
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1393 else
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1394 calc_tissue(1);
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1395
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1396 // Calc limit for surface, ie. GF_high.
258
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1397 calc_limit();
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1398
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1399 int_O_gtissue_limit = (short)(calc_lead_tissue_limit * 1000);
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1400 int_O_gtissue_press = (short)((pres_tissue[char_O_gtissue_no] + (pres_tissue+16)[char_O_gtissue_no]) * 1000);
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1401
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1402 // if guiding tissue can not be exposed to surface pressure immediately
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1403 if( calc_lead_tissue_limit > pres_surface && char_O_deco_status == 0)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1404 {
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1405 char_O_nullzeit = 0; // deco necessary
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1406 char_O_deco_status = 2; // calculate ascent on next iteration.
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1407 }
171
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1408 }
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1409
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1410
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1411 //////////////////////////////////////////////////////////////////////////////
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1412 // Compute stops.
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1413 //
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1414 // Note: because this can be very long, break on 16 iterations, and set state
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1415 // to 0 when finished, or to 1 when needing to continue.
257
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
1416 // Note: because this might be very long (~ 66 ms by iteration in 1.84beta),
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
1417 // break the loop when total time > 512msec.
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1418 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1419 void calc_hauptroutine_calc_deco(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1420 {
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1421 overlay unsigned char loop;
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1422
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1423 for(loop = 0; loop < 16; ++loop)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1424 {
257
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
1425 // Limit loops to 512ms, using the RTC timer 3:
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
1426 if( tmr3() & (512*32) )
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
1427 break;
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
1428
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1429 // Do not ascent while doing a gas switch ?
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1430 if( sim_gas_delay <= sim_dive_mins )
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1431 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1432 if( calc_nextdecodepth() )
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1433 {
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1434 if( temp_depth_limit == 0 )
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1435 goto Surface;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1436
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1437 //---- We hit a stop at temp_depth_limit ---------------------
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1438 temp_deco = temp_depth_limit * 0.09985 // Convert to relative bar,
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1439 + pres_surface; // To absolute.
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1440 update_deco_table(); // Adds a one minute stops.
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1441 }
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1442 else
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1443 {
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1444 //---- No stop -----------------------------------------------
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1445 temp_deco -= 0.9985; // Ascend 10m, no wait.
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1446
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1447 //---- Finish computations once surface is reached -----------
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1448 if( temp_deco <= pres_surface )
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1449 {
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1450 Surface:
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1451 copy_deco_table();
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1452 calc_ascenttime();
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1453 char_O_deco_status = 0; // calc nullzeit next time.
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1454 return;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1455 }
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1456 }
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1457 }
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1458 else
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1459 update_deco_table(); // Just pass one minute.
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1460
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1461 //---- Then update tissue --------------------------------------------
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1462 sim_dive_mins++; // Advance simulated time by 1 minute.
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1463 gas_switch_set(); // Apply any simulated gas change, once validated.
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1464 sim_alveolar_presures(); // Updates ppN2 and ppHe.
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1465 sim_tissue(1); // Simulate compartiments for 1 minute.
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1466 }
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1467
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1468 // Surface not reached, need more stops...
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1469 char_O_deco_status = 1; // calc more stops next time.
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1470 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1471
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1472 //////////////////////////////////////////////////////////////////////////////
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1473 // Simulation ascention to first deco stop.
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1474 //
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1475 // Note: because we ascent with a constant speed (10m/mn, ie. 1bar/mn),
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1476 // there is no need to break on more that 16 iterations
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1477 // (or we are already in deep shit).
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1478 //
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1479 void sim_ascent_to_first_stop(void)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1480 {
171
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1481 update_startvalues();
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1482 clear_deco_table();
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1483
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
1484 temp_deco = pres_respiration; // Starts from current real depth.
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1485
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1486 // Do we have a gas switch going on ?
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1487 if( sim_gas_delay > sim_dive_mins )
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1488 return;
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1489
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1490 //---- Loop until first stop, gas switch, or surface is reached ----------
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1491 for(;;)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1492 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1493 // Try ascending 1 full minute.
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1494 temp_deco -= 0.9985; // 1 min, at 10m/min. ~ 1bar.
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1495
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1496 // Compute sim_lead_tissue_limit at GF_low (deepest stop).
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1497 sim_limit(GF_low);
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1498
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1499 // Did we reach deepest remaining stop ?
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1500 if( temp_deco < sim_lead_tissue_limit )
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1501 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1502 temp_deco += 0.9985; // Restore last correct depth,
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1503 break; // End fast ascent.
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1504 }
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1505
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1506 // Did we reach surface ?
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1507 if( temp_deco <= pres_surface )
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1508 {
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1509 temp_deco = pres_surface; // Yes: finished !
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1510 break;
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1511 }
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1512
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1513 // Check for gas change below new depth ?
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1514 temp_depth_limit = (temp_deco - pres_surface) / 0.09985;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1515
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1516 if( gas_switch_deepest() )
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1517 {
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1518 temp_deco = temp_depth_limit * 0.09985 + pres_surface;
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1519 break;
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1520 }
171
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1521
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1522 sim_dive_mins++; // Advance simulated time by 1 minute.
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1523 sim_alveolar_presures(); // temp_deco --> ppN2/ppHe
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1524 sim_tissue(1); // and update tissues for 1 min.
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1525 }
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1526 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1527
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1528 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1529 // calc_tissue
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1530 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1531 // optimized in v.101
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1532 //
184
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
1533 static void calc_tissue(PARAMETER unsigned char period)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1534 {
251
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
1535 assert( 0.00 <= ppN2 && ppN2 < 11.2 ); // 80% N2 at 130m
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
1536 assert( 0.00 <= ppHe && ppHe < 12.6 ); // 90% He at 130m
236
3dbeacf42e9e BUGFIX missing deko init in reboot code.
JeanDo
parents: 235
diff changeset
1537
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1538 for (ci=0;ci<16;ci++)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1539 {
258
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1540 read_buhlmann_times(period); // 2 sec or 1 min period.
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1541
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1542 // N2
236
3dbeacf42e9e BUGFIX missing deko init in reboot code.
JeanDo
parents: 235
diff changeset
1543 temp_tissue = (ppN2 - pres_tissue[ci]) * var_N2_e;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1544 temp_tissue_safety();
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1545 pres_tissue[ci] += temp_tissue;
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
1546
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1547 // He
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
1548 temp_tissue = (ppHe - (pres_tissue+16)[ci]) * var_He_e;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1549 temp_tissue_safety();
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1550 (pres_tissue+16)[ci] += temp_tissue;
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1551 }
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1552 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1553
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1554 //////////////////////////////////////////////////////////////////////////////
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1555 // calc_limit
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1556 //
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1557 // New in v.111 : separated from calc_tissue(), and depends on GF value.
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1558 //
258
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1559 static void calc_limit(void)
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1560 {
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1561 char_O_gtissue_no = 255;
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1562 calc_lead_tissue_limit = 0.0;
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1563
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1564 for (ci=0;ci<16;ci++)
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1565 {
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1566 overlay float p = pres_tissue[ci] + (pres_tissue+16)[ci];
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1567
258
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1568 read_buhlmann_coefficients();
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1569 var_N2_a = (var_N2_a * pres_tissue[ci] + var_He_a * (pres_tissue+16)[ci]) / p;
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1570 var_N2_b = (var_N2_b * pres_tissue[ci] + var_He_b * (pres_tissue+16)[ci]) / p;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1571
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1572 // Apply the Eric Baker's varying gradient factor correction.
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1573 // Note: the correction factor depends both on GF and b,
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1574 // Actual values are in the 1.5 .. 1.0 range (for a GF=30%),
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1575 // so that can change who is the leading gas...
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1576 // Note: Also depends of the GF. So the calcul is different for
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1577 // GF_low, current GF, or GF_high...
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1578 // *BUT* calc_tissue() is used to compute bottom time,
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1579 // hence what would happend at surface,
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1580 // hence at GF_high.
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1581 if( char_I_deco_model == 1 )
258
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1582 p = ( p - var_N2_a * GF_high) * var_N2_b
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1583 / (GF_high + var_N2_b * (1.0 - GF_high));
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1584 else
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1585 p = (p - var_N2_a) * var_N2_b;
258
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1586 if( p < 0.0 ) p = 0.0;
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1587
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1588 if( p > calc_lead_tissue_limit )
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1589 {
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1590 char_O_gtissue_no = ci;
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1591 calc_lead_tissue_limit = p;
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1592 }
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1593 }
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1594
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1595 assert( char_O_gtissue_no < 16 );
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1596 assert( 0.0 <= calc_lead_tissue_limit && calc_lead_tissue_limit <= 14.0);
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1597 }
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1598
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1599 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1600 // calc_nullzeit
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1601 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1602 // calculates the remaining bottom time
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1603 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1604 // unchanged in v.101
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1605 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1606 static void calc_nullzeit(void)
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1607 {
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1608 overlay unsigned char loop;
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
1609 update_startvalues();
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1610
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1611 char_O_nullzeit = 0;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1612 for(loop = 1; loop <= 17; loop++)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1613 {
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1614 backup_sim_pres_tissue();
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1615 sim_tissue(2); // 10 min.
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1616 sim_limit(GF_high);
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1617
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1618 if( sim_lead_tissue_limit > pres_surface ) // changed in v.102 , if guiding tissue can not be exposed to surface pressure immediately
185
ae3a83982ab2 BUGFIX NDL blocked to 11' (bb #9)
JeanDo
parents: 184
diff changeset
1619 {
ae3a83982ab2 BUGFIX NDL blocked to 11' (bb #9)
JeanDo
parents: 184
diff changeset
1620 restore_sim_pres_tissue();
ae3a83982ab2 BUGFIX NDL blocked to 11' (bb #9)
JeanDo
parents: 184
diff changeset
1621 break;
ae3a83982ab2 BUGFIX NDL blocked to 11' (bb #9)
JeanDo
parents: 184
diff changeset
1622 }
ae3a83982ab2 BUGFIX NDL blocked to 11' (bb #9)
JeanDo
parents: 184
diff changeset
1623 // Validate once we know its good.
ae3a83982ab2 BUGFIX NDL blocked to 11' (bb #9)
JeanDo
parents: 184
diff changeset
1624 char_O_nullzeit += 10;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1625 }
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1626
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1627 if (char_O_nullzeit < 60)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1628 {
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1629 for(loop=1; loop <= 10; loop++)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1630 {
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1631 sim_tissue(1); // 1 min
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1632 sim_limit(GF_high);
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1633
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1634 if( sim_lead_tissue_limit > pres_surface) // changed in v.102 , if guiding tissue can not be exposed to surface pressure immediately
185
ae3a83982ab2 BUGFIX NDL blocked to 11' (bb #9)
JeanDo
parents: 184
diff changeset
1635 break;
ae3a83982ab2 BUGFIX NDL blocked to 11' (bb #9)
JeanDo
parents: 184
diff changeset
1636 char_O_nullzeit++;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1637 }
185
ae3a83982ab2 BUGFIX NDL blocked to 11' (bb #9)
JeanDo
parents: 184
diff changeset
1638 }
ae3a83982ab2 BUGFIX NDL blocked to 11' (bb #9)
JeanDo
parents: 184
diff changeset
1639 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1640
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1641 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1642 // backup_sim_pres_tissue
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1643 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1644 void backup_sim_pres_tissue(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1645 {
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1646 overlay unsigned char x;
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1647
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1648 for(x = 0; x<32; x++)
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1649 sim_pres_tissue_backup[x] = sim_pres_tissue[x];
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1650 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1651
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1652 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1653 // restore_sim_pres_tissue
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1654 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1655 void restore_sim_pres_tissue(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1656 {
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1657 overlay unsigned char x;
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1658
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1659 for(x = 0; x<32; x++)
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1660 sim_pres_tissue[x] = sim_pres_tissue_backup[x];
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1661 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1662
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1663 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1664 // calc_ascenttime
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1665 //
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1666 static void calc_ascenttime(void)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1667 {
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1668 if (pres_respiration > pres_surface)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1669 {
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1670 overlay unsigned char x;
168
494587193f5d Use 16bits for TTS sum.
JeanDo
parents: 167
diff changeset
1671
275
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
1672 // + 0.7 to count 1 minute ascent time from 3 metre to surface
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1673 overlay float ascent = pres_respiration - pres_surface + 0.7;
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1674 if (ascent < 0.0)
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1675 ascent = 0.0;
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1676 int_O_ascenttime = (unsigned short)(ascent + 0.99);
168
494587193f5d Use 16bits for TTS sum.
JeanDo
parents: 167
diff changeset
1677
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1678 for(x=0; x<32 && internal_deco_depth[x]; x++)
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1679 int_O_ascenttime += (unsigned short)internal_deco_time[x];
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1680 }
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1681 else
168
494587193f5d Use 16bits for TTS sum.
JeanDo
parents: 167
diff changeset
1682 int_O_ascenttime = 0;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1683 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1684
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1685 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1686 // update_startvalues
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1687 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1688 // updated in v.102
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1689 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1690 void update_startvalues(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1691 {
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1692 overlay unsigned char x;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1693
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1694 // Start ascent simulation with current tissue partial pressures.
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1695 for (x = 0;x<16;x++)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1696 {
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1697 sim_pres_tissue[x] = pres_tissue[x];
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1698 (sim_pres_tissue+16)[x] = (pres_tissue+16)[x];
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1699 }
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1700
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1701 // No leading tissue (yet) for this ascent simulation.
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1702 sim_lead_tissue_limit = 0.0;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1703 sim_lead_tissue_no = 255;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1704 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1705
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1706 //////////////////////////////////////////////////////////////////////////////
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1707 // sim_tissue
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1708 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1709 // optimized in v.101
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1710 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1711 // Function very simular to calc_tissue, but:
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1712 // + Use a 1min or 10min period.
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1713 // + Do it on sim_pres_tissue, instead of pres_tissue.
184
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
1714 static void sim_tissue(PARAMETER unsigned char period)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1715 {
251
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
1716 assert( 0.00 <= ppN2 && ppN2 < 11.2 ); // 80% N2 at 130m
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
1717 assert( 0.00 <= ppHe && ppHe < 12.6 ); // 90% He at 130m
236
3dbeacf42e9e BUGFIX missing deko init in reboot code.
JeanDo
parents: 235
diff changeset
1718
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1719 for(ci=0; ci<16; ci++)
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1720 {
258
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1721 read_buhlmann_times(period); // 1 or 10 minute(s) interval
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
1722
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1723 // N2
236
3dbeacf42e9e BUGFIX missing deko init in reboot code.
JeanDo
parents: 235
diff changeset
1724 temp_tissue = (ppN2 - sim_pres_tissue[ci]) * var_N2_e;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1725 temp_tissue_safety();
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1726 sim_pres_tissue[ci] += temp_tissue;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1727
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1728 // He
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
1729 temp_tissue = (ppHe - (sim_pres_tissue+16)[ci]) * var_He_e;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1730 temp_tissue_safety();
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1731 (sim_pres_tissue+16)[ci] += temp_tissue;
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1732 }
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1733 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1734
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1735 //////////////////////////////////////////////////////////////////////////////
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1736 // sim_limit()
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1737 //
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1738 // New in v.111
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1739 //
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1740 // Function separated from sim_tissue() to allow recomputing limit on
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1741 // different depth, because it depends on current gradient factor.
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1742 //
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1743 static void sim_limit(PARAMETER float GF_current)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1744 {
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1745 assert( 0.0 < GF_current && GF_current <= 1.0f);
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1746
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1747 sim_lead_tissue_limit = 0.0;
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1748 sim_lead_tissue_no = 0; // If no one is critic, keep first tissue.
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1749
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1750 for(ci=0; ci<16; ci++)
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1751 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1752 overlay float N2 = sim_pres_tissue[ci];
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1753 overlay float He = (sim_pres_tissue+16)[ci];
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1754 overlay float p = N2 + He;
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1755
258
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1756 read_buhlmann_coefficients();
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1757 var_N2_a = (var_N2_a * N2 + var_He_a * He) / p;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1758 var_N2_b = (var_N2_b * N2 + var_He_b * He) / p;
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1759
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1760 // Apply the Eric Baker's varying gradient factor correction.
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1761 // Note: the correction factor depends both on GF and b,
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1762 // Actual values are in the 1.5 .. 1.0 range (for a GF=30%),
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1763 // so that can change who is the leading gas...
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1764 // Note: Also depends of the GF_current...
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1765 if( char_I_deco_model == 1 )
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1766 p = ( p - var_N2_a * GF_current) * var_N2_b
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1767 / (GF_current + var_N2_b * (1.0 - GF_current));
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1768 else
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1769 p = (p - var_N2_a) * var_N2_b;
237
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
1770 if( p < 0.0 ) p = 0.0;
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1771
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1772 if( p > sim_lead_tissue_limit )
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1773 {
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1774 sim_lead_tissue_no = ci;
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1775 sim_lead_tissue_limit = p;
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1776 }
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1777 } // for ci
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1778
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1779 assert( sim_lead_tissue_no < 16 );
237
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
1780 assert( 0.0 <= sim_lead_tissue_limit && sim_lead_tissue_limit <= 14.0 );
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1781 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1782
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1783 //////////////////////////////////////////////////////////////////////////////
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1784 // clear_deco_table
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1785 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1786 // unchanged in v.101
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1787 //
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1788 static void clear_deco_table(void)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1789 {
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1790 overlay unsigned char x;
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1791
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1792 for(x=0; x<32; ++x)
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1793 {
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1794 internal_deco_time [x] = 0;
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1795 internal_deco_depth[x] = 0;
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1796 }
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1797 }
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1798
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1799 //////////////////////////////////////////////////////////////////////////////
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1800 // update_deco_table
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1801 //
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1802 // Add 1 min to current stop.
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1803 //
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1804 // Inputs:
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1805 // temp_depth_limit = stop's depth, in meters.
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1806 // In/Out:
275
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
1807 // internal_deco_depth[] : depth (in metres) of each stops.
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1808 // internal_deco_time [] : time (in minutes) of each stops.
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1809 //
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1810 static void update_deco_table()
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1811 {
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1812 overlay unsigned char x;
247
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1813 assert( temp_depth_limit < 128 ); // Can't be negativ (overflown).
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1814 assert( temp_depth_limit > 0 ); // No stop at surface...
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1815
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1816 for(x=0; x<32; ++x)
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1817 {
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1818 // Make sure deco-stops are recorded in order:
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1819 assert( !internal_deco_depth[x] || temp_depth_limit <= internal_deco_depth[x] );
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1820
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
1821 if( internal_deco_depth[x] == temp_depth_limit )
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1822 {
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1823 // Do not overflow (max 255')
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1824 if( internal_deco_time[x] < 255 )
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1825 {
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1826 internal_deco_time[x]++;
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1827 return;
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1828 }
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1829 // But store extra in the next stop...
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1830 }
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1831
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1832 if( internal_deco_depth[x] == 0 )
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1833 {
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1834 internal_deco_depth[x] = temp_depth_limit;
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1835 internal_deco_time[x] = 1;
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1836 return;
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1837 }
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1838 }
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1839
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1840 // Can't store stops at more than 96m.
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1841 // Or stops at less that 3m too.
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1842 // Just do nothing with that...
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1843 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1844
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1845 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1846 // calc_gradient_factor
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1847 //
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
1848 // optimized in v.101 (var_N2_a)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1849 // new code in v.102
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1850 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1851 static void calc_gradient_factor(void)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1852 {
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1853 overlay float gf;
237
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
1854
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1855 assert( char_O_gtissue_no < 16 );
237
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
1856 assert( 0.800 <= pres_respiration && pres_respiration < 14.0 );
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1857
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1858 // tissue > respiration (entsaettigungsvorgang)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1859 // gradient ist wieviel prozent an limit mit basis tissue
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1860 // dh. 0% = respiration == tissue
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1861 // dh. 100% = respiration == limit
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1862 temp_tissue = pres_tissue[char_O_gtissue_no] + (pres_tissue+16)[char_O_gtissue_no];
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1863 if( temp_tissue < pres_respiration )
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1864 gf = 0.0;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1865 else
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1866 {
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1867 gf = (temp_tissue - pres_respiration)
258
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1868 / (temp_tissue - calc_lead_tissue_limit)
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1869 * 100.0;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1870 if( gf > 255.0 ) gf = 255.0;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1871 if( gf < 0.0 ) gf = 0.0;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1872 }
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1873 char_O_gradient_factor = (unsigned char)gf;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1874
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1875 if (char_I_deco_model == 1) // calculate relative gradient factor
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1876 {
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1877 overlay float rgf;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1878
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1879 if( low_depth == 0 )
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1880 rgf = GF_high;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1881 else
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1882 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1883 overlay float temp1 = low_depth * 0.09985;
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1884 overlay float temp2 = pres_respiration - pres_surface;
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1885
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1886 if (temp2 <= 0)
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1887 rgf = GF_high;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1888 else if (temp2 >= temp1)
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1889 rgf = GF_low;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1890 else
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1891 rgf = GF_low + (temp1 - temp2)/temp1*GF_delta;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1892 }
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1893
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1894 rgf = gf / rgf; // gf is already in percent
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1895 if( rgf < 0.0 ) rgf = 0.0;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1896 if( rgf > 255.0 ) rgf = 255.0;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1897 char_O_relative_gradient_GF = (unsigned char)rgf;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1898 } // calc relative gradient factor
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1899 else
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1900 {
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1901 char_O_relative_gradient_GF = char_O_gradient_factor;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1902 }
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1903 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1904
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1905 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1906 // deco_calc_desaturation_time
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1907 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1908 // FIXED N2_ratio
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1909 // unchanged in v.101
233
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
1910 // Inputs: int_I_pres_surface, ppWVapour, char_I_desaturation_multiplier
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
1911 // Outputs: int_O_desaturation_time, char_O_tissue_saturation[0..31]
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1912 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1913 void deco_calc_desaturation_time(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1914 {
122
3003a8040b78 FIX again reset C data stack and frame pointer when entering C code.
JeanDo
parents: 116
diff changeset
1915 RESET_C_STACK
3003a8040b78 FIX again reset C data stack and frame pointer when entering C code.
JeanDo
parents: 116
diff changeset
1916
233
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
1917 assert( 800 < int_I_pres_surface && int_I_pres_surface < 1100 );
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
1918 assert( 0 < char_I_desaturation_multiplier && char_I_desaturation_multiplier <= 100 );
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
1919
260
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1920 #ifndef CROSS_COMPILE
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1921 // Note: we don't use far rom pointer, because the
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1922 // 24 bits is to complex, hence we have to set
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1923 // the UPPER page ourself...
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1924 // --> Set zero if tables are moved to lower pages !
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1925 _asm
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1926 movlw 1
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1927 movwf TBLPTRU,0
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1928 _endasm
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1929 #endif
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1930
237
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
1931 N2_ratio = 0.7902; // FIXED sum as stated in bühlmann
233
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
1932 pres_surface = int_I_pres_surface * 0.001;
236
3dbeacf42e9e BUGFIX missing deko init in reboot code.
JeanDo
parents: 235
diff changeset
1933 ppN2 = N2_ratio * (pres_surface - ppWVapour);
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1934 int_O_desaturation_time = 0;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1935 float_desaturation_multiplier = char_I_desaturation_multiplier / 142.0; // new in v.101 (70,42%/100.=142)
233
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
1936
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1937 for (ci=0;ci<16;ci++)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1938 {
251
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
1939 overlay unsigned short desat_time; // For a particular compartiment, in min.
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
1940 overlay float temp1;
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
1941 overlay float temp2;
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
1942 overlay float temp3;
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
1943 overlay float temp4;
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
1944
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1945 // saturation_time (for flight) and N2_saturation in multiples of halftime
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1946 // version v.100: 1.1 = 10 percent distance to totally clean (totally clean is not possible, would take infinite time )
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1947 // new in version v.101: 1.07 = 7 percent distance to totally clean (totally clean is not possible, would take infinite time )
260
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1948 // changes in v.101: 1.05 = 5 percent dist to totally clean is new desaturation point for display and NoFly calculations
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1949 // N2
260
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1950 temp1 = 1.05 * ppN2 - pres_tissue[ci];
236
3dbeacf42e9e BUGFIX missing deko init in reboot code.
JeanDo
parents: 235
diff changeset
1951 temp2 = ppN2 - pres_tissue[ci];
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1952 if (temp2 >= 0.0)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1953 {
233
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
1954 temp1 = 0.0;
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
1955 temp2 = 0.0;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1956 }
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1957 else
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1958 temp1 = temp1 / temp2;
251
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
1959 if( 0.0 < temp1 && temp1 < 1.0 )
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1960 {
260
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1961 overlay float var_N2_halftime = buhlmann_ht[ci];
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1962 assert( 4.0 <= var_N2_halftime && var_N2_halftime <= 635.0 );
252
8b252ff2eded Bug bb13 : strange failling assertion...
JeanDo
parents: 251
diff changeset
1963
260
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1964 // 0.6931 is ln(2), because the math function log() calculates with a base of e not 2 as requested.
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1965 // minus because log is negative.
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1966 temp1 = log(1.0 - temp1) / -0.6931; // temp1 is the multiples of half times necessary.
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1967 temp2 = var_N2_halftime * temp1 / float_desaturation_multiplier; // time necessary (in minutes ) for complete desaturation (see comment about 5 percent) , new in v.101: float_desaturation_multiplier
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1968
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1969 }
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1970 else
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1971 {
233
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
1972 temp1 = 0.0;
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
1973 temp2 = 0.0;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1974 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1975
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1976 // He
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1977 temp3 = 0.1 - (pres_tissue+16)[ci];
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1978 if (temp3 >= 0.0)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1979 {
233
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
1980 temp3 = 0.0;
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
1981 temp4 = 0.0;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1982 }
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1983 else
260
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1984 temp3 = - temp3 / (pres_tissue+16)[ci];
251
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
1985 if( 0.0 < temp3 && temp3 < 1.0 )
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1986 {
260
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1987 overlay float var_He_halftime = (buhlmann_ht+16)[ci];
261
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
1988 assert( 1.51 <= var_He_halftime && var_He_halftime <= 240.03 );
260
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1989
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1990 temp3 = log(1.0 - temp3) / -0.6931; // temp1 is the multiples of half times necessary.
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1991 // 0.6931 is ln(2), because the math function log() calculates with a base of e not 2 as requested.
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1992 // minus because log is negative
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
1993 temp4 = var_He_halftime * temp3 / float_desaturation_multiplier; // time necessary (in minutes ) for "complete" desaturation, new in v.101 float_desaturation_multiplier
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1994 }
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1995 else
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1996 {
233
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
1997 temp3 = 0.0;
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
1998 temp4 = 0.0;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1999 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2000
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2001 // saturation_time (for flight)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2002 if (temp4 > temp2)
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
2003 desat_time = (unsigned short)temp4;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2004 else
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
2005 desat_time = (unsigned short)temp2;
252
8b252ff2eded Bug bb13 : strange failling assertion...
JeanDo
parents: 251
diff changeset
2006
251
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
2007 if(desat_time > int_O_desaturation_time)
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
2008 int_O_desaturation_time = desat_time;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2009
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2010 // N2 saturation in multiples of halftime for display purposes
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2011 temp2 = temp1 * 20.0; // 0 = 1/8, 120 = 0, 249 = 8
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2012 temp2 = temp2 + 80.0; // set center
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2013 if (temp2 < 0.0)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2014 temp2 = 0.0;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2015 if (temp2 > 255.0)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2016 temp2 = 255.0;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2017 char_O_tissue_saturation[ci] = (char)temp2;
233
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
2018
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2019 // He saturation in multiples of halftime for display purposes
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2020 temp4 = temp3 * 20.0; // 0 = 1/8, 120 = 0, 249 = 8
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2021 temp4 = temp4 + 80.0; // set center
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2022 if (temp4 < 0.0)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2023 temp4 = 0.0;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2024 if (temp4 > 255.0)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2025 temp4 = 255.0;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2026 (char_O_tissue_saturation+16)[ci] = (char)temp4;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2027 } // for
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2028 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2029
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2030 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2031 // calc_wo_deco_step_1_min
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2032 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2033 // FIXED N2 Ratio
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2034 // optimized in v.101 (...saturation_multiplier)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2035 // desaturation slowed down to 70,42%
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2036 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2037 static void calc_wo_deco_step_1_min(void)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2038 {
251
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
2039 assert( 800 < int_I_pres_surface && int_I_pres_surface < 1100 );
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
2040 assert( 800 < int_I_pres_respiration && int_I_pres_respiration < 1100 );
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
2041 assert( 100 <= char_I_saturation_multiplier && char_I_saturation_multiplier < 200 );
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
2042 assert( 0 < char_I_desaturation_multiplier && char_I_desaturation_multiplier <= 100 );
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
2043
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2044 if(flag_in_divemode)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2045 {
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2046 flag_in_divemode = 0;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2047 set_dbg_end_of_dive();
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2048 }
122
3003a8040b78 FIX again reset C data stack and frame pointer when entering C code.
JeanDo
parents: 116
diff changeset
2049
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2050 N2_ratio = 0.7902; // FIXED, sum lt. buehlmann
233
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
2051 pres_respiration = int_I_pres_respiration * 0.001; // assembler code uses different digit system
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
2052 pres_surface = int_I_pres_surface * 0.001; // the b"uhlmann formula using pres_surface does not use the N2_ratio
236
3dbeacf42e9e BUGFIX missing deko init in reboot code.
JeanDo
parents: 235
diff changeset
2053 ppN2 = N2_ratio * (pres_respiration - ppWVapour); // ppWVapour is the extra pressure in the body
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
2054 ppHe = 0.0;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2055 float_desaturation_multiplier = char_I_desaturation_multiplier / 142.0; // new in v.101 (70,42%/100.=142)
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
2056 float_saturation_multiplier = char_I_saturation_multiplier * 0.01;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2057
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
2058 calc_tissue(1); // update the pressure in the 32 tissues in accordance with the new ambient pressure
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2059
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
2060 clear_deco_table();
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
2061 char_O_deco_status = 3; // surface new in v.102 : stays in surface state.
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2062 char_O_nullzeit = 0;
168
494587193f5d Use 16bits for TTS sum.
JeanDo
parents: 167
diff changeset
2063 int_O_ascenttime = 0;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2064 calc_gradient_factor();
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2065 }
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2066
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2067 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2068 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2069 ////////////////////////////////// deco_hash /////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2070 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2071 //////////////////////////////////////////////////////////////////////////////
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2072
184
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
2073 #ifndef CROSS_COMPILE
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2074 void deco_hash(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2075 {
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2076 overlay unsigned char md_i, md_j; // Loop index.
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2077 overlay unsigned char md_t;
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2078 overlay unsigned char md_buffer[16];
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2079 overlay unsigned char md_temp;
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
2080 overlay unsigned short md_pointer;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2081
122
3003a8040b78 FIX again reset C data stack and frame pointer when entering C code.
JeanDo
parents: 116
diff changeset
2082 RESET_C_STACK
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2083
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2084 // init
164
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
2085 for(md_i=0;md_i<16;md_i++)
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2086 {
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2087 md_state[md_i] = 0;
164
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
2088 char_O_hash[md_i] = 0;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2089 } // for md_i 16
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2090
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2091 _asm
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2092 movlw 0x01 // md_pi address.
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2093 movwf TBLPTRU,0
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2094 movlw 0x7E
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2095 movwf TBLPTRH,0
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2096 movlw 0x00
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2097 movwf TBLPTRL,0
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2098 _endasm;
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
2099 md_i = 0;
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
2100 do {
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2101 _asm
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2102 TBLRDPOSTINC
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2103 movff TABLAT,md_temp
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2104 _endasm
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
2105 md_pi_subst[md_i++] = md_temp;
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
2106 } while( md_i != 0 );
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
2107
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2108 _asm
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2109 movlw 0x00
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2110 movwf TBLPTRU,0
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2111 movlw 0x00
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2112 movwf TBLPTRH,0
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2113 movlw 0x00
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2114 movwf TBLPTRL,0
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2115 _endasm
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2116
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2117 // cycle buffers
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2118 for (md_pointer=0x0000;md_pointer<0x17f3;md_pointer++)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2119 {
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2120 md_t = 0;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2121 for (md_i=0;md_i<16;md_i++)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2122 {
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2123 if(md_pointer == 9)
164
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
2124 md_temp = char_O_hash[md_i];
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2125 else
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2126 {
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2127 _asm
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2128 TBLRDPOSTINC
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2129 movff TABLAT,md_temp
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2130 _endasm
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2131 } // else
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2132
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2133 md_buffer[md_i] = md_temp;
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
2134 md_state[md_i+16] = md_temp;
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
2135 md_state[md_i+32] = (unsigned char)(md_temp ^ md_state[md_i]);
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2136 } // for md_i 16
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2137
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2138 for (md_i=0;md_i<18;md_i++)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2139 {
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2140 for (md_j=0;md_j<48;md_j++)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2141 {
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2142 md_state[md_j] ^= md_pi_subst[md_t];
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2143 md_t = md_state[md_j];
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2144 } // for md_j 48
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2145 md_t = (unsigned char)(md_t+1);
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2146 } // for md_i 18
164
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
2147 md_t = char_O_hash[15];
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2148
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2149 for (md_i=0;md_i<16;md_i++)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2150 {
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2151 char_O_hash[md_i] ^= md_pi_subst[(md_buffer[md_i] ^ md_t)];
164
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
2152 md_t = char_O_hash[md_i];
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2153 } // for md_i 16
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2154 } // for md_pointer
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2155 } // void deco_hash(void)
184
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
2156 #endif
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2157
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2158 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2159 // deco_clear_CNS_fraction
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2160 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2161 // new in v.101
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2162 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2163 void deco_clear_CNS_fraction(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2164 {
122
3003a8040b78 FIX again reset C data stack and frame pointer when entering C code.
JeanDo
parents: 116
diff changeset
2165 RESET_C_STACK
237
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
2166
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2167 CNS_fraction = 0.0;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2168 char_O_CNS_fraction = 0;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2169 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2170
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2171 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2172 // deco_calc_CNS_fraction
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2173 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2174 // new in v.101
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2175 // optimized in v.102 : with new variables char_I_actual_ppO2 and actual_ppO2
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2176 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2177 // Input: char_I_actual_ppO2
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2178 // Output: char_O_CNS_fraction
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2179 // Uses and Updates: CNS_fraction
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2180 // Uses: acutal_ppO2
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2181 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2182 void deco_calc_CNS_fraction(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2183 {
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2184 overlay float actual_ppO2;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2185 RESET_C_STACK
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2186
237
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
2187 assert( 0.0 <= CNS_fraction && CNS_fraction <= 2.5 );
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
2188 assert( char_I_actual_ppO2 > 15 );
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
2189
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2190 actual_ppO2 = (float)char_I_actual_ppO2 / 100.0;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2191
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2192 if (char_I_actual_ppO2 < 50)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2193 CNS_fraction = CNS_fraction;// no changes
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2194 else if (char_I_actual_ppO2 < 60)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2195 CNS_fraction = 1/(-54000.0 * actual_ppO2 + 54000.0) + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2196 else if (char_I_actual_ppO2 < 70)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2197 CNS_fraction = 1/(-45000.0 * actual_ppO2 + 48600.0) + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2198 else if (char_I_actual_ppO2 < 80)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2199 CNS_fraction = 1/(-36000.0 * actual_ppO2 + 42300.0) + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2200 else if (char_I_actual_ppO2 < 90)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2201 CNS_fraction = 1/(-27000.0 * actual_ppO2 + 35100.0) + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2202 else if (char_I_actual_ppO2 < 110)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2203 CNS_fraction = 1/(-18000.0 * actual_ppO2 + 27000.0) + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2204 else if (char_I_actual_ppO2 < 150)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2205 CNS_fraction = 1/(-9000.0 * actual_ppO2 + 17100.0) + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2206 else if (char_I_actual_ppO2 < 160)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2207 CNS_fraction = 1/(-22500.0 * actual_ppO2 + 37350.0) + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2208 else if (char_I_actual_ppO2 < 165)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2209 CNS_fraction = 0.000755 + CNS_fraction; // Arieli et all.(2002): Modeling pulmonary and CNS O2 toxicity... Formula (A1) based on value for 1.55 and c=20
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2210 else if (char_I_actual_ppO2 < 170)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2211 CNS_fraction = 0.00102 + CNS_fraction; // example calculation: Sqrt((1.7/1.55)^20)*0.000404
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2212 else if (char_I_actual_ppO2 < 175)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2213 CNS_fraction = 0.00136 + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2214 else if (char_I_actual_ppO2 < 180)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2215 CNS_fraction = 0.00180 + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2216 else if (char_I_actual_ppO2 < 185)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2217 CNS_fraction = 0.00237 + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2218 else if (char_I_actual_ppO2 < 190)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2219 CNS_fraction = 0.00310 + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2220 else if (char_I_actual_ppO2 < 195)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2221 CNS_fraction = 0.00401 + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2222 else if (char_I_actual_ppO2 < 200)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2223 CNS_fraction = 0.00517 + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2224 else if (char_I_actual_ppO2 < 230)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2225 CNS_fraction = 0.0209 + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2226 else
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2227 CNS_fraction = 0.0482 + CNS_fraction; // value for 2.5
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2228
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2229 if (CNS_fraction > 2.5)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2230 CNS_fraction = 2.5;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2231 if (CNS_fraction < 0.0)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2232 CNS_fraction = 0.0;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2233
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2234 char_O_CNS_fraction = (char)((CNS_fraction + 0.005)* 100.0);
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2235 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2236
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2237 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2238 // deco_calc_CNS_decrease_15min
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2239 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2240 // new in v.101
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2241 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2242 // calculates the half time of 90 minutes in 6 steps of 15 min
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
2243 // (Used in sleepmode, for low battery mode).
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2244 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2245 // Output: char_O_CNS_fraction
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2246 // Uses and Updates: CNS_fraction
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2247 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2248 void deco_calc_CNS_decrease_15min(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2249 {
237
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
2250 RESET_C_STACK
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
2251 assert( 0.0 <= CNS_fraction && CNS_fraction <= 2.5 );
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
2252
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2253 CNS_fraction = 0.890899 * CNS_fraction;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2254 char_O_CNS_fraction = (char)(CNS_fraction * 100.0 + 0.5);
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2255 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2256
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2257 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2258 // deco_calc_percentage
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2259 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2260 // new in v.101
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2261 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2262 // calculates int_I_temp * char_I_temp / 100
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2263 // output is int_I_temp
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
2264 //
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
2265 // Used to compute NoFly remaining time.
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2266 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2267 void deco_calc_percentage(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2268 {
122
3003a8040b78 FIX again reset C data stack and frame pointer when entering C code.
JeanDo
parents: 116
diff changeset
2269 RESET_C_STACK
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2270
237
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
2271 assert( 60 <= char_I_temp && char_I_temp <= 100 );
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
2272 assert( 0 <= int_I_temp && int_I_temp < 2880 ); // Less than 48h...
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
2273
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2274 int_I_temp = (unsigned short)(((float)int_I_temp * (float)char_I_temp) * 0.01 );
237
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
2275
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
2276 assert( int_I_temp < 1440 ); // Less than 24h...
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2277 }
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2278
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2279
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2280 //////////////////////////////////////////////////////////////////////////////
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2281 // deco_gas_volumes
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2282 //
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2283 // new in v.111
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2284 //
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2285 // calculates volumes for each gas.
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2286 //
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2287 // Input: char_I_bottom_depth, char_I_bottom_time for planned dive.
240
d995e220ddac BUGFIX Gas Usage when first gas is not #1 (bug BB22).
JeanDo
parents: 237
diff changeset
2288 // Gas list.
d995e220ddac BUGFIX Gas Usage when first gas is not #1 (bug BB22).
JeanDo
parents: 237
diff changeset
2289 // char_I_first_gas is the bottom gas.
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2290 // decoplan (char_O_deco_depth, char_O_deco_time).
234
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2291 // CF#54 == TRUE if shallowest stop first.
275
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
2292 // CF#56 == bottom deci-liters/minutes (0.5 .. 50.0) or bar/min.
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
2293 // CF#57 == deco deci-liters/minutes (0.5 .. 50.0) or bar/min.
224
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
2294 // Output: int_O_gas_volumes[0..4] in litters * 0.1
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2295 //
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2296 void deco_gas_volumes(void)
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2297 {
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2298 overlay float volumes[5];
265
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2299 overlay float bottom_usage, ascent_usage;
234
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2300 overlay unsigned char i, deepest_first;
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
2301 overlay unsigned char gas;
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2302 RESET_C_STACK
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2303
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2304 //---- initialize with bottom consumption --------------------------------
240
d995e220ddac BUGFIX Gas Usage when first gas is not #1 (bug BB22).
JeanDo
parents: 237
diff changeset
2305 for(i=0; i<5; ++i) // Nothing yet...
d995e220ddac BUGFIX Gas Usage when first gas is not #1 (bug BB22).
JeanDo
parents: 237
diff changeset
2306 volumes[i] = 0.0;
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2307
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
2308 assert(1 <= char_I_first_gas && char_I_first_gas <= 5);
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
2309 gas = char_I_first_gas - 1;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
2310
265
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2311 bottom_usage = read_custom_function(56) * 0.1;
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2312 if( bottom_usage > 0.0 )
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2313 volumes[gas]
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2314 = (char_I_bottom_depth*0.1 + 1.0) // Use Psurface = 1.0 bar.
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2315 * char_I_bottom_time // in minutes.
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2316 * bottom_usage; // In liter/minutes.
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2317 else
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2318 volumes[gas] = 65535.0;
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2319
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2320 //---- Ascent usage ------------------------------------------------------
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2321
234
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2322 deepest_first = read_custom_function(54) == 0;
240
d995e220ddac BUGFIX Gas Usage when first gas is not #1 (bug BB22).
JeanDo
parents: 237
diff changeset
2323 ascent_usage = read_custom_function(57) * 0.1; // In liter/minutes.
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2324
224
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
2325 // Usage up to the first stop:
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
2326 // - computed at MAX depth (easier, safer),
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2327 // - with an ascent speed of 10m/min.
224
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
2328 // - with ascent litter / minutes.
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2329 // - still using bottom gas:
265
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2330 if( ascent_usage > 0.0 )
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2331 volumes[gas]
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2332 += (char_I_bottom_depth*0.1 + 1.0) // Depth -> bar
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2333 * (char_I_bottom_depth - char_O_first_deco_depth) * 0.1 // ascent time (min)
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2334 * ascent_usage; // Consumption ( xxx / min @ 1 bar)
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2335 else
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2336 volumes[gas] = 65535.0;
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2337
234
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2338 for(i=0; i<32; ++i)
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2339 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
2340 overlay unsigned char j;
234
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2341 overlay unsigned char depth, time, ascent;
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2342
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2343 // Manage stops in reverse order (CF#54)
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2344 if( deepest_first )
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2345 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
2346 time = char_O_deco_time[i];
234
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2347 if( time == 0 ) break; // End of table: done.
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2348
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2349 ascent = depth = char_O_deco_depth[i];
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2350 if( i < 31 )
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2351 ascent -= char_O_deco_depth[i+1];
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2352 }
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2353 else
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2354 {
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2355 time = char_O_deco_time[31-i];
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2356 if( time == 0 ) continue; // not yet: still searh table.
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2357
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2358 ascent = depth = char_O_deco_depth[31-i];
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2359 if( i < 31 )
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2360 ascent -= char_O_deco_depth[30-i];
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2361 }
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2362
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2363 // Gas switch depth ?
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
2364 for(j=0; j<5; ++j)
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2365 {
234
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2366 if( depth <= char_I_deco_gas_change[j] )
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
2367 if( !char_I_deco_gas_change[gas] || (char_I_deco_gas_change[gas] > char_I_deco_gas_change[j]) )
224
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
2368 gas = j;
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2369 }
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2370
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2371 // usage during stop:
224
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
2372 // Note: because first gas is not in there, increment gas+1
265
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2373 if( ascent_usage > 0.0 )
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2374 volumes[gas] += (depth*0.1 + 1.0) // depth --> bar.
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2375 * time // in minutes.
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2376 * ascent_usage // in xxx / min @ 1bar.
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2377 // Plus usage during ascent to the next stop, at 10m/min.
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2378 + (depth*0.1 + 1.0)
275
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
2379 * ascent*0.1 // metre --> min
265
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2380 * ascent_usage;
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2381 else
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2382 volumes[gas] = 65535.0;
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2383 }
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2384
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2385 //---- convert results for the ASM interface -----------------------------
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2386 for(i=0; i<5; ++i)
224
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
2387 if( volumes[i] > 6553.4 )
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
2388 int_O_gas_volumes[i] = 65535;
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2389 else
224
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
2390 int_O_gas_volumes[i] = (unsigned short)(volumes[i]*10.0 + 0.5);
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2391 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2392
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2393 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2394
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2395 void deco_push_tissues_to_vault(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2396 {
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2397 overlay unsigned char x;
122
3003a8040b78 FIX again reset C data stack and frame pointer when entering C code.
JeanDo
parents: 116
diff changeset
2398 RESET_C_STACK
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2399
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2400 cns_vault = CNS_fraction;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2401 for (x=0;x<32;x++)
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2402 pres_tissue_vault[x] = pres_tissue[x];
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2403 }
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2404
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2405 void deco_pull_tissues_from_vault(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2406 {
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2407 overlay unsigned char x;
122
3003a8040b78 FIX again reset C data stack and frame pointer when entering C code.
JeanDo
parents: 116
diff changeset
2408 RESET_C_STACK
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2409
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2410 CNS_fraction = cns_vault;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2411 for (x=0;x<32;x++)
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2412 pres_tissue[x] = pres_tissue_vault[x];
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2413 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2414
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2415 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2416 //
184
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
2417 #ifndef CROSS_COMPILE
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
2418 void main() {}
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
2419 #endif