Mercurial > public > mk2
view code_part1/OSTC_code_asm_part1/simulator.asm @ 78:bd16d5830b06
testing patch
author | heinrichsweikamp |
---|---|
date | Tue, 07 Dec 2010 21:06:45 +0100 |
parents | df2d3b28947f |
children | 2a31948dbcb7 |
line wrap: on
line source
; OSTC - diving computer code ; Copyright (C) 2008 HeinrichsWeikamp GbR ; This program is free software: you can redistribute it and/or modify ; it under the terms of the GNU General Public License as published by ; the Free Software Foundation, either version 3 of the License, or ; (at your option) any later version. ; This program is distributed in the hope that it will be useful, ; but WITHOUT ANY WARRANTY; without even the implied warranty of ; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the ; GNU General Public License for more details. ; You should have received a copy of the GNU General Public License ; along with this program. If not, see <http://www.gnu.org/licenses/>. ; menu "Simulator" ; written by: Matthias Heinrichs, info@heinrichsweikamp.com ; written: 081210 ; last updated: 081210 ; known bugs: ; ToDo: menu_simulator: movlw d'1' movwf logbook_temp1 ; Bottom time movlw d'15' movwf logbook_temp2 ; Max. Depth movlw d'1' movwf menupos menu_simulator1: clrf timeout_counter2 bsf menubit bsf cursor call PLED_brightness_full ;max. brightness call PLED_ClearScreen call PLED_simulator_mask menu_simulator2: bcf switch_left bcf switch_right bcf menubit2 bcf menubit3 call PLED_simulator_data call PLED_menu_cursor menu_simulator_loop: call check_switches_menu menu_simulator_loop2: btfss onesecupdate bra menu_simulator_loop3 call timeout_surfmode call set_dive_modes call test_charger ; check if charger IC is active call get_battery_voltage ; get battery voltage bcf onesecupdate ; End of one second tasks menu_simulator_loop3: btfsc menubit2 goto menu_simulator_do ; call submenu btfss menubit goto menu_simulator_exit btfsc sleepmode goto menu_simulator_exit btfsc divemode goto restart ; exit menu, restart and enter divemode bra menu_simulator_loop menu_simulator_do: ; calls submenu dcfsnz menupos,F bra simulator_startdive dcfsnz menupos,F bra simulator_inc_bottomtime dcfsnz menupos,F bra simulator_inc_maxdepth dcfsnz menupos,F bra simulator_calc_deco dcfsnz menupos,F bra simulator_show_decoplan menu_simulator_exit: movlw d'4' movwf menupos goto more_menu2 ; exit... simulator_inc_bottomtime: movlw d'2' addwf logbook_temp1,F ; Here: Bottomtime in m movlw d'199' cpfslt logbook_temp1 movwf logbook_temp1 movlw d'2' movwf menupos bra menu_simulator2 simulator_inc_maxdepth: movlw d'3' addwf logbook_temp2,F ; Here: Maxdepth in m movlw d'99' cpfslt logbook_temp2 movwf logbook_temp2 movlw d'3' movwf menupos bra menu_simulator2 simulator_startdive: ; Descent to -15m depth ; Set standalone_simulator flag (Displays Simulator menu during simulation by pressing ENTER button) ; Clear standalone_simulator after (any) dive bsf simulatormode_active ; normal simulator mode bsf standalone_simulator ; Standalone Simulator active movff logbook_temp2,xA+0 clrf xA+1 movlw d'100' movwf xB+0 clrf xB+1 call mult16x16 ;xA*xB=xC ; Depth in m*100 movlw LOW d'1000' addwf xC+0,F movlw HIGH d'1000' addwfc xC+1,F ; add 1000mBar ; movf amb_pressure+0,W ; addwf xC+0,F ; movf amb_pressure+1,W ; addwfc xC+1,F ; Add ambient pressure ; movff xC+0,sim_pressure+0 movff xC+1,sim_pressure+1 movff sim_pressure+0,amb_pressure+0 ; override readings with simulator values movff sim_pressure+1,amb_pressure+1 bcf menubit2 bcf menubit3 bcf menubit bcf switch_left bcf switch_right call simulator_save_tissue_data ; Stores 32 floats "pre_tissue" into bank3 bsf divemode ; Set divemode flag ostc_debug 'P' ; Sends debug-information to screen if debugmode active goto diveloop ; Start Divemode simulator_show_decoplan: call PLED_ClearScreen call PLED_simdata_screen call divemode_copy_decolist ;copy gf_decolist (0x250:.32) to gf_decolist_copy (0x0E0:.32) call divemenu_see_decoplan ;call enable_rs232 ; lfsr FSR0,0x250 ; movlw 0x20 ; movwf wait_temp ;xy: ; Clear Deco list ; movff POSTINC0,TXREG ; call rs232_wait_tx ; decfsz wait_temp,F ; bra xy ; movff char_O_array_decodepth+0,TXREG ; WIN_INVERT .1 ; Init new Wordprocessor DISPLAYTEXT .188 ; Sim. Results: WIN_INVERT .0 ; Init new Wordprocessor simulator_show_decoplan1: bcf switch_left bcf switch_right simulator_show_decoplan2: btfss onesecupdate bra simulator_show_decoplan3 call timeout_surfmode call set_dive_modes call test_charger ; check if charger IC is active call get_battery_voltage ; get battery voltage bcf onesecupdate ; End of one second tasks simulator_show_decoplan3: btfsc switch_right bra simulator_show_decoplan4 ; Quit display btfsc switch_left bra simulator_show_decoplan5 ; Quit display or new Decoplan-Page (GF Mode only) btfsc sleepmode goto more_menu btfsc divemode goto restart ; exit menu, restart and enter divemode bra simulator_show_decoplan2 simulator_show_decoplan5: btfsc multi_gf_display ; Next Page in Multi-GF Screen? bra simulator_show_decoplan5_1 ; Yes! simulator_show_decoplan5_0: bcf display_see_deco ; clear flag bra simulator_show_decoplan4 ; Quit simulator_show_decoplan5_1: incf temp8,F btfsc last_ceiling_gf_shown ; last ceiling shown? bra simulator_show_decoplan5_0 ; All done, clear and return call PLED_decoplan_gf_page_current ; Re-Draw Current page of GF Decoplan bra simulator_show_decoplan1 simulator_show_decoplan4: movlw d'5' movwf menupos bra menu_simulator1 simulator_calc_deco: call diveloop_boot ; configure gases, etc. bsf simulatormode_active ; normal simulator mode bsf standalone_simulator ; Standalone Simulator active movff logbook_temp2,xA+0 clrf xA+1 movlw d'100' movwf xB+0 clrf xB+1 call mult16x16 ;xA*xB=xC ; Depth in m*100 movlw LOW d'1000' addwf xC+0,F movlw HIGH d'1000' addwfc xC+1,F ; add 1000mBar ; movf amb_pressure+0,W ; addwf xC+0,F ; movf amb_pressure+1,W ; addwfc xC+1,F ; Add ambient pressure ; movff xC+0,sim_pressure+0 movff xC+1,sim_pressure+1 movff sim_pressure+0,amb_pressure+0 ; override readings with simulator values movff sim_pressure+1,amb_pressure+1 call simulator_save_tissue_data ; Stores 32 floats "pre_tissue" into bank3 WIN_INVERT .1 DISPLAYTEXT .12 ;" Wait.." WIN_INVERT .0 simulator_calc_deco_loop1: call divemode_check_decogases ; Checks for decogases and sets the gases call divemode_prepare_flags_for_deco call deco_main_calc_hauptroutine ; calc_tissue movlb b'00000001' ; rambank 1 selected movff char_O_deco_status,deco_status ; tstfsz deco_status ; deco_status=0 if decompression calculation done bra simulator_calc_deco_loop1 ; Not finished movlw d'1' movff WREG,char_I_step_is_1min ; 1 minute mode movlw d'255' movff WREG,char_O_deco_status ; Reset Deco module simulator_calc_deco_loop2: call PLED_simulator_data btg LED_red call divemode_check_decogases ; Checks for decogases and sets the gases call divemode_prepare_flags_for_deco call deco_main_calc_hauptroutine ; calc_tissue movlb b'00000001' ; rambank 1 selected ostc_debug 'C' ; Sends debug-information to screen if debugmode active decfsz logbook_temp1,F bra simulator_calc_deco_loop2 movlw d'0' movff WREG,char_I_step_is_1min ; 2 second deco mode movlw d'255' movff WREG,char_O_deco_status ; Reset Deco module bra simulator_calc_deco2 ; Not finished simulator_calc_deco3: bsf LED_red call simulator_restore_tissue_data ; Restore 32 floats "pre_tissue" from bank3 bcf simulatormode_active ; normal simulator mode bcf standalone_simulator ; Standalone Simulator active WAITMS d'250' WAITMS d'250' WAITMS d'250' ; Wait for Pressure Sensor to get real pressure again... bcf LED_red movlw d'1' movwf logbook_temp1 ; Bottom time>0! movlw d'5' ; Pre-Set Cursor to "Show Decoplan" movwf menupos bra menu_simulator1 ; Done. simulator_calc_deco2: call divemode_check_decogases ; Checks for decogases and sets the gases call divemode_prepare_flags_for_deco call deco_main_calc_hauptroutine ; calc_tissue movlb b'00000001' ; rambank 1 selected movff char_O_deco_status,deco_status ; tstfsz deco_status ; deco_status=0 if decompression calculation done bra simulator_calc_deco2 ; Not finished bra simulator_calc_deco3 ; finished! simulator_save_tissue_data: bsf restore_deco_data ; Set restore flag ostc_debug 'S' ; Sends debug-information to screen if debugmode active call main_push_tissues_to_vault movlb 0x01 ; Back to RAM Bank1 ostc_debug 'T' ; Sends debug-information to screen if debugmode active return simulator_restore_tissue_data: bcf restore_deco_data ; clear restore flag ostc_debug 'S' ; Sends debug-information to screen if debugmode active call main_pull_tissues_from_vault movlb 0x01 ; Back to RAM Bank1 ostc_debug 'T' ; Sends debug-information to screen if debugmode active ostc_debug 'G' ; Sends debug-information to screen if debugmode active call deco_main_calc_desaturation_time ; calculate desaturation time movlb b'00000001' ; select ram bank 1 call calculate_noflytime ; Calc NoFly time ostc_debug 'H' ; Sends debug-information to screen if debugmode active ; Calculate CNS call main_calc_CNS_fraction ; calculate CNS movlb b'00000001' ; rambank 1 selected return