Mercurial > public > mk2
annotate code_part1/OSTC_code_asm_part1/simulator.asm @ 225:2dc4a7340510
BUGFIX Gas usage for unsorted gas list.
+ Fix detection of saturation (6553.5 l).
+ Better handling of unsorted gas list.
| author | JeanDo |
|---|---|
| date | Thu, 03 Mar 2011 15:52:16 +0100 |
| parents | 49c90c5d9603 |
| children | 85ea09d3b9d8 |
| 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 | |
| 26 menu_simulator: | |
| 27 movlw d'1' | |
| 28 movwf logbook_temp1 ; Bottom time | |
| 29 movlw d'15' | |
| 30 movwf logbook_temp2 ; Max. Depth | |
| 31 movlw d'1' | |
| 32 movwf menupos | |
| 33 | |
| 34 menu_simulator1: | |
| 35 clrf timeout_counter2 | |
| 36 bsf menubit | |
| 37 bsf cursor | |
| 49 | 38 call PLED_brightness_full ;max. brightness |
| 0 | 39 call PLED_ClearScreen |
| 40 call PLED_simulator_mask | |
| 41 | |
| 42 menu_simulator2: | |
| 43 bcf switch_left | |
| 44 bcf switch_right | |
| 45 bcf menubit2 | |
| 46 bcf menubit3 | |
| 47 call PLED_simulator_data | |
| 48 call PLED_menu_cursor | |
| 49 | |
| 50 menu_simulator_loop: | |
| 51 call check_switches_menu | |
| 52 menu_simulator_loop2: | |
| 53 btfss onesecupdate | |
| 54 bra menu_simulator_loop3 | |
| 55 | |
| 56 call timeout_surfmode | |
| 57 call set_dive_modes | |
| 58 call test_charger ; check if charger IC is active | |
| 59 call get_battery_voltage ; get battery voltage | |
| 60 | |
| 61 bcf onesecupdate ; End of one second tasks | |
| 62 | |
| 63 menu_simulator_loop3: | |
| 64 btfsc menubit2 | |
| 65 goto menu_simulator_do ; call submenu | |
| 66 | |
| 67 btfss menubit | |
| 35 | 68 goto menu_simulator_exit |
| 0 | 69 |
| 70 btfsc sleepmode | |
| 35 | 71 goto menu_simulator_exit |
| 0 | 72 |
| 73 btfsc divemode | |
| 74 goto restart ; exit menu, restart and enter divemode | |
| 75 | |
| 76 bra menu_simulator_loop | |
| 77 | |
| 78 menu_simulator_do: ; calls submenu | |
| 79 dcfsnz menupos,F | |
| 80 bra simulator_startdive | |
| 81 dcfsnz menupos,F | |
| 82 bra simulator_inc_bottomtime | |
| 83 dcfsnz menupos,F | |
| 84 bra simulator_inc_maxdepth | |
| 85 dcfsnz menupos,F | |
| 86 bra simulator_calc_deco | |
| 87 dcfsnz menupos,F | |
| 88 bra simulator_show_decoplan | |
| 35 | 89 menu_simulator_exit: |
| 0 | 90 movlw d'4' |
| 91 movwf menupos | |
| 92 goto more_menu2 ; exit... | |
| 93 | |
| 94 simulator_inc_bottomtime: | |
| 95 movlw d'2' | |
| 96 addwf logbook_temp1,F ; Here: Bottomtime in m | |
| 97 movlw d'199' | |
| 98 cpfslt logbook_temp1 | |
| 99 movwf logbook_temp1 | |
| 100 movlw d'2' | |
| 101 movwf menupos | |
| 102 bra menu_simulator2 | |
| 103 | |
| 104 simulator_inc_maxdepth: | |
| 105 movlw d'3' | |
| 106 addwf logbook_temp2,F ; Here: Maxdepth in m | |
| 107 movlw d'99' | |
| 108 cpfslt logbook_temp2 | |
| 109 movwf logbook_temp2 | |
| 110 movlw d'3' | |
| 111 movwf menupos | |
| 112 bra menu_simulator2 | |
| 113 | |
| 114 simulator_startdive: | |
| 33 | 115 ; Descent to -15m depth |
| 0 | 116 ; Set standalone_simulator flag (Displays Simulator menu during simulation by pressing ENTER button) |
| 117 ; Clear standalone_simulator after (any) dive | |
| 118 bsf simulatormode_active ; normal simulator mode | |
| 119 bsf standalone_simulator ; Standalone Simulator active | |
| 120 | |
| 121 movff logbook_temp2,xA+0 | |
| 122 clrf xA+1 | |
| 123 movlw d'100' | |
| 124 movwf xB+0 | |
| 125 clrf xB+1 | |
| 126 call mult16x16 ;xA*xB=xC ; Depth in m*100 | |
| 127 | |
| 62 | 128 movlw LOW d'1000' |
| 0 | 129 addwf xC+0,F |
| 62 | 130 movlw HIGH d'1000' |
| 131 addwfc xC+1,F ; add 1000mBar | |
| 132 | |
| 133 ; movf amb_pressure+0,W | |
| 134 ; addwf xC+0,F | |
| 135 ; movf amb_pressure+1,W | |
| 136 ; addwfc xC+1,F ; Add ambient pressure | |
| 137 ; | |
| 0 | 138 movff xC+0,sim_pressure+0 |
| 139 movff xC+1,sim_pressure+1 | |
| 140 | |
| 141 movff sim_pressure+0,amb_pressure+0 ; override readings with simulator values | |
| 142 movff sim_pressure+1,amb_pressure+1 | |
| 143 | |
| 144 bcf menubit2 | |
| 145 bcf menubit3 | |
| 146 bcf menubit | |
| 147 bcf switch_left | |
| 148 bcf switch_right | |
| 149 | |
| 150 call simulator_save_tissue_data ; Stores 32 floats "pre_tissue" into bank3 | |
| 151 | |
| 200 | 152 movlw d'3' ; Begin of deco cycle (reset table). |
| 153 movff WREG,char_O_deco_status ; Reset Deco module. | |
| 154 | |
| 0 | 155 bsf divemode ; Set divemode flag |
| 156 ostc_debug 'P' ; Sends debug-information to screen if debugmode active | |
| 157 goto diveloop ; Start Divemode | |
| 158 | |
| 159 simulator_show_decoplan: | |
| 124 | 160 call PLED_ClearScreen |
| 161 call PLED_simdata_screen | |
| 162 call divemenu_see_decoplan | |
| 163 | |
| 184 | 164 WIN_LEFT .0 |
| 165 call PLED_standard_color | |
| 166 | |
| 124 | 167 ; Display TTS, if any... |
| 168 | 168 movff int_O_ascenttime+0,lo |
| 169 movff int_O_ascenttime+1,hi | |
| 170 movf lo,W | |
| 171 iorwf hi,W | |
| 124 | 172 bz simulator_decoplan_notts |
| 184 | 173 |
| 124 | 174 WIN_TOP .160 |
| 184 | 175 lfsr FSR2, letter |
| 176 OUTPUTTEXT .85 ; TTS (for translation). | |
| 177 STRCAT ": " | |
| 178 bsf leftbind | |
| 179 output_16 | |
| 180 STRCAT_PRINT "'" | |
| 181 | |
| 182 simulator_decoplan_notts: | |
| 224 | 183 ; Print ambient pressure in DEBUG compile, because if might |
| 184 ; be usefull to calibrate decompression algorithm. | |
| 185 #ifdef __DEBUG | |
| 184 | 186 movff int_I_pres_surface+0,lo |
| 187 movff int_I_pres_surface+1,hi | |
| 188 | |
| 224 | 189 WIN_TOP .190 |
| 184 | 190 lfsr FSR2, letter |
|
169
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
168
diff
changeset
|
191 bsf leftbind |
|
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
168
diff
changeset
|
192 output_16 |
| 124 | 193 bcf leftbind |
| 184 | 194 STRCAT_PRINT " mbar" |
| 224 | 195 #endif |
| 124 | 196 |
| 197 WIN_INVERT .1 ; Init new Wordprocessor | |
| 198 DISPLAYTEXT .188 ; Sim. Results: | |
| 199 WIN_INVERT .0 ; Init new Wordprocessor | |
| 34 | 200 |
| 64 | 201 simulator_show_decoplan1: |
| 0 | 202 bcf switch_left |
| 203 bcf switch_right | |
| 204 simulator_show_decoplan2: | |
| 205 btfss onesecupdate | |
| 206 bra simulator_show_decoplan3 | |
| 207 | |
| 208 call timeout_surfmode | |
| 209 call set_dive_modes | |
| 210 call test_charger ; check if charger IC is active | |
| 211 call get_battery_voltage ; get battery voltage | |
| 212 | |
| 213 bcf onesecupdate ; End of one second tasks | |
| 214 | |
| 215 simulator_show_decoplan3: | |
| 64 | 216 btfsc switch_right |
| 0 | 217 bra simulator_show_decoplan4 ; Quit display |
| 218 | |
| 64 | 219 btfsc switch_left |
| 224 | 220 bra simulator_show_decoplan5 ; Next decoplan-page. |
| 0 | 221 |
| 222 btfsc sleepmode | |
| 223 goto more_menu | |
| 224 | |
| 225 btfsc divemode | |
| 226 goto restart ; exit menu, restart and enter divemode | |
| 227 | |
| 228 bra simulator_show_decoplan2 | |
| 229 | |
| 64 | 230 simulator_show_decoplan5: |
| 124 | 231 incf decoplan_page,F |
| 64 | 232 btfsc last_ceiling_gf_shown ; last ceiling shown? |
| 233 bra simulator_show_decoplan5_0 ; All done, clear and return | |
| 234 | |
|
169
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
168
diff
changeset
|
235 call PLED_decoplan ; Re-Draw Current page of GF Decoplan |
| 64 | 236 bra simulator_show_decoplan1 |
| 237 | |
|
169
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
168
diff
changeset
|
238 simulator_show_decoplan5_0: |
| 224 | 239 btfss display_see_deco |
| 240 bra simulator_show_decoplan4 | |
|
169
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
168
diff
changeset
|
241 bcf display_see_deco ; clear flag |
| 224 | 242 |
| 225 | 243 ; Re-read gas change depth, from the unsorted list. |
| 244 movlw .27 ; Active flags. | |
| 245 movwf EEADR | |
| 246 clrf EEADRH | |
| 247 call read_eeprom | |
| 248 movff EEDATA,waitms_temp ; Save activity flags. | |
| 249 incf EEADR,F ; 28 == Gas#1's change depth. | |
| 250 | |
| 251 lfsr FSR2,char_I_deco_gas_change | |
| 252 movlw 5 | |
| 253 movwf wait_temp | |
| 254 | |
| 255 simulator_show_decoplan5_4: | |
| 256 call read_eeprom | |
| 257 incf EEADR,F | |
| 258 | |
| 259 rrcf waitms_temp ; Roll acticity to cary. | |
| 260 btfss STATUS,C | |
| 261 clrf EEDATA ; If not active, set depth=0 | |
| 262 | |
| 263 movff EEDATA,POSTINC2 ; Write that in depth array. | |
| 264 decfsz wait_temp | |
| 265 bra simulator_show_decoplan5_4 | |
| 266 | |
| 267 ; Compute gas consumption for each tank. | |
| 224 | 268 call deco_gas_volumes |
| 269 movlb 1 | |
| 270 | |
| 225 | 271 ; Display results |
| 224 | 272 call PLED_clear_divemode_menu ; Clear right part. |
| 273 | |
| 274 movlw d'10' | |
| 275 movwf waitms_temp ; Row for gas list is .10+.25 | |
| 276 clrf wait_temp ; Gas counter | |
| 277 lfsr FSR0,int_O_gas_volumes ; Initialize indexed addressing. | |
| 278 | |
| 279 WIN_LEFT .90 ; Set column | |
| 280 | |
| 281 simulator_show_decoplan5_loop: | |
| 282 incf wait_temp,F ; Increment gas # | |
| 283 | |
| 284 movlw .25 | |
| 285 addwf waitms_temp,F ; Increase row position | |
| 286 movff waitms_temp,win_top ; Set Row | |
| 287 | |
| 288 movff POSTINC0,lo ; Read (16bit) result, low first, | |
| 289 movff POSTINC0,hi ; then high. | |
| 290 movf lo,W ; Null ? | |
| 291 iorwf hi,W | |
| 292 bz simulator_show_decoplan5_1 ; Skip printing. | |
| 293 | |
| 294 movf lo,W ; == 65535 (saturated ?) | |
| 225 | 295 andwf hi,W |
| 224 | 296 incf WREG |
| 297 bnz simulator_show_decoplan5_2 | |
| 298 call PLED_warnings_color | |
| 299 STRCPY "> " | |
| 300 bra simulator_show_decoplan5_3 | |
| 301 | |
| 302 simulator_show_decoplan5_2: | |
| 303 call PLED_standard_color | |
| 304 STRCPY "= " | |
| 305 | |
| 306 simulator_show_decoplan5_3: | |
| 307 output_16dp .4 ; 1 decimal. | |
| 308 call word_processor ; No unit: can be bars or litters. | |
| 309 | |
| 310 ; Loop for all 5 gas | |
| 311 simulator_show_decoplan5_1: | |
| 312 movlw d'5' ; list all five gases | |
| 313 cpfseq wait_temp ; All gases shown? | |
| 314 bra simulator_show_decoplan5_loop ; No | |
| 315 | |
| 316 WIN_TOP .2 | |
| 317 WIN_LEFT .0 | |
| 318 WIN_INVERT 1 | |
| 319 STRCPY_PRINT "Gas usage: " | |
| 320 WIN_INVERT 0 | |
| 321 | |
| 322 bra simulator_show_decoplan1 | |
|
169
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
168
diff
changeset
|
323 |
| 0 | 324 simulator_show_decoplan4: |
| 325 movlw d'5' | |
| 326 movwf menupos | |
| 327 bra menu_simulator1 | |
| 328 | |
| 329 | |
| 330 simulator_calc_deco: | |
| 331 call diveloop_boot ; configure gases, etc. | |
| 332 | |
| 333 bsf simulatormode_active ; normal simulator mode | |
| 334 bsf standalone_simulator ; Standalone Simulator active | |
| 335 | |
| 224 | 336 ; Save dive parameters for gas volume estimation: |
| 337 movff logbook_temp2,char_I_bottom_depth | |
| 338 movff logbook_temp1,char_I_bottom_time | |
| 339 | |
| 0 | 340 |
| 197 | 341 movff logbook_temp2,xA+0 ; Bottom depth. |
| 0 | 342 clrf xA+1 |
| 343 movlw d'100' | |
| 344 movwf xB+0 | |
| 345 clrf xB+1 | |
| 346 call mult16x16 ;xA*xB=xC ; Depth in m*100 | |
| 347 | |
| 62 | 348 movlw LOW d'1000' |
| 0 | 349 addwf xC+0,F |
| 62 | 350 movlw HIGH d'1000' |
| 351 addwfc xC+1,F ; add 1000mBar | |
| 352 | |
| 0 | 353 movff xC+0,sim_pressure+0 |
| 354 movff xC+1,sim_pressure+1 | |
| 355 | |
| 356 movff sim_pressure+0,amb_pressure+0 ; override readings with simulator values | |
| 357 movff sim_pressure+1,amb_pressure+1 | |
| 358 | |
| 197 | 359 call simulator_save_tissue_data ; Stores 32 floats "pre_tissue" into bank3 |
| 0 | 360 |
| 124 | 361 call PLED_topline_box |
| 0 | 362 WIN_INVERT .1 |
| 197 | 363 DISPLAYTEXT .12 ; "Wait..." |
| 0 | 364 WIN_INVERT .0 |
| 365 | |
| 197 | 366 call divemode_check_decogases ; Checks for decogases and sets the gases |
| 367 call divemode_prepare_flags_for_deco | |
| 200 | 368 movlw d'3' ; Begin of deco cycle (reset table). |
| 197 | 369 movff WREG,char_O_deco_status ; Reset Deco module. |
| 370 | |
| 0 | 371 simulator_calc_deco_loop1: |
| 197 | 372 call deco_calc_hauptroutine ; calc_tissue |
| 373 movlb b'00000001' ; rambank 1 selected | |
| 32 | 374 |
| 124 | 375 movff char_O_deco_status,WREG |
| 376 tstfsz WREG ; deco_status=0 if decompression calculation done | |
| 197 | 377 bra simulator_calc_deco_loop1 ; Not finished |
| 0 | 378 |
| 31 | 379 movlw d'1' |
| 197 | 380 movff WREG,char_I_step_is_1min ; 1 minute mode |
| 32 | 381 |
| 382 simulator_calc_deco_loop2: | |
| 383 call PLED_simulator_data | |
| 197 | 384 btg LED_red |
| 32 | 385 |
| 197 | 386 call divemode_check_decogases ; Checks for decogases and sets the gases |
| 0 | 387 call divemode_prepare_flags_for_deco |
| 388 | |
| 116 | 389 call deco_calc_hauptroutine ; calc_tissue |
| 197 | 390 movlb b'00000001' ; rambank 1 selected |
| 391 ostc_debug 'C' ; Sends debug-information to screen if debugmode active | |
| 392 | |
| 393 decfsz logbook_temp1,F ; Decrement bottom time. | |
| 394 bra simulator_calc_deco_loop2 | |
| 32 | 395 |
| 396 movlw d'0' | |
| 197 | 397 movff WREG,char_I_step_is_1min ; 2 second deco mode |
| 398 | |
| 399 simulator_calc_deco2: | |
| 200 | 400 btg LED_red |
| 401 | |
| 197 | 402 call divemode_check_decogases ; Checks for decogases and sets the gases |
| 403 call divemode_prepare_flags_for_deco | |
| 32 | 404 |
| 197 | 405 call deco_calc_hauptroutine ; calc_tissue |
| 406 movlb b'00000001' ; rambank 1 selected | |
| 0 | 407 |
| 197 | 408 movff char_O_deco_status,WREG |
| 409 tstfsz WREG ; deco_status=0 if decompression calculation done | |
| 410 bra simulator_calc_deco2 ; Not finished | |
| 0 | 411 |
| 197 | 412 ; Finished |
| 21 | 413 bsf LED_red |
| 0 | 414 |
| 415 call simulator_restore_tissue_data ; Restore 32 floats "pre_tissue" from bank3 | |
| 416 | |
| 197 | 417 bcf simulatormode_active ; normal simulator mode |
| 418 bcf standalone_simulator ; Standalone Simulator active | |
| 0 | 419 |
| 420 WAITMS d'250' | |
| 421 WAITMS d'250' | |
| 197 | 422 WAITMS d'250' ; Wait for Pressure Sensor to get real pressure again... |
| 0 | 423 |
| 197 | 424 bcf LED_red |
| 0 | 425 |
| 197 | 426 movlw d'5' ; Pre-Set Cursor to "Show Decoplan" |
| 427 movwf menupos | |
| 224 | 428 movff char_I_bottom_time,logbook_temp1; restore bottom time. |
| 197 | 429 bra menu_simulator1 ; Done. |
| 49 | 430 |
| 431 simulator_save_tissue_data: | |
| 432 bsf restore_deco_data ; Set restore flag | |
| 433 ostc_debug 'S' ; Sends debug-information to screen if debugmode active | |
| 116 | 434 call deco_push_tissues_to_vault |
| 49 | 435 movlb 0x01 ; Back to RAM Bank1 |
| 436 ostc_debug 'T' ; Sends debug-information to screen if debugmode active | |
| 437 return | |
| 438 | |
| 439 simulator_restore_tissue_data: | |
| 440 bcf restore_deco_data ; clear restore flag | |
| 441 ostc_debug 'S' ; Sends debug-information to screen if debugmode active | |
| 116 | 442 call deco_pull_tissues_from_vault |
| 49 | 443 movlb 0x01 ; Back to RAM Bank1 |
| 444 ostc_debug 'T' ; Sends debug-information to screen if debugmode active | |
| 445 | |
| 446 ostc_debug 'G' ; Sends debug-information to screen if debugmode active | |
| 116 | 447 call deco_calc_desaturation_time ; calculate desaturation time |
| 49 | 448 movlb b'00000001' ; select ram bank 1 |
| 449 call calculate_noflytime ; Calc NoFly time | |
| 450 ostc_debug 'H' ; Sends debug-information to screen if debugmode active | |
| 451 | |
| 452 ; Calculate CNS | |
| 116 | 453 call deco_calc_CNS_fraction ; calculate CNS |
| 49 | 454 movlb b'00000001' ; rambank 1 selected |
| 455 return |