Mercurial > public > mk2
annotate code_part1/OSTC_code_asm_part1/simulator.asm @ 575:cbdcbbc91877
some code cleaning
| author | heinrichsweikamp |
|---|---|
| date | Sat, 21 Apr 2012 15:08:09 +0200 |
| parents | 3091628b2742 |
| children | ab2686087bce |
| rev | line source |
|---|---|
| 0 | 1 |
| 2 ; OSTC - diving computer code | |
| 3 ; Copyright (C) 2008 HeinrichsWeikamp GbR | |
| 4 | |
| 5 ; This program is free software: you can redistribute it and/or modify | |
| 6 ; it under the terms of the GNU General Public License as published by | |
| 7 ; the Free Software Foundation, either version 3 of the License, or | |
| 8 ; (at your option) any later version. | |
| 9 | |
| 10 ; This program is distributed in the hope that it will be useful, | |
| 11 ; but WITHOUT ANY WARRANTY; without even the implied warranty of | |
| 12 ; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
| 13 ; GNU General Public License for more details. | |
| 14 | |
| 15 ; You should have received a copy of the GNU General Public License | |
| 16 ; along with this program. If not, see <http://www.gnu.org/licenses/>. | |
| 17 | |
| 18 | |
| 19 ; menu "Simulator" | |
| 20 ; written by: Matthias Heinrichs, info@heinrichsweikamp.com | |
| 21 ; written: 081210 | |
| 22 ; last updated: 081210 | |
| 23 ; known bugs: | |
| 24 ; ToDo: | |
| 25 | |
| 430 | 26 ;============================================================================= |
| 27 ; Temp data, local to this module, moved to ACCES0 area. | |
| 28 ; | |
| 29 CBLOCK tmp ; Into safe (from C library) area. | |
| 30 sim_btm_time ; Simulated bottom time | |
| 31 sim_btm_depth ; Simulated max depth | |
| 32 sim_CNS ; Backup CNS value during decoplanning. | |
| 33 ENDC | |
| 34 | |
| 35 ;============================================================================= | |
| 36 | |
| 0 | 37 menu_simulator: |
|
352
544a96faa9f3
New "Quit sim" option in simulated dive mode, CF02 now allows more then 240seconds, Bugfix with runtime=1min in runtime simulator
Heinrichsweikamp
parents:
344
diff
changeset
|
38 movlw d'3' |
| 430 | 39 movwf sim_btm_time ; Bottom time |
| 0 | 40 movlw d'15' |
| 430 | 41 movwf sim_btm_depth ; Max. Depth |
| 0 | 42 movlw d'1' |
| 43 movwf menupos | |
| 369 | 44 clrf WREG ; Interval |
| 45 movff WREG,char_I_dive_interval | |
| 0 | 46 |
| 47 menu_simulator1: | |
| 48 clrf timeout_counter2 | |
| 49 bsf menubit | |
| 50 bsf cursor | |
| 49 | 51 call PLED_brightness_full ;max. brightness |
| 0 | 52 call PLED_ClearScreen |
| 53 call PLED_simulator_mask | |
| 54 | |
| 55 menu_simulator2: | |
| 56 bcf switch_left | |
| 57 bcf switch_right | |
| 58 bcf menubit2 | |
| 59 bcf menubit3 | |
| 60 call PLED_simulator_data | |
| 61 call PLED_menu_cursor | |
| 62 | |
| 63 menu_simulator_loop: | |
| 64 call check_switches_menu | |
| 65 menu_simulator_loop2: | |
| 575 | 66 btfsc onesecupdate |
| 67 call menu_check_dive_and_timeout ; "Goto restart" or sets sleepmode flag | |
| 0 | 68 bcf onesecupdate ; End of one second tasks |
| 69 | |
| 70 btfsc menubit2 | |
| 71 goto menu_simulator_do ; call submenu | |
| 72 | |
| 73 btfss menubit | |
| 35 | 74 goto menu_simulator_exit |
| 0 | 75 |
| 76 btfsc sleepmode | |
| 35 | 77 goto menu_simulator_exit |
| 0 | 78 |
| 79 bra menu_simulator_loop | |
| 80 | |
| 81 menu_simulator_do: ; calls submenu | |
| 82 dcfsnz menupos,F | |
| 369 | 83 bra simulator_inc_interval |
| 84 dcfsnz menupos,F | |
| 0 | 85 bra simulator_startdive |
| 86 dcfsnz menupos,F | |
| 87 bra simulator_inc_bottomtime | |
| 88 dcfsnz menupos,F | |
| 89 bra simulator_inc_maxdepth | |
| 90 dcfsnz menupos,F | |
| 91 bra simulator_calc_deco | |
| 369 | 92 |
| 35 | 93 menu_simulator_exit: |
| 0 | 94 movlw d'4' |
| 95 movwf menupos | |
| 369 | 96 goto more_menu2 ; exit... |
| 0 | 97 |
| 369 | 98 simulator_inc_interval: |
| 99 movff char_I_dive_interval,PRODL | |
| 389 | 100 movlw .3 |
| 101 addwf PRODL,F | |
| 369 | 102 movlw .24*6 ; Max 24h delay. |
| 103 cpfslt PRODL | |
| 104 clrf PRODL | |
| 105 movff PRODL,char_I_dive_interval | |
| 106 | |
| 107 movlw d'1' | |
| 108 movwf menupos | |
| 109 bra menu_simulator2 | |
| 110 | |
| 0 | 111 simulator_inc_bottomtime: |
| 112 movlw d'2' | |
| 430 | 113 addwf sim_btm_time,F ; Here: Bottomtime in m |
| 0 | 114 movlw d'199' |
| 430 | 115 cpfslt sim_btm_time |
| 116 movwf sim_btm_time | |
| 369 | 117 movlw d'3' |
| 0 | 118 movwf menupos |
| 119 bra menu_simulator2 | |
| 120 | |
| 121 simulator_inc_maxdepth: | |
| 122 movlw d'3' | |
| 430 | 123 addwf sim_btm_depth,F ; Here: Maxdepth in m |
|
415
d022c62a1df5
fixing issue with end-of-dive threshold in high-altitude mode
heinrichsweikamp
parents:
398
diff
changeset
|
124 movlw d'120' |
| 430 | 125 cpfslt sim_btm_depth |
| 126 movwf sim_btm_depth | |
| 369 | 127 movlw d'4' |
| 0 | 128 movwf menupos |
| 129 bra menu_simulator2 | |
| 130 | |
| 369 | 131 ;============================================================================= |
| 132 | |
| 0 | 133 simulator_startdive: |
| 33 | 134 ; Descent to -15m depth |
| 0 | 135 ; Set standalone_simulator flag (Displays Simulator menu during simulation by pressing ENTER button) |
| 136 ; Clear standalone_simulator after (any) dive | |
| 137 bsf simulatormode_active ; normal simulator mode | |
| 138 bsf standalone_simulator ; Standalone Simulator active | |
| 369 | 139 |
| 430 | 140 movff sim_btm_depth,xA+0 |
| 0 | 141 clrf xA+1 |
| 142 movlw d'100' | |
| 143 movwf xB+0 | |
| 144 clrf xB+1 | |
| 145 call mult16x16 ;xA*xB=xC ; Depth in m*100 | |
| 146 | |
| 62 | 147 movlw LOW d'1000' |
| 0 | 148 addwf xC+0,F |
| 62 | 149 movlw HIGH d'1000' |
|
398
ab962c4b19d6
Fixing issue 50, correct "Bar" to "bar" in texts and comments
heinrichsweikamp
parents:
390
diff
changeset
|
150 addwfc xC+1,F ; add 1000mbar |
| 62 | 151 |
| 0 | 152 movff xC+0,sim_pressure+0 |
| 153 movff xC+1,sim_pressure+1 | |
|
341
2144f19fa1eb
BUGFIX protect against ISR changing pressure/temperature while reading it.
JeanDo
parents:
292
diff
changeset
|
154 |
|
2144f19fa1eb
BUGFIX protect against ISR changing pressure/temperature while reading it.
JeanDo
parents:
292
diff
changeset
|
155 ; This override is done in ISR too, but do it right now also: |
|
2144f19fa1eb
BUGFIX protect against ISR changing pressure/temperature while reading it.
JeanDo
parents:
292
diff
changeset
|
156 movff sim_pressure+0,amb_pressure+0 |
| 0 | 157 movff sim_pressure+1,amb_pressure+1 |
| 385 | 158 call comp_air_pressure0 ; Make sure to have depth in rel_pressure:2 |
| 0 | 159 |
| 160 bcf menubit2 | |
| 161 bcf menubit3 | |
| 162 bcf menubit | |
| 163 bcf switch_left | |
| 164 bcf switch_right | |
| 165 | |
| 369 | 166 call simulator_save_tissue_data ; Stores 32 floats "pre_tissue" into bank3 |
| 0 | 167 |
| 369 | 168 movff char_I_dive_interval,WREG ; Any interval ? |
| 169 iorlw 0 ; Test for null | |
| 170 btfss STATUS,Z | |
| 171 call deco_calc_dive_interval ; NZ: call interval subroutine. | |
| 172 movlb 1 | |
| 173 | |
| 174 movlw d'3' ; Begin of deco cycle (reset table). | |
| 175 movff WREG,char_O_deco_status ; Reset Deco module. | |
| 200 | 176 |
| 369 | 177 bsf divemode ; Set divemode flag |
| 178 ostc_debug 'P' ; Sends debug-information to screen if debugmode active | |
| 179 goto diveloop ; Start Divemode | |
| 0 | 180 |
|
279
8514588eb6a2
Mark gas-switch stops for decoplans, displayed in yellow.
JeanDo
parents:
278
diff
changeset
|
181 ;============================================================================= |
|
8514588eb6a2
Mark gas-switch stops for decoplans, displayed in yellow.
JeanDo
parents:
278
diff
changeset
|
182 ; Show decoplanning result. |
|
8514588eb6a2
Mark gas-switch stops for decoplans, displayed in yellow.
JeanDo
parents:
278
diff
changeset
|
183 ; |
| 0 | 184 simulator_show_decoplan: |
| 124 | 185 call PLED_ClearScreen |
| 186 call PLED_simdata_screen | |
| 187 call divemenu_see_decoplan | |
| 188 | |
| 184 | 189 WIN_LEFT .0 |
| 190 call PLED_standard_color | |
| 191 | |
| 124 | 192 ; Display TTS, if any... |
| 168 | 193 movff int_O_ascenttime+0,lo |
| 194 movff int_O_ascenttime+1,hi | |
| 195 movf lo,W | |
| 196 iorwf hi,W | |
| 124 | 197 bz simulator_decoplan_notts |
| 184 | 198 |
| 292 | 199 WIN_TOP .162 |
| 184 | 200 lfsr FSR2, letter |
|
279
8514588eb6a2
Mark gas-switch stops for decoplans, displayed in yellow.
JeanDo
parents:
278
diff
changeset
|
201 OUTPUTTEXT .85 ; TTS |
| 184 | 202 STRCAT ": " |
| 203 bsf leftbind | |
| 204 output_16 | |
| 205 STRCAT_PRINT "'" | |
| 206 | |
| 207 simulator_decoplan_notts: | |
| 292 | 208 WIN_TOP .190 ; Print calculated CNS before and after dive |
| 440 | 209 |
| 210 incf sim_CNS,W ; Detect CNS simulation overflow. | |
| 211 bz simulator_decoplan_cns_1 | |
| 212 | |
| 213 movlw .100 ; Detect if CNS > 100% | |
| 214 cpfslt sim_CNS | |
| 215 call PLED_warnings_color ; Yes: draw in red ! | |
| 216 | |
| 445 | 217 STRCPY TXT_CNS4 |
| 292 | 218 movff char_O_CNS_fraction,lo ; Current CNS, before dive. |
| 219 output_8 | |
| 220 STRCAT "%\x92" ; Right-arrow | |
| 440 | 221 |
| 430 | 222 movff sim_CNS,lo ; Get back CNS value. |
| 292 | 223 output_8 ; CNS after dive. |
| 224 STRCAT_PRINT "%" | |
| 440 | 225 bra simulator_decoplan_cns_2 |
| 124 | 226 |
| 440 | 227 simulator_decoplan_cns_1: |
| 228 call PLED_warnings_color ; Yes: draw in red ! | |
| 445 | 229 STRCPY_PRINT TXT_CNSGR10 |
| 440 | 230 |
| 231 simulator_decoplan_cns_2: | |
| 232 call PLED_standard_color ; Back to normal. | |
| 124 | 233 WIN_INVERT .1 ; Init new Wordprocessor |
| 234 DISPLAYTEXT .188 ; Sim. Results: | |
| 235 WIN_INVERT .0 ; Init new Wordprocessor | |
| 34 | 236 |
| 64 | 237 simulator_show_decoplan1: |
| 369 | 238 bcf switch_left |
| 239 bcf switch_right | |
| 0 | 240 simulator_show_decoplan2: |
| 575 | 241 btfsc uart_dump_screen ; Asked to dump screen contains ? |
| 242 call dump_screen ; Yes! | |
| 369 | 243 |
| 575 | 244 btfsc onesecupdate |
| 245 call menu_check_dive_and_timeout ; "Goto restart" or sets sleepmode flag | |
| 246 | |
| 247 bcf onesecupdate ; End of one second tasks | |
| 0 | 248 |
| 249 simulator_show_decoplan3: | |
| 64 | 250 btfsc switch_right |
| 369 | 251 bra menu_simulator1 ; Quit display |
| 0 | 252 |
| 64 | 253 btfsc switch_left |
| 224 | 254 bra simulator_show_decoplan5 ; Next decoplan-page. |
| 0 | 255 |
| 256 btfsc sleepmode | |
| 257 goto more_menu | |
| 258 | |
| 259 bra simulator_show_decoplan2 | |
| 260 | |
| 64 | 261 simulator_show_decoplan5: |
| 124 | 262 incf decoplan_page,F |
| 64 | 263 btfsc last_ceiling_gf_shown ; last ceiling shown? |
| 264 bra simulator_show_decoplan5_0 ; All done, clear and return | |
| 265 | |
|
169
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
168
diff
changeset
|
266 call PLED_decoplan ; Re-Draw Current page of GF Decoplan |
| 64 | 267 bra simulator_show_decoplan1 |
| 268 | |
|
231
f9d42f8ff97b
BUGFIX Don't show (nosense) gas consumption in CCR mode (bug BB20).
JeanDo
parents:
230
diff
changeset
|
269 ;---- In OCR mode, show the gas Usage special page --------------------------- |
|
f9d42f8ff97b
BUGFIX Don't show (nosense) gas consumption in CCR mode (bug BB20).
JeanDo
parents:
230
diff
changeset
|
270 simulator_show_decoplan5_0: |
|
f9d42f8ff97b
BUGFIX Don't show (nosense) gas consumption in CCR mode (bug BB20).
JeanDo
parents:
230
diff
changeset
|
271 btfss display_see_deco ; Already displayed ? |
| 369 | 272 bra menu_simulator1 ; Exit to menu. |
|
231
f9d42f8ff97b
BUGFIX Don't show (nosense) gas consumption in CCR mode (bug BB20).
JeanDo
parents:
230
diff
changeset
|
273 |
|
169
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
168
diff
changeset
|
274 bcf display_see_deco ; clear flag |
| 224 | 275 |
|
231
f9d42f8ff97b
BUGFIX Don't show (nosense) gas consumption in CCR mode (bug BB20).
JeanDo
parents:
230
diff
changeset
|
276 btfsc FLAG_const_ppO2_mode ; In CCR mode ? |
| 369 | 277 bra menu_simulator1 ; YES: finished. |
|
231
f9d42f8ff97b
BUGFIX Don't show (nosense) gas consumption in CCR mode (bug BB20).
JeanDo
parents:
230
diff
changeset
|
278 |
|
290
4dbff2aa31ee
Hunting for refusing to ignore disabled gas in list...
JeanDo
parents:
279
diff
changeset
|
279 ; Make sure to pass first gas |
|
240
d995e220ddac
BUGFIX Gas Usage when first gas is not #1 (bug BB22).
JeanDo
parents:
236
diff
changeset
|
280 clrf EEADRH |
|
290
4dbff2aa31ee
Hunting for refusing to ignore disabled gas in list...
JeanDo
parents:
279
diff
changeset
|
281 read_int_eeprom .33 ; First gas. |
|
240
d995e220ddac
BUGFIX Gas Usage when first gas is not #1 (bug BB22).
JeanDo
parents:
236
diff
changeset
|
282 movff EEDATA,char_I_first_gas |
| 225 | 283 |
| 284 ; Compute gas consumption for each tank. | |
| 224 | 285 call deco_gas_volumes |
| 286 movlb 1 | |
| 287 | |
|
230
9406a5b0ba5e
BUGFIX Clear bottom stops when display gas usage (bug BB23)
JeanDo
parents:
229
diff
changeset
|
288 ; Clear the complete stop result column: |
| 292 | 289 WIN_BOX_BLACK .0, .239, .85, .160 ;top, bottom, left, right |
| 224 | 290 |
| 291 movlw d'10' | |
| 292 movwf waitms_temp ; Row for gas list is .10+.25 | |
| 293 clrf wait_temp ; Gas counter | |
| 294 lfsr FSR0,int_O_gas_volumes ; Initialize indexed addressing. | |
| 295 | |
| 296 WIN_LEFT .90 ; Set column | |
|
270
fda90f19486a
Don't show gas 1 usage black on back (bb28 followup)
JeanDo
parents:
269
diff
changeset
|
297 call PLED_standard_color |
| 224 | 298 |
| 299 simulator_show_decoplan5_loop: | |
| 300 incf wait_temp,F ; Increment gas # | |
| 301 | |
| 302 movlw .25 | |
| 303 addwf waitms_temp,F ; Increase row position | |
| 304 movff waitms_temp,win_top ; Set Row | |
| 305 | |
| 306 movff POSTINC0,lo ; Read (16bit) result, low first, | |
| 307 movff POSTINC0,hi ; then high. | |
| 308 movf lo,W ; Null ? | |
| 309 iorwf hi,W | |
| 310 bz simulator_show_decoplan5_1 ; Skip printing. | |
| 311 | |
| 312 movf lo,W ; == 65535 (saturated ?) | |
| 225 | 313 andwf hi,W |
| 224 | 314 incf WREG |
| 315 bnz simulator_show_decoplan5_2 | |
| 316 call PLED_warnings_color | |
| 265 | 317 STRCPY_PRINT "= xxxx.x" |
| 318 call PLED_standard_color | |
| 319 bra simulator_show_decoplan5_1 | |
| 224 | 320 |
| 321 simulator_show_decoplan5_2: | |
| 322 STRCPY "= " | |
| 323 | |
| 232 | 324 bsf leftbind |
|
441
4826dd98514b
NEW: Decoplanner OC volumes in liters (or bars), up to 65000.
JeanDo
parents:
440
diff
changeset
|
325 output_16 ; No decimal anymore. |
| 232 | 326 bcf leftbind |
| 224 | 327 call word_processor ; No unit: can be bars or litters. |
| 328 | |
| 329 ; Loop for all 5 gas | |
| 330 simulator_show_decoplan5_1: | |
| 331 movlw d'5' ; list all five gases | |
| 332 cpfseq wait_temp ; All gases shown? | |
| 333 bra simulator_show_decoplan5_loop ; No | |
| 334 | |
| 335 WIN_INVERT 1 | |
|
231
f9d42f8ff97b
BUGFIX Don't show (nosense) gas consumption in CCR mode (bug BB20).
JeanDo
parents:
230
diff
changeset
|
336 DISPLAYTEXTH .301 ; OCR Gas Usage: |
| 224 | 337 WIN_INVERT 0 |
| 338 | |
| 339 bra simulator_show_decoplan1 | |
|
169
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
168
diff
changeset
|
340 |
| 271 | 341 ;============================================================================= |
| 342 ; OSTC Simulator: compute a new runtime | |
| 343 ; | |
| 0 | 344 simulator_calc_deco: |
|
269
be06783f533b
hunting for bug#30 - solved by disabling timer3 (?)
heinrichsweikamp
parents:
265
diff
changeset
|
345 call simulator_save_tissue_data ; Stores 32 floats "pre_tissue" into bank3 |
| 0 | 346 |
| 369 | 347 movff char_I_dive_interval,WREG ; Any interval ? |
| 348 iorlw 0 ; Test for null | |
| 349 btfss STATUS,Z | |
| 350 call deco_calc_dive_interval ; NZ: call interval subroutine. | |
| 351 movlb 1 | |
| 352 | |
| 292 | 353 bsf simulatormode_active ; normal simulator mode |
| 354 bsf standalone_simulator ; Standalone Simulator active | |
| 355 bsf no_sensor_int ; Disable sensor interrupt | |
| 390 | 356 clrf T3CON ; Disable timer3 counter, |
| 292 | 357 clrf TMR3L ; so the simu won't stop right away. |
| 537 | 358 nop |
|
269
be06783f533b
hunting for bug#30 - solved by disabling timer3 (?)
heinrichsweikamp
parents:
265
diff
changeset
|
359 clrf TMR3H |
|
be06783f533b
hunting for bug#30 - solved by disabling timer3 (?)
heinrichsweikamp
parents:
265
diff
changeset
|
360 |
| 292 | 361 call diveloop_boot ; configure gases, etc. |
|
269
be06783f533b
hunting for bug#30 - solved by disabling timer3 (?)
heinrichsweikamp
parents:
265
diff
changeset
|
362 |
| 224 | 363 ; Save dive parameters for gas volume estimation: |
| 430 | 364 movff sim_btm_depth,char_I_bottom_depth |
| 365 movff sim_btm_time,char_I_bottom_time | |
| 224 | 366 |
| 430 | 367 movff sim_btm_depth,xA+0 ; Bottom depth. |
| 0 | 368 clrf xA+1 |
| 369 movlw d'100' | |
| 370 movwf xB+0 | |
| 371 clrf xB+1 | |
| 292 | 372 call mult16x16 ;xA*xB=xC, Depth in m*100 |
| 0 | 373 |
| 62 | 374 movlw LOW d'1000' |
| 0 | 375 addwf xC+0,F |
| 62 | 376 movlw HIGH d'1000' |
|
398
ab962c4b19d6
Fixing issue 50, correct "Bar" to "bar" in texts and comments
heinrichsweikamp
parents:
390
diff
changeset
|
377 addwfc xC+1,F ; add 1000mbar |
| 62 | 378 |
| 0 | 379 movff xC+0,sim_pressure+0 |
| 380 movff xC+1,sim_pressure+1 | |
| 381 | |
| 124 | 382 call PLED_topline_box |
| 0 | 383 WIN_INVERT .1 |
| 292 | 384 DISPLAYTEXT .12 ; "Wait..." |
| 0 | 385 WIN_INVERT .0 |
| 386 | |
|
341
2144f19fa1eb
BUGFIX protect against ISR changing pressure/temperature while reading it.
JeanDo
parents:
292
diff
changeset
|
387 ; This override is done in ISR too, but do it right now also: |
|
2144f19fa1eb
BUGFIX protect against ISR changing pressure/temperature while reading it.
JeanDo
parents:
292
diff
changeset
|
388 movff sim_pressure+0,amb_pressure+0 |
|
269
be06783f533b
hunting for bug#30 - solved by disabling timer3 (?)
heinrichsweikamp
parents:
265
diff
changeset
|
389 movff sim_pressure+1,amb_pressure+1 |
|
be06783f533b
hunting for bug#30 - solved by disabling timer3 (?)
heinrichsweikamp
parents:
265
diff
changeset
|
390 |
| 197 | 391 call divemode_check_decogases ; Checks for decogases and sets the gases |
| 392 call divemode_prepare_flags_for_deco | |
| 292 | 393 call set_first_gas ; Set current N2/He/O2 ratios. |
| 394 call set_actual_ppo2 ; Then configure char_I_actual_ppO2 | |
|
269
be06783f533b
hunting for bug#30 - solved by disabling timer3 (?)
heinrichsweikamp
parents:
265
diff
changeset
|
395 |
| 278 | 396 ; First minute is special: init everything. |
| 200 | 397 movlw d'3' ; Begin of deco cycle (reset table). |
| 197 | 398 movff WREG,char_O_deco_status ; Reset Deco module. |
| 399 | |
| 278 | 400 movlw d'1' |
| 401 movff WREG,char_I_step_is_1min ; 1 minute mode. | |
|
269
be06783f533b
hunting for bug#30 - solved by disabling timer3 (?)
heinrichsweikamp
parents:
265
diff
changeset
|
402 |
| 278 | 403 call deco_calc_hauptroutine ; Reset table + sim one minute for descent. |
| 292 | 404 call deco_calc_CNS_fraction ; Also calculate CNS (in 1min loop) |
| 197 | 405 movlb b'00000001' ; rambank 1 selected |
| 32 | 406 |
| 430 | 407 decf sim_btm_time,F ; One minute done. |
|
439
b9cf06de8aca
BUGFIX: Decoplanner accumulates CNS during ascent (bug #55)
JeanDo
parents:
430
diff
changeset
|
408 bz simulator_calc_deco_loop_end |
| 0 | 409 |
| 278 | 410 ; Loop for bottom time duration |
| 32 | 411 simulator_calc_deco_loop2: |
| 292 | 412 call PLED_simulator_data ; Update display of bottom time. |
| 32 | 413 |
| 292 | 414 call deco_calc_tissue ; JUST calc tissue (faster). |
| 415 call deco_calc_CNS_fraction ; Also calculate CNS (in 1min loop) | |
| 416 movlb b'00000001' ; rambank 1 selected | |
| 417 ostc_debug 'C' ; Sends debug-information to screen if debugmode active | |
| 197 | 418 |
| 430 | 419 decfsz sim_btm_time,F ; Decrement bottom time, |
| 278 | 420 bra simulator_calc_deco_loop2 ; and loop while not finished. |
| 32 | 421 |
|
439
b9cf06de8aca
BUGFIX: Decoplanner accumulates CNS during ascent (bug #55)
JeanDo
parents:
430
diff
changeset
|
422 ; Now the bottom time is finish, restart a full ascent simulation: |
|
b9cf06de8aca
BUGFIX: Decoplanner accumulates CNS during ascent (bug #55)
JeanDo
parents:
430
diff
changeset
|
423 simulator_calc_deco_loop_end: |
| 32 | 424 movlw d'0' |
| 278 | 425 movff WREG,char_I_step_is_1min ; Back to 2 second deco mode |
| 197 | 426 |
| 271 | 427 clrf timeout_counter2 ; timeout used as maxloop here |
| 278 | 428 movff char_I_bottom_depth,char_O_deco_last_stop |
| 429 | |
| 197 | 430 simulator_calc_deco2: |
| 431 call deco_calc_hauptroutine ; calc_tissue | |
| 432 movlb b'00000001' ; rambank 1 selected | |
| 0 | 433 |
| 430 | 434 movff char_O_deco_last_stop,sim_btm_depth |
| 278 | 435 call PLED_simulator_data ; Animate ascent simu. |
| 436 | |
| 271 | 437 dcfsnz timeout_counter2,F ; Abort loop (max. 256 tries)? |
| 262 | 438 bra simulator_calc_deco3 ; Yes... |
| 439 | |
| 197 | 440 movff char_O_deco_status,WREG |
| 278 | 441 iorwf WREG ; deco_status=0 if decompression calculation done |
| 442 bnz simulator_calc_deco2 ; Not finished | |
| 0 | 443 |
| 292 | 444 ; Finished |
| 262 | 445 simulator_calc_deco3: |
|
439
b9cf06de8aca
BUGFIX: Decoplanner accumulates CNS during ascent (bug #55)
JeanDo
parents:
430
diff
changeset
|
446 call deco_calc_CNS_planning ; Compute cNS after full ascent. |
| 442 | 447 movlb 0x01 ; Back to RAM Bank1 |
| 430 | 448 movff char_O_CNS_fraction,sim_CNS ; Save calculated CNS. |
| 292 | 449 rcall simulator_restore_tissue_data ; Restore CNS & 32 floats "pre_tissue" from vault |
| 0 | 450 |
| 197 | 451 bcf simulatormode_active ; normal simulator mode |
| 452 bcf standalone_simulator ; Standalone Simulator active | |
|
269
be06783f533b
hunting for bug#30 - solved by disabling timer3 (?)
heinrichsweikamp
parents:
265
diff
changeset
|
453 bcf no_sensor_int ; Re-enable sensor interrupt |
| 0 | 454 |
| 455 WAITMS d'250' | |
| 456 WAITMS d'250' | |
| 197 | 457 WAITMS d'250' ; Wait for Pressure Sensor to get real pressure again... |
| 0 | 458 |
| 335 | 459 movlw d'5' ; Pre-Set Cursor to "Show Decoplan" |
| 197 | 460 movwf menupos |
| 430 | 461 movff char_I_bottom_time,sim_btm_time ; Restore bottom time, |
| 462 movff char_I_bottom_depth,sim_btm_depth ; and depth. | |
| 369 | 463 |
| 464 clrf timeout_counter2 ; Restart menu timeout. | |
| 465 bra simulator_show_decoplan ; Done. | |
| 49 | 466 |
|
439
b9cf06de8aca
BUGFIX: Decoplanner accumulates CNS during ascent (bug #55)
JeanDo
parents:
430
diff
changeset
|
467 ;============================================================================= |
|
b9cf06de8aca
BUGFIX: Decoplanner accumulates CNS during ascent (bug #55)
JeanDo
parents:
430
diff
changeset
|
468 |
| 49 | 469 simulator_save_tissue_data: |
| 335 | 470 bsf restore_deco_data ; Set restore flag |
| 471 ostc_debug 'S' ; Sends debug-information to screen if debugmode active | |
| 116 | 472 call deco_push_tissues_to_vault |
| 335 | 473 movlb 0x01 ; Back to RAM Bank1 |
| 474 ostc_debug 'T' ; Sends debug-information to screen if debugmode active | |
| 49 | 475 return |
| 476 | |
|
439
b9cf06de8aca
BUGFIX: Decoplanner accumulates CNS during ascent (bug #55)
JeanDo
parents:
430
diff
changeset
|
477 ;============================================================================= |
|
b9cf06de8aca
BUGFIX: Decoplanner accumulates CNS during ascent (bug #55)
JeanDo
parents:
430
diff
changeset
|
478 |
| 49 | 479 simulator_restore_tissue_data: |
|
229
85ea09d3b9d8
Nofly should not be reset after dive simulation (bug BB18).
JeanDo
parents:
225
diff
changeset
|
480 bcf restore_deco_data ; clear restore flag |
|
85ea09d3b9d8
Nofly should not be reset after dive simulation (bug BB18).
JeanDo
parents:
225
diff
changeset
|
481 ostc_debug 'S' ; Sends debug-information to screen if debugmode active |
| 292 | 482 call deco_pull_tissues_from_vault ; Restore CNS too... |
| 49 | 483 movlb 0x01 ; Back to RAM Bank1 |
|
229
85ea09d3b9d8
Nofly should not be reset after dive simulation (bug BB18).
JeanDo
parents:
225
diff
changeset
|
484 ostc_debug 'T' ; Sends debug-information to screen if debugmode active |
| 49 | 485 |
| 486 ostc_debug 'G' ; Sends debug-information to screen if debugmode active | |
| 116 | 487 call deco_calc_desaturation_time ; calculate desaturation time |
|
229
85ea09d3b9d8
Nofly should not be reset after dive simulation (bug BB18).
JeanDo
parents:
225
diff
changeset
|
488 movlb b'00000001' ; select ram bank 1 |
| 519 | 489 |
| 490 ; Reset gradient factor until next computation, to avoid spurious | |
| 491 ; displays after simulation. | |
| 492 clrf WREG | |
| 493 movff WREG,char_O_gradient_factor | |
| 494 movff WREG,char_O_relative_gradient_GF | |
| 495 | |
|
229
85ea09d3b9d8
Nofly should not be reset after dive simulation (bug BB18).
JeanDo
parents:
225
diff
changeset
|
496 ; Note: should not reset nofly-time here: the true value have continued to be decremented |
|
85ea09d3b9d8
Nofly should not be reset after dive simulation (bug BB18).
JeanDo
parents:
225
diff
changeset
|
497 ; during simulation, which is the right thing to do... |
| 49 | 498 ostc_debug 'H' ; Sends debug-information to screen if debugmode active |
| 499 | |
| 500 return |