annotate code_part1/OSTC_code_c_part2/p2_deco.c @ 278:17aab4ca0547

BUGFIX CCR decoplan fails (bug bb42). Make decoplaning faster (just update tissue during bottomtime). Animate ascent depth during decoplaning.
author JeanDo
date Tue, 19 Apr 2011 02:26:41 +0200
parents 02303915c199
children 8514588eb6a2
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 //////////////////////////////////////////////////////////////////////////////
278
17aab4ca0547 BUGFIX CCR decoplan fails (bug bb42).
JeanDo
parents: 276
diff changeset
928 // Called every 1 min during decoplanning.
17aab4ca0547 BUGFIX CCR decoplan fails (bug bb42).
JeanDo
parents: 276
diff changeset
929 // Update tissues for 1 min.
17aab4ca0547 BUGFIX CCR decoplan fails (bug bb42).
JeanDo
parents: 276
diff changeset
930 //
17aab4ca0547 BUGFIX CCR decoplan fails (bug bb42).
JeanDo
parents: 276
diff changeset
931 void deco_calc_tissue(void)
17aab4ca0547 BUGFIX CCR decoplan fails (bug bb42).
JeanDo
parents: 276
diff changeset
932 {
17aab4ca0547 BUGFIX CCR decoplan fails (bug bb42).
JeanDo
parents: 276
diff changeset
933 RESET_C_STACK
17aab4ca0547 BUGFIX CCR decoplan fails (bug bb42).
JeanDo
parents: 276
diff changeset
934 calc_hauptroutine_update_tissues();
17aab4ca0547 BUGFIX CCR decoplan fails (bug bb42).
JeanDo
parents: 276
diff changeset
935 }
17aab4ca0547 BUGFIX CCR decoplan fails (bug bb42).
JeanDo
parents: 276
diff changeset
936
17aab4ca0547 BUGFIX CCR decoplan fails (bug bb42).
JeanDo
parents: 276
diff changeset
937 //////////////////////////////////////////////////////////////////////////////
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
938
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
939 void deco_calc_wo_deco_step_1_min(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
940 {
122
3003a8040b78 FIX again reset C data stack and frame pointer when entering C code.
JeanDo
parents: 116
diff changeset
941 RESET_C_STACK
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
942 calc_wo_deco_step_1_min();
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
943 deco_calc_desaturation_time();
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
944 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
945
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
946 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
947
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
948 void deco_debug(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
949 {
122
3003a8040b78 FIX again reset C data stack and frame pointer when entering C code.
JeanDo
parents: 116
diff changeset
950 RESET_C_STACK
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
951 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
952
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
953
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
954 //////////////////////////////////////////////////////////////////////////////
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
955 // Find current gas in the list (if any).
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
956 //
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
957 // Input: char_I_deco_N2_ratio[] and He, to detect breathed gas.
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
958 //
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
959 // Output: sim_gas_depth_used
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
960 //
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
961 static void gas_switch_find_current(void)
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
962 {
247
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
963 overlay unsigned char j;
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
964 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
965 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
966
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
967 for(j=0; j<5; ++j)
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
968 {
247
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
969 // 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
970 // 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
971 if( N2 == char_I_deco_N2_ratio[j]
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
972 && He == char_I_deco_He_ratio[j]
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 {
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
975 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
976 sim_gas_last_used = j+1;
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
977 break;
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
978 }
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
979 }
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
980
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
981 // If there is no gas-switch-delay running ?
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
982 if( sim_gas_delay <= sim_dive_mins)
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
983 {
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
984 // Compute current depth:
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
985 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
986 assert( depth < 130 );
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
987
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
988 // 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
989 if( (sim_gas_last_depth-3) > depth )
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
990 {
247
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
991 for(j=0; j<5; ++j)
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
992 {
247
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
993 // 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
994 // (again, with the same 3m margin)
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
995 if( char_I_deco_gas_change[j]
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
996 && depth <= char_I_deco_gas_change[j]
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
997 && depth >= (char_I_deco_gas_change[j] - 3)
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
998 )
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
999 {
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1000 // Then start gas-switch timer there,
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1001 sim_gas_delay = sim_dive_mins
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1002 + read_custom_function(55);
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1003
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1004 // 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
1005 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
1006 break;
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1007 }
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1008 }
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1009 }
247
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1010 else
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1011 // Make clear there is no deay anymore.
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1012 sim_gas_delay = 0;
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1013 }
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1014 }
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1015
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1016 //////////////////////////////////////////////////////////////////////////////
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1017 // Find deepest available gas.
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1018 //
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1019 // Input: temp_depth_limit,
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1020 // deco_gas_change[]
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1021 // sim_gas_delay, sim_gas_depth_used, sim_dive_mins.
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1022 //
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1023 // RETURNS TRUE if a stop is needed for gas switch.
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1024 //
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1025 // 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
1026 //
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1027 // NOTE: might be called from bottom (when sim_gas_delay and sim_gas_depth_used
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1028 // are null), or during the ascent to make sure we are not passing a
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1029 // stop (in which case both can be already set).
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1030 //
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1031 static unsigned char gas_switch_deepest(void)
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1032 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1033 overlay unsigned char switch_deco = 0, switch_last = 0;
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1034
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1035 if (char_I_const_ppO2 == 0)
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1036 {
225
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1037 overlay unsigned char j;
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1038
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1039 // Loop over all enabled gas, to find the deepest one,
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1040 // above las gas, but below temp_depth_limit.
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1041 for(j=0; j<5; ++j)
225
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1042 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1043 // Gas not (yet) allowed ? Skip !
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1044 if( temp_depth_limit > deco_gas_change[j] )
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1045 continue;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1046
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1047 // Gas deeper than the current/previous one ? Skip !
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1048 if( sim_gas_last_depth && deco_gas_change[j] >= sim_gas_last_depth )
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1049 continue;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1050
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1051 // First, or deeper ?
247
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1052 if( switch_deco < deco_gas_change[j] )
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1053 {
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1054 switch_deco = deco_gas_change[j];
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1055 switch_last = j+1;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1056 }
225
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1057 }
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1058 }
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1059
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1060 // If there is a better gas available
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1061 if( switch_deco )
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1062 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1063 assert( !sim_gas_last_depth || sim_gas_last_depth > switch_deco );
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1064
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1065 // Should restart gas-switch delay only when gas do changes...
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1066 assert( sim_gas_delay <= sim_dive_mins );
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1067
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1068 sim_gas_last_depth = switch_deco;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1069 sim_gas_last_used = switch_last;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1070 sim_gas_delay = read_custom_function(55);
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1071
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1072 // Apply depth correction ONLY if CF#55 is not null:
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1073 if( sim_gas_delay > 0 )
225
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1074 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1075 sim_gas_delay += sim_dive_mins;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1076 temp_depth_limit = switch_deco;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1077 return 1;
225
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1078 }
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1079
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1080 return 0;
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1081 }
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1082
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1083 sim_gas_delay = 0;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1084 return 0;
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1085 }
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1086
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1087 //////////////////////////////////////////////////////////////////////////////
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1088 // Calculate gas switches
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1089 //
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1090 //
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1091 // Input: N2_ratio, He_ratio.
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1092 // sim_gas_last_used
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1093 //
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1094 // Output: calc_N2_ratio, calc_He_ratio
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1095 //
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1096 static void gas_switch_set(void)
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1097 {
224
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
1098 assert( 0 <= sim_gas_last_used && sim_gas_last_used <= 5 );
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1099
224
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
1100 if( sim_gas_last_used == 0 )
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
1101 {
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
1102 calc_N2_ratio = N2_ratio;
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
1103 calc_He_ratio = He_ratio;
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
1104 }
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
1105 else
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
1106 {
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
1107 calc_N2_ratio = char_I_deco_N2_ratio[sim_gas_last_used-1] * 0.01;
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
1108 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
1109 }
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1110
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1111 assert( 0.0 <= calc_N2_ratio && calc_N2_ratio <= 0.95 );
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1112 assert( 0.0 <= calc_He_ratio && calc_He_ratio <= 0.95 );
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1113 assert( (calc_N2_ratio + calc_He_ratio) <= 1.00 );
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1114 }
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1115
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1116 //////////////////////////////////////////////////////////////////////////////
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1117 //
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1118 // Input: calc_N2_ratio, calc_He_ratio : simulated gas mix.
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1119 // temp_deco : simulated respiration pressure + security offset (deco_distance)
276
02303915c199 BUGFIX CF16 applyed to diluant in CCR mode.
JeanDo
parents: 275
diff changeset
1120 // float_deco_distance : security factor.
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1121 // Water-vapor pressure inside lumbs (ppWVapour).
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1122 //
236
3dbeacf42e9e BUGFIX missing deko init in reboot code.
JeanDo
parents: 235
diff changeset
1123 // Output: ppN2, ppHe.
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1124 //
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1125 static void sim_alveolar_presures(void)
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1126 {
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1127 overlay float deco_diluent = temp_deco; // new in v.101
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1128
276
02303915c199 BUGFIX CF16 applyed to diluant in CCR mode.
JeanDo
parents: 275
diff changeset
1129 // Take deco offset into account, but not at surface.
02303915c199 BUGFIX CF16 applyed to diluant in CCR mode.
JeanDo
parents: 275
diff changeset
1130 // Note: this should be done on ambiant pressure, hence before
02303915c199 BUGFIX CF16 applyed to diluant in CCR mode.
JeanDo
parents: 275
diff changeset
1131 // computing the diluant partial pressure...
02303915c199 BUGFIX CF16 applyed to diluant in CCR mode.
JeanDo
parents: 275
diff changeset
1132 if( deco_diluent > pres_surface )
02303915c199 BUGFIX CF16 applyed to diluant in CCR mode.
JeanDo
parents: 275
diff changeset
1133 deco_diluent += float_deco_distance;
02303915c199 BUGFIX CF16 applyed to diluant in CCR mode.
JeanDo
parents: 275
diff changeset
1134
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1135 //---- CCR mode : deco gas switch ? --------------------------------------
276
02303915c199 BUGFIX CF16 applyed to diluant in CCR mode.
JeanDo
parents: 275
diff changeset
1136 if( char_I_const_ppO2 != 0 )
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1137 {
276
02303915c199 BUGFIX CF16 applyed to diluant in CCR mode.
JeanDo
parents: 275
diff changeset
1138 // In CCR mode, use calc_XX_ratio instead of XX_ratio.
02303915c199 BUGFIX CF16 applyed to diluant in CCR mode.
JeanDo
parents: 275
diff changeset
1139 // Note: PPO2 and ratios are known outside the lumbs, so there is no
02303915c199 BUGFIX CF16 applyed to diluant in CCR mode.
JeanDo
parents: 275
diff changeset
1140 // ppWVapour in the equations below:
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1141 if( temp_deco > deco_ppO2_change )
276
02303915c199 BUGFIX CF16 applyed to diluant in CCR mode.
JeanDo
parents: 275
diff changeset
1142 deco_diluent -= const_ppO2;
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1143 else
276
02303915c199 BUGFIX CF16 applyed to diluant in CCR mode.
JeanDo
parents: 275
diff changeset
1144 deco_diluent -= deco_ppO2;
02303915c199 BUGFIX CF16 applyed to diluant in CCR mode.
JeanDo
parents: 275
diff changeset
1145 deco_diluent /= calc_N2_ratio + calc_He_ratio;
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1146
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1147 if (deco_diluent > temp_deco)
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1148 deco_diluent = temp_deco;
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1149 }
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1150
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1151 if( deco_diluent > ppWVapour )
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1152 {
236
3dbeacf42e9e BUGFIX missing deko init in reboot code.
JeanDo
parents: 235
diff changeset
1153 ppN2 = calc_N2_ratio * (deco_diluent - ppWVapour);
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1154 ppHe = calc_He_ratio * (deco_diluent - ppWVapour);
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1155 }
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1156 else
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1157 {
236
3dbeacf42e9e BUGFIX missing deko init in reboot code.
JeanDo
parents: 235
diff changeset
1158 ppN2 = 0.0;
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1159 ppHe = 0.0;
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1160 }
236
3dbeacf42e9e BUGFIX missing deko init in reboot code.
JeanDo
parents: 235
diff changeset
1161 assert( 0.0 <= ppN2 && ppN2 < 14.0 );
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1162 assert( 0.0 <= ppHe && ppHe < 14.0 );
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1163 }
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1164
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1165 //////////////////////////////////////////////////////////////////////////////
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1166 // clear_tissue
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1167 //
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
1168 // optimized in v.101 (var_N2_a)
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1169 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1170 // preload tissues with standard pressure for the given ambient pressure.
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1171 // Note: fixed N2_ratio for standard air.
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1172 //
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1173 static void clear_tissue(void)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1174 {
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1175 flag_in_divemode = 0;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1176 int_O_DBS_bitfield = 0;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1177 int_O_DBS2_bitfield = 0;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1178 int_O_DBG_pre_bitfield = 0;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1179 int_O_DBG_post_bitfield = 0;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1180 char_O_NDL_at_20mtr = 255;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1181
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1182 // Kludge: the 0.0002 of 0.7902 are missing with standard air.
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1183 N2_ratio = 0.7902;
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1184 pres_respiration = int_I_pres_respiration * 0.001;
164
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
1185
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1186 for(ci=0; ci<16; ci++)
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1187 {
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1188 // cycle through the 16 Bühlmann tissues
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
1189 overlay float p = N2_ratio * (pres_respiration - ppWVapour);
164
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
1190 pres_tissue[ci] = p;
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1191
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1192 // cycle through the 16 Bühlmann tissues for Helium
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1193 (pres_tissue+16)[ci] = 0.0;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1194 } // for 0 to 16
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1195
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1196 clear_deco_table();
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1197 char_O_deco_status = 0;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1198 char_O_nullzeit = 0;
168
494587193f5d Use 16bits for TTS sum.
JeanDo
parents: 167
diff changeset
1199 int_O_ascenttime = 0;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1200 char_O_gradient_factor = 0;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1201 char_O_relative_gradient_GF = 0;
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1202 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
1203
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1204 calc_lead_tissue_limit = 0.0;
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1205 char_O_gtissue_no = 0;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1206 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1207
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1208 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1209 // calc_hauptroutine
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1210 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1211 // this is the major code in dive mode calculates:
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1212 // the tissues,
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1213 // the bottom time,
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1214 // and simulates the ascend with all deco stops.
171
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1215 //
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1216 // The deco_state sequence is :
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1217 // 3 (at surface)
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1218 // +---> 0 : calc nullzeit
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1219 // | 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
1220 // | +-> 1 : simulate up to 16min of stops.
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1221 // | +------< not finished
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1222 // +--------< finish
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1223 //
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1224 static void calc_hauptroutine(void)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1225 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1226 static unsigned char backup_gas_used = 0;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1227 static unsigned char backup_gas_depth = 0;
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1228 static unsigned char backup_gas_delay = 0;
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1229
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1230 calc_hauptroutine_data_input();
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1231
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1232 if(!flag_in_divemode)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1233 {
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1234 flag_in_divemode = 1;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1235 create_dbs_set_dbg_and_ndl20mtr();
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1236 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1237 else
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1238 check_pre_dbg();
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1239
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1240 calc_hauptroutine_update_tissues();
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1241 calc_gradient_factor();
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1242
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1243 // toggle between calculation for nullzeit (bottom time),
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1244 // deco stops
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1245 // and more deco stops (continue)
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1246 switch( char_O_deco_status )
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1247 {
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1248 case 3: //---- At surface: start a new dive ------------------------------
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1249 clear_deco_table();
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1250 copy_deco_table();
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
1251 int_O_ascenttime = 0; // Reset DTR.
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
1252 char_O_nullzeit = 0; // Reset bottom time.
278
17aab4ca0547 BUGFIX CCR decoplan fails (bug bb42).
JeanDo
parents: 276
diff changeset
1253 char_O_deco_status = 0; // Calc bottom-time/nullzeit next iteration.
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1254
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1255 // Values that should be reset just once for the full real dive.
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1256 // This is used to record the lowest stop for the whole dive,
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1257 // Including ACCROSS all simulated ascent.
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1258 low_depth = 0;
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1259
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1260 // Reset gas switch history.
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1261 backup_gas_used = sim_gas_last_used = 0;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1262 backup_gas_depth = sim_gas_last_depth = 0;
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1263 backup_gas_delay = sim_gas_delay = 0;
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1264 sim_dive_mins = 0;
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1265 break;
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1266
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1267 case 0: //---- bottom time -----------------------------------------------
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1268 calc_nullzeit();
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1269 check_ndl();
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1270 char_O_deco_status = 2; // calc ascent next time.
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1271 break;
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1272
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1273 case 2: //---- Simulate ascent to first stop -----------------------------
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1274 // 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
1275 sim_dive_mins = int_I_divemins; // Init current time.
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1276
247
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1277 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
1278 gas_switch_set(); // setup calc_ratio's
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1279
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1280 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
1281 backup_gas_depth = sim_gas_last_depth; // And save for later simu steps.
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1282 backup_gas_delay = sim_gas_delay;
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1283
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1284 sim_ascent_to_first_stop();
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1285
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1286 char_O_deco_status = 1; // Calc stops next time (deco or gas switch).
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1287 break;
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1288
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1289 case 1: //---- Simulate stops --------------------------------------------
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1290 calc_hauptroutine_calc_deco();
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1291
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1292 // If simulation is finished, restore the GF low reference, so that
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1293 // next ascent simulation is done from the current depth:
217
ce6f16711567 BUGFIX gas switch
JeanDo
parents: 216
diff changeset
1294 if( char_O_deco_status == 0 )
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1295 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1296 sim_gas_last_used = backup_gas_used;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1297 sim_gas_last_depth = backup_gas_depth;
247
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1298 sim_gas_delay = backup_gas_delay;
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1299 }
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1300 break;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1301 }
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1302
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1303 check_post_dbg();
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1304 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1305
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1306 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1307 // calc_hauptroutine_data_input
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1308 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1309 // Reset all C-code dive parameters from their ASM-code values.
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1310 // Detect gas change condition.
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1311 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1312 void calc_hauptroutine_data_input(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1313 {
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1314 overlay short int_temp;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1315
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1316 pres_respiration = int_I_pres_respiration * 0.001;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1317 pres_surface = int_I_pres_surface * 0.001;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1318 N2_ratio = char_I_N2_ratio * 0.01;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1319 He_ratio = char_I_He_ratio * 0.01;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1320 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
1321
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1322 // ____________________________________________________
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1323 //
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1324 // _____________ G A S _ C H A N G E S ________________
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1325 // ____________________________________________________
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1326
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1327 // Keep a margin of 150mbar = 1.50m
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1328 int_temp = (int_I_pres_respiration - int_I_pres_surface)
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1329 + MBAR_REACH_GASCHANGE_AUTO_CHANGE_OFF;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1330
225
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1331 deco_gas_change[0] = 0;
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1332 deco_gas_change[1] = 0;
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1333 deco_gas_change[2] = 0;
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1334 deco_gas_change[3] = 0;
2dc4a7340510 BUGFIX Gas usage for unsorted gas list.
JeanDo
parents: 224
diff changeset
1335 deco_gas_change[4] = 0;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1336
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1337 // 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
1338 if(char_I_deco_gas_change[0])
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1339 {
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
1340 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
1341 deco_gas_change[0] = char_I_deco_gas_change[0];
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1342 }
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
1343 if(char_I_deco_gas_change[1])
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1344 {
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
1345 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
1346 deco_gas_change[1] = char_I_deco_gas_change[1];
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1347 }
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
1348 if(char_I_deco_gas_change[2])
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1349 {
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
1350 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
1351 deco_gas_change[2] = char_I_deco_gas_change[2];
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1352 }
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
1353 if(char_I_deco_gas_change[3])
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1354 {
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
1355 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
1356 deco_gas_change[3] = char_I_deco_gas_change[3];
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1357 }
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
1358 if(char_I_deco_gas_change[4])
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1359 {
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
1360 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
1361 deco_gas_change[4] = char_I_deco_gas_change[4];
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1362 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1363
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1364 const_ppO2 = char_I_const_ppO2 * 0.01;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1365 deco_ppO2_change = char_I_deco_ppO2_change / 99.95
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1366 + pres_surface
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1367 + float_deco_distance;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1368 deco_ppO2 = char_I_deco_ppO2 * 0.01;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1369 float_desaturation_multiplier = char_I_desaturation_multiplier * 0.01;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1370 float_saturation_multiplier = char_I_saturation_multiplier * 0.01;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1371 GF_low = char_I_GF_Low_percentage * 0.01;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1372 GF_high = char_I_GF_High_percentage * 0.01;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1373 GF_delta = GF_high - GF_low;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1374 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1375
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1376 //////////////////////////////////////////////////////////////////////////////
171
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1377 //
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1378 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1379 void calc_hauptroutine_update_tissues(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1380 {
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1381 assert( 0.00 <= N2_ratio && N2_ratio <= 1.00 );
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1382 assert( 0.00 <= He_ratio && He_ratio <= 1.00 );
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1383 assert( (N2_ratio + He_ratio) <= 0.95 );
237
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
1384 assert( 0.800 < pres_respiration && pres_respiration < 14.0 );
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1385
276
02303915c199 BUGFIX CF16 applyed to diluant in CCR mode.
JeanDo
parents: 275
diff changeset
1386 pres_diluent = pres_respiration;
02303915c199 BUGFIX CF16 applyed to diluant in CCR mode.
JeanDo
parents: 275
diff changeset
1387 if (char_I_const_ppO2 != 0) // new in v.101
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1388 {
276
02303915c199 BUGFIX CF16 applyed to diluant in CCR mode.
JeanDo
parents: 275
diff changeset
1389 pres_diluent -= const_ppO2; // new in v.101
02303915c199 BUGFIX CF16 applyed to diluant in CCR mode.
JeanDo
parents: 275
diff changeset
1390 pres_diluent /= N2_ratio + He_ratio; // new in v.101
02303915c199 BUGFIX CF16 applyed to diluant in CCR mode.
JeanDo
parents: 275
diff changeset
1391 if( pres_diluent > pres_respiration ) // new in v.101
02303915c199 BUGFIX CF16 applyed to diluant in CCR mode.
JeanDo
parents: 275
diff changeset
1392 pres_diluent = pres_respiration; // new in v.101
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1393 }
276
02303915c199 BUGFIX CF16 applyed to diluant in CCR mode.
JeanDo
parents: 275
diff changeset
1394 if (pres_diluent > ppWVapour) // new in v.101
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1395 {
276
02303915c199 BUGFIX CF16 applyed to diluant in CCR mode.
JeanDo
parents: 275
diff changeset
1396 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
1397 ppHe = He_ratio * (pres_diluent - ppWVapour); // changed in v.101
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1398 char_O_diluent = (char)(pres_diluent/pres_respiration*100.0);
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1399 }
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1400 else // new in v.101
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1401 {
236
3dbeacf42e9e BUGFIX missing deko init in reboot code.
JeanDo
parents: 235
diff changeset
1402 ppN2 = 0.0; // new in v.101
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
1403 ppHe = 0.0; // new in v.101
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1404 char_O_diluent = 0;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1405 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1406
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1407 if(!char_I_step_is_1min)
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1408 calc_tissue(0);
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1409 else
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1410 calc_tissue(1);
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1411
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1412 // Calc limit for surface, ie. GF_high.
258
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1413 calc_limit();
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1414
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1415 int_O_gtissue_limit = (short)(calc_lead_tissue_limit * 1000);
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1416 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
1417
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1418 // if guiding tissue can not be exposed to surface pressure immediately
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1419 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
1420 {
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1421 char_O_nullzeit = 0; // deco necessary
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1422 char_O_deco_status = 2; // calculate ascent on next iteration.
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1423 }
171
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1424 }
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1425
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1426
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1427 //////////////////////////////////////////////////////////////////////////////
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1428 // Compute stops.
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1429 //
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1430 // 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
1431 // 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
1432 // 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
1433 // break the loop when total time > 512msec.
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1434 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1435 void calc_hauptroutine_calc_deco(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1436 {
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1437 overlay unsigned char loop;
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1438
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1439 for(loop = 0; loop < 16; ++loop)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1440 {
257
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
1441 // 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
1442 if( tmr3() & (512*32) )
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
1443 break;
f8f869bafd92 Use timer TMR3 to limit loops in calc_hauptroutine_calc_deco()
JeanDo
parents: 252
diff changeset
1444
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1445 // Do not ascent while doing a gas switch ?
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1446 if( sim_gas_delay <= sim_dive_mins )
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1447 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1448 if( calc_nextdecodepth() )
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1449 {
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1450 if( temp_depth_limit == 0 )
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1451 goto Surface;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1452
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1453 //---- We hit a stop at temp_depth_limit ---------------------
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1454 temp_deco = temp_depth_limit * 0.09985 // Convert to relative bar,
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1455 + pres_surface; // To absolute.
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1456 update_deco_table(); // Adds a one minute stops.
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1457 }
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1458 else
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1459 {
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1460 //---- No stop -----------------------------------------------
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1461 temp_deco -= 0.9985; // Ascend 10m, no wait.
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1462
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1463 //---- Finish computations once surface is reached -----------
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1464 if( temp_deco <= pres_surface )
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1465 {
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1466 Surface:
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1467 copy_deco_table();
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1468 calc_ascenttime();
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1469 char_O_deco_status = 0; // calc nullzeit next time.
278
17aab4ca0547 BUGFIX CCR decoplan fails (bug bb42).
JeanDo
parents: 276
diff changeset
1470 char_O_deco_last_stop = 0; // Surface reached.
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1471 return;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1472 }
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1473 }
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1474 }
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1475 else
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1476 update_deco_table(); // Just pass one minute.
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1477
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1478 //---- Then update tissue --------------------------------------------
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1479 sim_dive_mins++; // Advance simulated time by 1 minute.
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1480 gas_switch_set(); // Apply any simulated gas change, once validated.
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1481 sim_alveolar_presures(); // Updates ppN2 and ppHe.
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1482 sim_tissue(1); // Simulate compartiments for 1 minute.
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1483 }
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1484
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1485 // Surface not reached, need more stops...
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1486 char_O_deco_status = 1; // calc more stops next time.
278
17aab4ca0547 BUGFIX CCR decoplan fails (bug bb42).
JeanDo
parents: 276
diff changeset
1487 char_O_deco_last_stop = temp_depth_limit; // Reached depth.
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1488 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1489
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1490 //////////////////////////////////////////////////////////////////////////////
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1491 // Simulation ascention to first deco stop.
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1492 //
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1493 // 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
1494 // 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
1495 // (or we are already in deep shit).
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1496 //
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1497 void sim_ascent_to_first_stop(void)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1498 {
171
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1499 update_startvalues();
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1500 clear_deco_table();
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1501
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
1502 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
1503
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1504 // Do we have a gas switch going on ?
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1505 if( sim_gas_delay > sim_dive_mins )
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1506 return;
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1507
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1508 //---- 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
1509 for(;;)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1510 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1511 // Try ascending 1 full minute.
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1512 temp_deco -= 0.9985; // 1 min, at 10m/min. ~ 1bar.
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1513
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1514 // Compute sim_lead_tissue_limit at GF_low (deepest stop).
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1515 sim_limit(GF_low);
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1516
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1517 // Did we reach deepest remaining stop ?
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1518 if( temp_deco < sim_lead_tissue_limit )
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1519 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1520 temp_deco += 0.9985; // Restore last correct depth,
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1521 break; // End fast ascent.
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1522 }
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1523
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1524 // Did we reach surface ?
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1525 if( temp_deco <= pres_surface )
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1526 {
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1527 temp_deco = pres_surface; // Yes: finished !
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1528 break;
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1529 }
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1530
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1531 // Check for gas change below new depth ?
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1532 temp_depth_limit = (temp_deco - pres_surface) / 0.09985;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1533
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1534 if( gas_switch_deepest() )
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1535 {
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1536 temp_deco = temp_depth_limit * 0.09985 + pres_surface;
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1537 break;
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1538 }
171
7f3e1bf588bc More p2_deco.c cleanups
JeanDo
parents: 169
diff changeset
1539
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1540 sim_dive_mins++; // Advance simulated time by 1 minute.
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1541 sim_alveolar_presures(); // temp_deco --> ppN2/ppHe
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1542 sim_tissue(1); // and update tissues for 1 min.
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1543 }
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1544 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1545
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1546 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1547 // calc_tissue
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1548 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1549 // optimized in v.101
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1550 //
184
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
1551 static void calc_tissue(PARAMETER unsigned char period)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1552 {
251
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
1553 assert( 0.00 <= ppN2 && ppN2 < 11.2 ); // 80% N2 at 130m
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
1554 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
1555
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1556 for (ci=0;ci<16;ci++)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1557 {
258
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1558 read_buhlmann_times(period); // 2 sec or 1 min period.
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1559
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1560 // N2
236
3dbeacf42e9e BUGFIX missing deko init in reboot code.
JeanDo
parents: 235
diff changeset
1561 temp_tissue = (ppN2 - pres_tissue[ci]) * var_N2_e;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1562 temp_tissue_safety();
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1563 pres_tissue[ci] += temp_tissue;
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
1564
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1565 // He
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
1566 temp_tissue = (ppHe - (pres_tissue+16)[ci]) * var_He_e;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1567 temp_tissue_safety();
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1568 (pres_tissue+16)[ci] += temp_tissue;
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1569 }
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1570 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1571
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1572 //////////////////////////////////////////////////////////////////////////////
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1573 // calc_limit
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1574 //
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1575 // New in v.111 : separated from calc_tissue(), and depends on GF value.
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1576 //
258
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1577 static void calc_limit(void)
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1578 {
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1579 char_O_gtissue_no = 255;
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1580 calc_lead_tissue_limit = 0.0;
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1581
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1582 for (ci=0;ci<16;ci++)
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1583 {
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1584 overlay float p = pres_tissue[ci] + (pres_tissue+16)[ci];
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1585
258
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1586 read_buhlmann_coefficients();
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1587 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
1588 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
1589
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1590 // Apply the Eric Baker's varying gradient factor correction.
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1591 // Note: the correction factor depends both on GF and b,
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1592 // Actual values are in the 1.5 .. 1.0 range (for a GF=30%),
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1593 // so that can change who is the leading gas...
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1594 // Note: Also depends of the GF. So the calcul is different for
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1595 // GF_low, current GF, or GF_high...
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1596 // *BUT* calc_tissue() is used to compute bottom time,
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1597 // hence what would happend at surface,
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1598 // hence at GF_high.
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1599 if( char_I_deco_model == 1 )
258
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1600 p = ( p - var_N2_a * GF_high) * var_N2_b
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1601 / (GF_high + var_N2_b * (1.0 - GF_high));
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1602 else
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1603 p = (p - var_N2_a) * var_N2_b;
258
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1604 if( p < 0.0 ) p = 0.0;
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1605
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1606 if( p > calc_lead_tissue_limit )
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1607 {
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1608 char_O_gtissue_no = ci;
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1609 calc_lead_tissue_limit = p;
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1610 }
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1611 }
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1612
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1613 assert( char_O_gtissue_no < 16 );
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1614 assert( 0.0 <= calc_lead_tissue_limit && calc_lead_tissue_limit <= 14.0);
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1615 }
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1616
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1617 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1618 // calc_nullzeit
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1619 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1620 // calculates the remaining bottom time
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1621 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1622 // unchanged in v.101
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1623 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1624 static void calc_nullzeit(void)
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1625 {
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1626 overlay unsigned char loop;
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
1627 update_startvalues();
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1628
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1629 char_O_nullzeit = 0;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1630 for(loop = 1; loop <= 17; loop++)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1631 {
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1632 backup_sim_pres_tissue();
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1633 sim_tissue(2); // 10 min.
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1634 sim_limit(GF_high);
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1635
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1636 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
1637 {
ae3a83982ab2 BUGFIX NDL blocked to 11' (bb #9)
JeanDo
parents: 184
diff changeset
1638 restore_sim_pres_tissue();
ae3a83982ab2 BUGFIX NDL blocked to 11' (bb #9)
JeanDo
parents: 184
diff changeset
1639 break;
ae3a83982ab2 BUGFIX NDL blocked to 11' (bb #9)
JeanDo
parents: 184
diff changeset
1640 }
ae3a83982ab2 BUGFIX NDL blocked to 11' (bb #9)
JeanDo
parents: 184
diff changeset
1641 // Validate once we know its good.
ae3a83982ab2 BUGFIX NDL blocked to 11' (bb #9)
JeanDo
parents: 184
diff changeset
1642 char_O_nullzeit += 10;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1643 }
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1644
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1645 if (char_O_nullzeit < 60)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1646 {
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1647 for(loop=1; loop <= 10; loop++)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1648 {
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1649 sim_tissue(1); // 1 min
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1650 sim_limit(GF_high);
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1651
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1652 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
1653 break;
ae3a83982ab2 BUGFIX NDL blocked to 11' (bb #9)
JeanDo
parents: 184
diff changeset
1654 char_O_nullzeit++;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1655 }
185
ae3a83982ab2 BUGFIX NDL blocked to 11' (bb #9)
JeanDo
parents: 184
diff changeset
1656 }
ae3a83982ab2 BUGFIX NDL blocked to 11' (bb #9)
JeanDo
parents: 184
diff changeset
1657 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1658
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1659 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1660 // backup_sim_pres_tissue
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 void backup_sim_pres_tissue(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1663 {
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1664 overlay unsigned char x;
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1665
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1666 for(x = 0; x<32; x++)
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1667 sim_pres_tissue_backup[x] = sim_pres_tissue[x];
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1668 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1669
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1670 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1671 // restore_sim_pres_tissue
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1672 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1673 void restore_sim_pres_tissue(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1674 {
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1675 overlay unsigned char x;
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1676
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1677 for(x = 0; x<32; x++)
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1678 sim_pres_tissue[x] = sim_pres_tissue_backup[x];
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1679 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1680
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1681 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1682 // calc_ascenttime
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1683 //
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1684 static void calc_ascenttime(void)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1685 {
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1686 if (pres_respiration > pres_surface)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1687 {
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1688 overlay unsigned char x;
168
494587193f5d Use 16bits for TTS sum.
JeanDo
parents: 167
diff changeset
1689
275
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
1690 // + 0.7 to count 1 minute ascent time from 3 metre to surface
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1691 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
1692 if (ascent < 0.0)
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1693 ascent = 0.0;
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1694 int_O_ascenttime = (unsigned short)(ascent + 0.99);
168
494587193f5d Use 16bits for TTS sum.
JeanDo
parents: 167
diff changeset
1695
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1696 for(x=0; x<32 && internal_deco_depth[x]; x++)
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
1697 int_O_ascenttime += (unsigned short)internal_deco_time[x];
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1698 }
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1699 else
168
494587193f5d Use 16bits for TTS sum.
JeanDo
parents: 167
diff changeset
1700 int_O_ascenttime = 0;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1701 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1702
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1703 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1704 // update_startvalues
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1705 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1706 // updated in v.102
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1707 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1708 void update_startvalues(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1709 {
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1710 overlay unsigned char x;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1711
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1712 // Start ascent simulation with current tissue partial pressures.
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1713 for (x = 0;x<16;x++)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1714 {
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1715 sim_pres_tissue[x] = pres_tissue[x];
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1716 (sim_pres_tissue+16)[x] = (pres_tissue+16)[x];
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1717 }
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1718
201
e5c484d59a91 Gas switch debugging...
JeanDo
parents: 200
diff changeset
1719 // No leading tissue (yet) for this ascent simulation.
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1720 sim_lead_tissue_limit = 0.0;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1721 sim_lead_tissue_no = 255;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1722 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1723
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1724 //////////////////////////////////////////////////////////////////////////////
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1725 // sim_tissue
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1726 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1727 // optimized in v.101
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1728 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1729 // Function very simular to calc_tissue, but:
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1730 // + Use a 1min or 10min period.
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1731 // + 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
1732 static void sim_tissue(PARAMETER unsigned char period)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1733 {
251
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
1734 assert( 0.00 <= ppN2 && ppN2 < 11.2 ); // 80% N2 at 130m
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
1735 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
1736
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1737 for(ci=0; ci<16; ci++)
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1738 {
258
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1739 read_buhlmann_times(period); // 1 or 10 minute(s) interval
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
1740
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1741 // N2
236
3dbeacf42e9e BUGFIX missing deko init in reboot code.
JeanDo
parents: 235
diff changeset
1742 temp_tissue = (ppN2 - sim_pres_tissue[ci]) * var_N2_e;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1743 temp_tissue_safety();
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1744 sim_pres_tissue[ci] += temp_tissue;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1745
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1746 // He
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
1747 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
1748 temp_tissue_safety();
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1749 (sim_pres_tissue+16)[ci] += temp_tissue;
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1750 }
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1751 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1752
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1753 //////////////////////////////////////////////////////////////////////////////
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1754 // sim_limit()
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1755 //
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1756 // New in v.111
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1757 //
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1758 // Function separated from sim_tissue() to allow recomputing limit on
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1759 // different depth, because it depends on current gradient factor.
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1760 //
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1761 static void sim_limit(PARAMETER float GF_current)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1762 {
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1763 assert( 0.0 < GF_current && GF_current <= 1.0f);
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1764
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1765 sim_lead_tissue_limit = 0.0;
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1766 sim_lead_tissue_no = 0; // If no one is critic, keep first tissue.
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1767
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1768 for(ci=0; ci<16; ci++)
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1769 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1770 overlay float N2 = sim_pres_tissue[ci];
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1771 overlay float He = (sim_pres_tissue+16)[ci];
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1772 overlay float p = N2 + He;
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1773
258
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1774 read_buhlmann_coefficients();
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1775 var_N2_a = (var_N2_a * N2 + var_He_a * He) / p;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1776 var_N2_b = (var_N2_b * N2 + var_He_b * He) / p;
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1777
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1778 // Apply the Eric Baker's varying gradient factor correction.
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1779 // Note: the correction factor depends both on GF and b,
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1780 // Actual values are in the 1.5 .. 1.0 range (for a GF=30%),
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1781 // so that can change who is the leading gas...
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1782 // Note: Also depends of the GF_current...
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1783 if( char_I_deco_model == 1 )
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1784 p = ( p - var_N2_a * GF_current) * var_N2_b
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1785 / (GF_current + var_N2_b * (1.0 - GF_current));
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1786 else
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1787 p = (p - var_N2_a) * var_N2_b;
237
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
1788 if( p < 0.0 ) p = 0.0;
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1789
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1790 if( p > sim_lead_tissue_limit )
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1791 {
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1792 sim_lead_tissue_no = ci;
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1793 sim_lead_tissue_limit = p;
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1794 }
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1795 } // for ci
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1796
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1797 assert( sim_lead_tissue_no < 16 );
237
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
1798 assert( 0.0 <= sim_lead_tissue_limit && sim_lead_tissue_limit <= 14.0 );
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1799 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1800
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1801 //////////////////////////////////////////////////////////////////////////////
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1802 // clear_deco_table
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1803 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1804 // unchanged in v.101
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1805 //
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1806 static void clear_deco_table(void)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1807 {
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1808 overlay unsigned char x;
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 for(x=0; x<32; ++x)
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1811 {
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1812 internal_deco_time [x] = 0;
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1813 internal_deco_depth[x] = 0;
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1814 }
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1815 }
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1816
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1817 //////////////////////////////////////////////////////////////////////////////
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1818 // update_deco_table
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1819 //
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1820 // Add 1 min to current stop.
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1821 //
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1822 // Inputs:
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1823 // temp_depth_limit = stop's depth, in meters.
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1824 // In/Out:
275
4310ab395dbe Keep low_depth in float 32bits (w/o rounding) for a better stability.
JeanDo
parents: 270
diff changeset
1825 // 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
1826 // internal_deco_time [] : time (in minutes) of each stops.
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1827 //
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1828 static void update_deco_table()
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1829 {
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1830 overlay unsigned char x;
247
ce869aad7440 BUGFIX Count gas switch delay down during ascent (bug bb26)
JeanDo
parents: 241
diff changeset
1831 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
1832 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
1833
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1834 for(x=0; x<32; ++x)
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1835 {
212
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1836 // Make sure deco-stops are recorded in order:
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1837 assert( !internal_deco_depth[x] || temp_depth_limit <= internal_deco_depth[x] );
275befc5f39d Debug GF model (bug #11 & #12).
JeanDo
parents: 203
diff changeset
1838
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
1839 if( internal_deco_depth[x] == temp_depth_limit )
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1840 {
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1841 // Do not overflow (max 255')
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1842 if( internal_deco_time[x] < 255 )
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1843 {
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1844 internal_deco_time[x]++;
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1845 return;
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1846 }
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1847 // But store extra in the next stop...
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1848 }
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1849
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1850 if( internal_deco_depth[x] == 0 )
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1851 {
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1852 internal_deco_depth[x] = temp_depth_limit;
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1853 internal_deco_time[x] = 1;
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1854 return;
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1855 }
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1856 }
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1857
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1858 // Can't store stops at more than 96m.
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
1859 // Or stops at less that 3m too.
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
1860 // Just do nothing with that...
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1861 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1862
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1863 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1864 // calc_gradient_factor
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1865 //
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
1866 // optimized in v.101 (var_N2_a)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1867 // new code in v.102
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1868 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1869 static void calc_gradient_factor(void)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1870 {
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1871 overlay float gf;
237
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
1872
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1873 assert( char_O_gtissue_no < 16 );
237
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
1874 assert( 0.800 <= pres_respiration && pres_respiration < 14.0 );
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1875
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1876 // tissue > respiration (entsaettigungsvorgang)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1877 // gradient ist wieviel prozent an limit mit basis tissue
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1878 // dh. 0% = respiration == tissue
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1879 // dh. 100% = respiration == limit
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1880 temp_tissue = pres_tissue[char_O_gtissue_no] + (pres_tissue+16)[char_O_gtissue_no];
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1881 if( temp_tissue < pres_respiration )
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1882 gf = 0.0;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1883 else
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1884 {
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1885 gf = (temp_tissue - pres_respiration)
258
abbf9a2c2c48 Small p2_deco optimizations:
JeanDo
parents: 257
diff changeset
1886 / (temp_tissue - calc_lead_tissue_limit)
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1887 * 100.0;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1888 if( gf > 255.0 ) gf = 255.0;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1889 if( gf < 0.0 ) gf = 0.0;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1890 }
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1891 char_O_gradient_factor = (unsigned char)gf;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1892
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1893 if (char_I_deco_model == 1) // calculate relative gradient factor
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1894 {
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1895 overlay float rgf;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1896
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1897 if( low_depth == 0 )
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1898 rgf = GF_high;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1899 else
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1900 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
1901 overlay float temp1 = low_depth * 0.09985;
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1902 overlay float temp2 = pres_respiration - pres_surface;
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1903
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1904 if (temp2 <= 0)
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1905 rgf = GF_high;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1906 else if (temp2 >= temp1)
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1907 rgf = GF_low;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1908 else
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1909 rgf = GF_low + (temp1 - temp2)/temp1*GF_delta;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1910 }
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1911
197
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1912 rgf = gf / rgf; // gf is already in percent
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1913 if( rgf < 0.0 ) rgf = 0.0;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1914 if( rgf > 255.0 ) rgf = 255.0;
f15e804ff67f Gas switch delay
JeanDo
parents: 193
diff changeset
1915 char_O_relative_gradient_GF = (unsigned char)rgf;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1916 } // calc relative gradient factor
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1917 else
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1918 {
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
1919 char_O_relative_gradient_GF = char_O_gradient_factor;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1920 }
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1921 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1922
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1923 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1924 // deco_calc_desaturation_time
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1925 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1926 // FIXED N2_ratio
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1927 // unchanged in v.101
233
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
1928 // Inputs: int_I_pres_surface, ppWVapour, char_I_desaturation_multiplier
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
1929 // Outputs: int_O_desaturation_time, char_O_tissue_saturation[0..31]
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1930 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1931 void deco_calc_desaturation_time(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1932 {
122
3003a8040b78 FIX again reset C data stack and frame pointer when entering C code.
JeanDo
parents: 116
diff changeset
1933 RESET_C_STACK
3003a8040b78 FIX again reset C data stack and frame pointer when entering C code.
JeanDo
parents: 116
diff changeset
1934
233
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
1935 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
1936 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
1937
260
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1938 #ifndef CROSS_COMPILE
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1939 // 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
1940 // 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
1941 // the UPPER page ourself...
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1942 // --> 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
1943 _asm
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1944 movlw 1
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1945 movwf TBLPTRU,0
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1946 _endasm
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1947 #endif
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1948
237
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
1949 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
1950 pres_surface = int_I_pres_surface * 0.001;
236
3dbeacf42e9e BUGFIX missing deko init in reboot code.
JeanDo
parents: 235
diff changeset
1951 ppN2 = N2_ratio * (pres_surface - ppWVapour);
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1952 int_O_desaturation_time = 0;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1953 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
1954
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1955 for (ci=0;ci<16;ci++)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1956 {
251
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
1957 overlay unsigned short desat_time; // For a particular compartiment, in min.
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
1958 overlay float temp1;
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
1959 overlay float temp2;
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
1960 overlay float temp3;
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
1961 overlay float temp4;
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
1962
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1963 // saturation_time (for flight) and N2_saturation in multiples of halftime
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1964 // 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
1965 // 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
1966 // 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
1967 // N2
260
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1968 temp1 = 1.05 * ppN2 - pres_tissue[ci];
236
3dbeacf42e9e BUGFIX missing deko init in reboot code.
JeanDo
parents: 235
diff changeset
1969 temp2 = ppN2 - pres_tissue[ci];
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1970 if (temp2 >= 0.0)
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 }
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1975 else
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1976 temp1 = temp1 / temp2;
251
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
1977 if( 0.0 < temp1 && temp1 < 1.0 )
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1978 {
260
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1979 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
1980 assert( 4.0 <= var_N2_halftime && var_N2_halftime <= 635.0 );
252
8b252ff2eded Bug bb13 : strange failling assertion...
JeanDo
parents: 251
diff changeset
1981
260
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1982 // 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
1983 // minus because log is negative.
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
1984 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
1985 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
1986
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1987 }
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1988 else
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1989 {
233
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
1990 temp1 = 0.0;
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
1991 temp2 = 0.0;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1992 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
1993
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1994 // He
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
1995 temp3 = 0.1 - (pres_tissue+16)[ci];
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1996 if (temp3 >= 0.0)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
1997 {
233
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
1998 temp3 = 0.0;
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
1999 temp4 = 0.0;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2000 }
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2001 else
260
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
2002 temp3 = - temp3 / (pres_tissue+16)[ci];
251
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
2003 if( 0.0 < temp3 && temp3 < 1.0 )
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2004 {
260
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
2005 overlay float var_He_halftime = (buhlmann_ht+16)[ci];
261
9d4ab7c96885 Fix first stop rounding in GF model.
JeanDo
parents: 260
diff changeset
2006 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
2007
bde83cac971f BUGFIX bb13 : deco_calc_desaturation_time() should reset TBLPTR Upper register.
JeanDo
parents: 258
diff changeset
2008 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
2009 // 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
2010 // minus because log is negative
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
2011 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
2012 }
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2013 else
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2014 {
233
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
2015 temp3 = 0.0;
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
2016 temp4 = 0.0;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2017 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2018
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2019 // saturation_time (for flight)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2020 if (temp4 > temp2)
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
2021 desat_time = (unsigned short)temp4;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2022 else
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
2023 desat_time = (unsigned short)temp2;
252
8b252ff2eded Bug bb13 : strange failling assertion...
JeanDo
parents: 251
diff changeset
2024
251
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
2025 if(desat_time > int_O_desaturation_time)
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
2026 int_O_desaturation_time = desat_time;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2027
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2028 // N2 saturation in multiples of halftime for display purposes
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2029 temp2 = temp1 * 20.0; // 0 = 1/8, 120 = 0, 249 = 8
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2030 temp2 = temp2 + 80.0; // set center
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2031 if (temp2 < 0.0)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2032 temp2 = 0.0;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2033 if (temp2 > 255.0)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2034 temp2 = 255.0;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2035 char_O_tissue_saturation[ci] = (char)temp2;
233
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
2036
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2037 // He saturation in multiples of halftime for display purposes
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2038 temp4 = temp3 * 20.0; // 0 = 1/8, 120 = 0, 249 = 8
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2039 temp4 = temp4 + 80.0; // set center
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2040 if (temp4 < 0.0)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2041 temp4 = 0.0;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2042 if (temp4 > 255.0)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2043 temp4 = 255.0;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2044 (char_O_tissue_saturation+16)[ci] = (char)temp4;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2045 } // for
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2046 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2047
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2048 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2049 // calc_wo_deco_step_1_min
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2050 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2051 // FIXED N2 Ratio
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2052 // optimized in v.101 (...saturation_multiplier)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2053 // desaturation slowed down to 70,42%
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2054 //
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2055 static void calc_wo_deco_step_1_min(void)
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2056 {
251
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
2057 assert( 800 < int_I_pres_surface && int_I_pres_surface < 1100 );
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
2058 assert( 800 < int_I_pres_respiration && int_I_pres_respiration < 1100 );
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
2059 assert( 100 <= char_I_saturation_multiplier && char_I_saturation_multiplier < 200 );
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
2060 assert( 0 < char_I_desaturation_multiplier && char_I_desaturation_multiplier <= 100 );
f0cba9cff25c Still hunting for bb13...
JeanDo
parents: 247
diff changeset
2061
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2062 if(flag_in_divemode)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2063 {
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2064 flag_in_divemode = 0;
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2065 set_dbg_end_of_dive();
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2066 }
122
3003a8040b78 FIX again reset C data stack and frame pointer when entering C code.
JeanDo
parents: 116
diff changeset
2067
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2068 N2_ratio = 0.7902; // FIXED, sum lt. buehlmann
233
2cbaa01dac26 Hunting for NoFly (bug BB13)... not found yet...
JeanDo
parents: 226
diff changeset
2069 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
2070 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
2071 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
2072 ppHe = 0.0;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2073 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
2074 float_saturation_multiplier = char_I_saturation_multiplier * 0.01;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2075
192
c8816e4bc724 GF Model
JeanDo
parents: 186
diff changeset
2076 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
2077
169
e26f49674956 Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents: 168
diff changeset
2078 clear_deco_table();
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
2079 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
2080 char_O_nullzeit = 0;
168
494587193f5d Use 16bits for TTS sum.
JeanDo
parents: 167
diff changeset
2081 int_O_ascenttime = 0;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2082 calc_gradient_factor();
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2083 }
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2084
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2085 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2086 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2087 ////////////////////////////////// deco_hash /////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2088 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2089 //////////////////////////////////////////////////////////////////////////////
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2090
184
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
2091 #ifndef CROSS_COMPILE
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2092 void deco_hash(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2093 {
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2094 overlay unsigned char md_i, md_j; // Loop index.
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2095 overlay unsigned char md_t;
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2096 overlay unsigned char md_buffer[16];
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2097 overlay unsigned char md_temp;
203
2d9af08ed0ac BUGFIX Gas switch
JeanDo
parents: 201
diff changeset
2098 overlay unsigned short md_pointer;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2099
122
3003a8040b78 FIX again reset C data stack and frame pointer when entering C code.
JeanDo
parents: 116
diff changeset
2100 RESET_C_STACK
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2101
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2102 // init
164
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
2103 for(md_i=0;md_i<16;md_i++)
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2104 {
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2105 md_state[md_i] = 0;
164
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
2106 char_O_hash[md_i] = 0;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2107 } // for md_i 16
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2108
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2109 _asm
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2110 movlw 0x01 // md_pi address.
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2111 movwf TBLPTRU,0
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2112 movlw 0x7E
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2113 movwf TBLPTRH,0
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2114 movlw 0x00
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2115 movwf TBLPTRL,0
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2116 _endasm;
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
2117 md_i = 0;
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
2118 do {
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2119 _asm
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2120 TBLRDPOSTINC
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2121 movff TABLAT,md_temp
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2122 _endasm
165
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
2123 md_pi_subst[md_i++] = md_temp;
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
2124 } while( md_i != 0 );
8b5b848db4cd + Clean Buhlmann tables addressing
JeanDo
parents: 164
diff changeset
2125
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2126 _asm
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2127 movlw 0x00
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2128 movwf TBLPTRU,0
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2129 movlw 0x00
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2130 movwf TBLPTRH,0
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2131 movlw 0x00
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2132 movwf TBLPTRL,0
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2133 _endasm
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2134
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2135 // cycle buffers
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2136 for (md_pointer=0x0000;md_pointer<0x17f3;md_pointer++)
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 md_t = 0;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2139 for (md_i=0;md_i<16;md_i++)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2140 {
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2141 if(md_pointer == 9)
164
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
2142 md_temp = char_O_hash[md_i];
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2143 else
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2144 {
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2145 _asm
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2146 TBLRDPOSTINC
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2147 movff TABLAT,md_temp
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2148 _endasm
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2149 } // else
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2150
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2151 md_buffer[md_i] = md_temp;
186
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
2152 md_state[md_i+16] = md_temp;
57a654c199ae BUGFIX Gradient Factor algo.
JeanDo
parents: 185
diff changeset
2153 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
2154 } // for md_i 16
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2155
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2156 for (md_i=0;md_i<18;md_i++)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2157 {
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2158 for (md_j=0;md_j<48;md_j++)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2159 {
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2160 md_state[md_j] ^= md_pi_subst[md_t];
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2161 md_t = md_state[md_j];
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2162 } // for md_j 48
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2163 md_t = (unsigned char)(md_t+1);
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2164 } // for md_i 18
164
999abb01c78f + Change data allocation scheme
JeanDo
parents: 163
diff changeset
2165 md_t = char_O_hash[15];
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2166
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2167 for (md_i=0;md_i<16;md_i++)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2168 {
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2169 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
2170 md_t = char_O_hash[md_i];
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2171 } // for md_i 16
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2172 } // for md_pointer
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2173 } // void deco_hash(void)
184
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
2174 #endif
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2175
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2176 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2177 // deco_clear_CNS_fraction
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2178 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2179 // new in v.101
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2180 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2181 void deco_clear_CNS_fraction(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2182 {
122
3003a8040b78 FIX again reset C data stack and frame pointer when entering C code.
JeanDo
parents: 116
diff changeset
2183 RESET_C_STACK
237
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
2184
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2185 CNS_fraction = 0.0;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2186 char_O_CNS_fraction = 0;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2187 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2188
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2189 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2190 // deco_calc_CNS_fraction
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2191 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2192 // new in v.101
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2193 // 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
2194 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2195 // Input: char_I_actual_ppO2
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2196 // Output: char_O_CNS_fraction
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2197 // Uses and Updates: CNS_fraction
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2198 // Uses: acutal_ppO2
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2199 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2200 void deco_calc_CNS_fraction(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2201 {
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2202 overlay float actual_ppO2;
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2203 RESET_C_STACK
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2204
237
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
2205 assert( 0.0 <= CNS_fraction && CNS_fraction <= 2.5 );
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
2206 assert( char_I_actual_ppO2 > 15 );
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
2207
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2208 actual_ppO2 = (float)char_I_actual_ppO2 / 100.0;
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2209
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2210 if (char_I_actual_ppO2 < 50)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2211 CNS_fraction = CNS_fraction;// no changes
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2212 else if (char_I_actual_ppO2 < 60)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2213 CNS_fraction = 1/(-54000.0 * actual_ppO2 + 54000.0) + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2214 else if (char_I_actual_ppO2 < 70)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2215 CNS_fraction = 1/(-45000.0 * actual_ppO2 + 48600.0) + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2216 else if (char_I_actual_ppO2 < 80)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2217 CNS_fraction = 1/(-36000.0 * actual_ppO2 + 42300.0) + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2218 else if (char_I_actual_ppO2 < 90)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2219 CNS_fraction = 1/(-27000.0 * actual_ppO2 + 35100.0) + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2220 else if (char_I_actual_ppO2 < 110)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2221 CNS_fraction = 1/(-18000.0 * actual_ppO2 + 27000.0) + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2222 else if (char_I_actual_ppO2 < 150)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2223 CNS_fraction = 1/(-9000.0 * actual_ppO2 + 17100.0) + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2224 else if (char_I_actual_ppO2 < 160)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2225 CNS_fraction = 1/(-22500.0 * actual_ppO2 + 37350.0) + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2226 else if (char_I_actual_ppO2 < 165)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2227 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
2228 else if (char_I_actual_ppO2 < 170)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2229 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
2230 else if (char_I_actual_ppO2 < 175)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2231 CNS_fraction = 0.00136 + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2232 else if (char_I_actual_ppO2 < 180)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2233 CNS_fraction = 0.00180 + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2234 else if (char_I_actual_ppO2 < 185)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2235 CNS_fraction = 0.00237 + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2236 else if (char_I_actual_ppO2 < 190)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2237 CNS_fraction = 0.00310 + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2238 else if (char_I_actual_ppO2 < 195)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2239 CNS_fraction = 0.00401 + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2240 else if (char_I_actual_ppO2 < 200)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2241 CNS_fraction = 0.00517 + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2242 else if (char_I_actual_ppO2 < 230)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2243 CNS_fraction = 0.0209 + CNS_fraction;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2244 else
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2245 CNS_fraction = 0.0482 + CNS_fraction; // value for 2.5
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2246
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2247 if (CNS_fraction > 2.5)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2248 CNS_fraction = 2.5;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2249 if (CNS_fraction < 0.0)
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2250 CNS_fraction = 0.0;
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2251
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2252 char_O_CNS_fraction = (char)((CNS_fraction + 0.005)* 100.0);
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2253 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2254
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2255 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2256 // deco_calc_CNS_decrease_15min
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2257 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2258 // new in v.101
167
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 // 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
2261 // (Used in sleepmode, for low battery mode).
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2262 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2263 // Output: char_O_CNS_fraction
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2264 // Uses and Updates: CNS_fraction
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2265 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2266 void deco_calc_CNS_decrease_15min(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2267 {
237
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
2268 RESET_C_STACK
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
2269 assert( 0.0 <= CNS_fraction && CNS_fraction <= 2.5 );
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
2270
126
ed275788a291 Re-indent c-code. Add .o file.
JeanDo
parents: 122
diff changeset
2271 CNS_fraction = 0.890899 * CNS_fraction;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2272 char_O_CNS_fraction = (char)(CNS_fraction * 100.0 + 0.5);
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2273 }
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2274
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2275 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2276 // deco_calc_percentage
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2277 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2278 // new in v.101
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2279 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2280 // calculates int_I_temp * char_I_temp / 100
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2281 // output is int_I_temp
200
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
2282 //
0a3ca358c684 BUGFIX clear decotable at begin of simulator mode.
JeanDo
parents: 197
diff changeset
2283 // 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
2284 //
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2285 void deco_calc_percentage(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2286 {
122
3003a8040b78 FIX again reset C data stack and frame pointer when entering C code.
JeanDo
parents: 116
diff changeset
2287 RESET_C_STACK
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2288
237
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
2289 assert( 60 <= char_I_temp && char_I_temp <= 100 );
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
2290 assert( 0 <= int_I_temp && int_I_temp < 2880 ); // Less than 48h...
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
2291
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2292 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
2293
55178aa1f972 Hunting for NoFly bug...
JeanDo
parents: 236
diff changeset
2294 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
2295 }
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2296
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 //////////////////////////////////////////////////////////////////////////////
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2299 // deco_gas_volumes
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2300 //
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2301 // new in v.111
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2302 //
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2303 // calculates volumes for each gas.
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2304 //
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2305 // 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
2306 // Gas list.
d995e220ddac BUGFIX Gas Usage when first gas is not #1 (bug BB22).
JeanDo
parents: 237
diff changeset
2307 // 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
2308 // 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
2309 // 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
2310 // 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
2311 // CF#57 == deco deci-liters/minutes (0.5 .. 50.0) or bar/min.
224
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
2312 // 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
2313 //
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2314 void deco_gas_volumes(void)
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2315 {
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2316 overlay float volumes[5];
265
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2317 overlay float bottom_usage, ascent_usage;
234
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2318 overlay unsigned char i, deepest_first;
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
2319 overlay unsigned char gas;
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2320 RESET_C_STACK
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2321
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2322 //---- initialize with bottom consumption --------------------------------
240
d995e220ddac BUGFIX Gas Usage when first gas is not #1 (bug BB22).
JeanDo
parents: 237
diff changeset
2323 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
2324 volumes[i] = 0.0;
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2325
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
2326 assert(1 <= char_I_first_gas && char_I_first_gas <= 5);
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
2327 gas = char_I_first_gas - 1;
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
2328
265
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2329 bottom_usage = read_custom_function(56) * 0.1;
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2330 if( bottom_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) // Use Psurface = 1.0 bar.
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2333 * char_I_bottom_time // in minutes.
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2334 * bottom_usage; // In liter/minutes.
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
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2338 //---- Ascent usage ------------------------------------------------------
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2339
234
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2340 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
2341 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
2342
224
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
2343 // Usage up to the first stop:
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
2344 // - 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
2345 // - with an ascent speed of 10m/min.
224
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
2346 // - with ascent litter / minutes.
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2347 // - still using bottom gas:
265
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2348 if( ascent_usage > 0.0 )
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2349 volumes[gas]
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2350 += (char_I_bottom_depth*0.1 + 1.0) // Depth -> bar
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2351 * (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
2352 * ascent_usage; // Consumption ( xxx / min @ 1 bar)
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2353 else
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2354 volumes[gas] = 65535.0;
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2355
234
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2356 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
2357 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
2358 overlay unsigned char j;
234
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2359 overlay unsigned char depth, time, ascent;
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2360
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2361 // Manage stops in reverse order (CF#54)
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2362 if( deepest_first )
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2363 {
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
2364 time = char_O_deco_time[i];
234
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2365 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
2366
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2367 ascent = depth = char_O_deco_depth[i];
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2368 if( i < 31 )
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2369 ascent -= char_O_deco_depth[i+1];
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2370 }
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2371 else
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2372 {
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2373 time = char_O_deco_time[31-i];
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2374 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
2375
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2376 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
2377 if( i < 31 )
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2378 ascent -= char_O_deco_depth[30-i];
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2379 }
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2380
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2381 // Gas switch depth ?
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
2382 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
2383 {
234
bb8940caebe1 BUGFIX Gas Usage when stops are shallowest first: CF54 (bug BB24).
JeanDo
parents: 233
diff changeset
2384 if( depth <= char_I_deco_gas_change[j] )
241
f44274d8440a Model cleanups.
JeanDo
parents: 240
diff changeset
2385 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
2386 gas = j;
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2387 }
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2388
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2389 // usage during stop:
224
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
2390 // Note: because first gas is not in there, increment gas+1
265
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2391 if( ascent_usage > 0.0 )
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2392 volumes[gas] += (depth*0.1 + 1.0) // depth --> bar.
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2393 * time // in minutes.
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2394 * ascent_usage // in xxx / min @ 1bar.
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2395 // Plus usage during ascent to the next stop, at 10m/min.
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2396 + (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
2397 * ascent*0.1 // metre --> min
265
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2398 * ascent_usage;
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2399 else
ab8ce7de2b46 BUGFIX zero gas rate (bug bb28).
JeanDo
parents: 264
diff changeset
2400 volumes[gas] = 65535.0;
222
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2401 }
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2402
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2403 //---- convert results for the ASM interface -----------------------------
638f8e17bd51 Prototyping deco_gas_volumes() to compute gas consumption per tank with decoplanning.
JeanDo
parents: 218
diff changeset
2404 for(i=0; i<5; ++i)
224
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
2405 if( volumes[i] > 6553.4 )
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
2406 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
2407 else
224
49c90c5d9603 Gas usage
JeanDo
parents: 222
diff changeset
2408 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
2409 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2410
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2411 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2412
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2413 void deco_push_tissues_to_vault(void)
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 overlay unsigned char x;
122
3003a8040b78 FIX again reset C data stack and frame pointer when entering C code.
JeanDo
parents: 116
diff changeset
2416 RESET_C_STACK
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2417
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2418 cns_vault = CNS_fraction;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2419 for (x=0;x<32;x++)
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2420 pres_tissue_vault[x] = pres_tissue[x];
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2421 }
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2422
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2423 void deco_pull_tissues_from_vault(void)
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2424 {
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2425 overlay unsigned char x;
122
3003a8040b78 FIX again reset C data stack and frame pointer when entering C code.
JeanDo
parents: 116
diff changeset
2426 RESET_C_STACK
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2427
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2428 CNS_fraction = cns_vault;
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2429 for (x=0;x<32;x++)
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2430 pres_tissue[x] = pres_tissue_vault[x];
116
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2431 }
14a074e1a375 Split C code, and use direct linking.
JeanDo
parents:
diff changeset
2432
167
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2433 //////////////////////////////////////////////////////////////////////////////
cb055a7d75f3 + Use overlay local vars.
JeanDo
parents: 165
diff changeset
2434 //
184
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
2435 #ifndef CROSS_COMPILE
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
2436 void main() {}
016c45a0caaf Enable to compile p2_deco.c on other platforms.
JeanDo
parents: 171
diff changeset
2437 #endif