Mercurial > public > mk2
view code_part1/OSTC_code_asm_part1/simulator.asm @ 802:798c1acb750a
italian update
author | heinrichsweikamp |
---|---|
date | Mon, 13 Oct 2014 15:18:47 +0200 |
parents | e16e636def61 |
children | c50296c3059e |
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: ;============================================================================= ; Temp data, local to this module, moved to ACCES0 area. ; ; CBLOCK tmp ; Into safe (from C library) area. ; sim_btm_time ; Simulated bottom time ; sim_btm_depth ; Simulated max depth ; sim_CNS ; Backup CNS value during decoplanning. ; ENDC ;============================================================================= menu_simulator: movlw d'3' movwf sim_btm_time ; Bottom time movlw d'15' movwf sim_btm_depth ; Max. Depth movlw d'1' movwf menupos clrf WREG ; Interval movff WREG,char_I_dive_interval menu_simulator1: call DISP_brightness_full ;max. brightness call DISP_ClearScreen call DISP_simulator_mask menu_simulator2: call menu_pre_loop_common ; Clear some menu flags, timeout and switches call DISP_simulator_data call DISP_menu_cursor menu_simulator_loop: call check_switches_menu menu_simulator_loop2: btfsc onesecupdate call menu_check_dive_and_timeout ; "Goto restart" or sets sleepmode flag bcf onesecupdate ; End of one second tasks btfsc menubit2 goto menu_simulator_do ; call submenu btfss menubit goto menu_simulator_exit btfsc sleepmode goto menu_simulator_exit bra menu_simulator_loop menu_simulator_do: ; calls submenu dcfsnz menupos,F bra simulator_inc_interval 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 menu_simulator_exit: movlw d'4' movwf menupos goto more_menu2 ; exit... simulator_inc_interval: movff char_I_dive_interval,PRODL movlw .3 addwf PRODL,F movlw .24*6 ; Max 24h delay. cpfslt PRODL clrf PRODL movff PRODL,char_I_dive_interval movlw d'1' movwf menupos bra menu_simulator2 simulator_inc_bottomtime: movlw d'2' addwf sim_btm_time,F ; Here: Bottomtime in m movlw d'199' cpfslt sim_btm_time movwf sim_btm_time movlw d'3' movwf menupos bra menu_simulator2 simulator_inc_maxdepth: movlw d'3' addwf sim_btm_depth,F ; Here: Maxdepth in m movlw d'120' cpfslt sim_btm_depth movwf sim_btm_depth movlw d'4' 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 sim_btm_depth,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 movff xC+0,sim_pressure+0 movff xC+1,sim_pressure+1 ; This override is done in ISR too, but do it right now also: movff sim_pressure+0,amb_pressure+0 movff sim_pressure+1,amb_pressure+1 call comp_air_pressure0 ; Make sure to have depth in rel_pressure:2 bcf menubit2 bcf menubit3 bcf menubit call wait_switches ; Waits until switches are released, resets flag if button stays pressed! call simulator_save_tissue_data ; Stores 32 floats "pre_tissue" into bank3 movff char_I_dive_interval,WREG ; Any interval ? iorlw 0 ; Test for null btfss STATUS,Z call deco_calc_dive_interval ; NZ: call interval subroutine. movlb 1 movlw d'3' ; Begin of deco cycle (reset table). movff WREG,char_O_deco_status ; Reset Deco module. bsf divemode ; Set divemode flag ostc_debug 'P' ; Sends debug-information to screen if debugmode active goto diveloop ; Start Divemode ;============================================================================= ; Show decoplanning result. ; simulator_show_decoplan: call DISP_ClearScreen call DISP_simdata_screen call divemenu_see_decoplan WIN_LEFT .0 call DISP_standard_color ; Display TTS, if any... movff int_O_ascenttime+0,lo movff int_O_ascenttime+1,hi movf lo,W iorwf hi,W bz simulator_decoplan_notts WIN_TOP .162 lfsr FSR2, letter OUTPUTTEXT .85 ; TTS STRCAT ": " bsf leftbind output_16 STRCAT_PRINT "'" simulator_decoplan_notts: WIN_TOP .190 ; Print calculated CNS before and after dive incf sim_CNS,W ; Detect CNS simulation overflow. bz simulator_decoplan_cns_1 movlw .100 ; Detect if CNS > 100% cpfslt sim_CNS call DISP_warnings_color ; Yes: draw in red ! STRCPY TXT_CNS4 movff char_O_CNS_fraction,lo ; Current CNS, before dive. output_8 STRCAT "%\x92" ; Right-arrow movff sim_CNS,lo ; Get back CNS value. output_8 ; CNS after dive. STRCAT_PRINT "%" bra simulator_decoplan_cns_2 simulator_decoplan_cns_1: call DISP_warnings_color ; Yes: draw in red ! STRCPY_PRINT TXT_CNSGR10 simulator_decoplan_cns_2: call DISP_divemask_color DISPLAYTEXT .188 ; Sim. Results: call DISP_standard_color simulator_show_decoplan1: call wait_switches ; Waits until switches are released, resets flag if button stays pressed! simulator_show_decoplan2: btfsc uart_dump_screen ; Asked to dump screen contains ? call dump_screen ; Yes! btfsc onesecupdate call menu_check_dive_and_timeout ; "Goto restart" or sets sleepmode flag bcf onesecupdate ; End of one second tasks simulator_show_decoplan3: btfsc switch_right bra menu_simulator1 ; Quit display btfsc switch_left bra simulator_show_decoplan5 ; Next decoplan-page. btfsc sleepmode goto more_menu bra simulator_show_decoplan2 simulator_show_decoplan5: incf decoplan_page,F btfsc last_ceiling_gf_shown ; last ceiling shown? bra simulator_show_decoplan5_0 ; All done, clear and return call DISP_decoplan ; Re-Draw Current page of GF Decoplan bra simulator_show_decoplan1 ;---- In OCR mode, show the gas Usage special page --------------------------- simulator_show_decoplan5_0: btfss display_see_deco ; Already displayed ? bra menu_simulator1 ; Exit to menu. bcf display_see_deco ; clear flag btfsc FLAG_const_ppO2_mode ; In CCR mode ? bra menu_simulator1 ; YES: finished. ; Make sure to pass first gas clrf EEADRH read_int_eeprom .33 ; First gas. movff EEDATA,char_I_first_gas ; Compute gas consumption for each tank. call deco_gas_volumes movlb 1 ; Clear the complete stop result column: WIN_BOX_BLACK .0, .239, .85, .159 ;top, bottom, left, right movlw d'10' movwf waitms_temp ; Row for gas list is .10+.25 clrf wait_temp ; Gas counter lfsr FSR0,int_O_gas_volumes ; Initialize indexed addressing. WIN_LEFT .90 ; Set column call DISP_standard_color simulator_show_decoplan5_loop: incf wait_temp,F ; Increment gas # movlw .25 addwf waitms_temp,F ; Increase row position movff waitms_temp,win_top ; Set Row movff POSTINC0,lo ; Read (16bit) result, low first, movff POSTINC0,hi ; then high. movf lo,W ; Null ? iorwf hi,W bz simulator_show_decoplan5_1 ; Skip printing. movf lo,W ; == 65535 (saturated ?) andwf hi,W incf WREG bnz simulator_show_decoplan5_2 call DISP_warnings_color STRCPY_PRINT "= xxxx.x" call DISP_standard_color bra simulator_show_decoplan5_1 simulator_show_decoplan5_2: STRCPY "= " bsf leftbind output_16 ; No decimal anymore. bcf leftbind call word_processor ; No unit: can be bars or litters. ; Loop for all 5 gas simulator_show_decoplan5_1: movlw d'5' ; list all five gases cpfseq wait_temp ; All gases shown? bra simulator_show_decoplan5_loop ; No call DISP_divemask_color DISPLAYTEXTH .301 ; OCR Gas Usage: call DISP_standard_color bra simulator_show_decoplan1 ;============================================================================= ; OSTC Simulator: compute a new runtime ; simulator_calc_deco: btfsc gauge_mode ; In Gauge mode? bra menu_simulator ; Yes, igonore decoplaner btfsc FLAG_apnoe_mode ; In Apnoe mode? bra menu_simulator ; Yes, igonore decoplaner call simulator_save_tissue_data ; Stores 32 floats "pre_tissue" into bank3 movff char_I_dive_interval,WREG ; Any interval ? iorlw 0 ; Test for null btfss STATUS,Z call deco_calc_dive_interval ; NZ: call interval subroutine. movlb 1 bsf simulatormode_active ; normal simulator mode bsf standalone_simulator ; Standalone Simulator active bsf no_sensor_int ; Disable sensor interrupt clrf T3CON ; Disable timer3 counter, clrf TMR3L ; so the simu won't stop right away. nop clrf TMR3H call diveloop_boot ; configure gases, etc. ; Save dive parameters for gas volume estimation: movff sim_btm_depth,char_I_bottom_depth movff sim_btm_time,char_I_bottom_time movff sim_btm_depth,xA+0 ; Bottom depth. 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 movff xC+0,sim_pressure+0 movff xC+1,sim_pressure+1 call DISP_divemask_color DISPLAYTEXT .12 ; "Wait..." call DISP_standard_color ; This override is done in ISR too, but do it right now also: movff sim_pressure+0,amb_pressure+0 movff sim_pressure+1,amb_pressure+1 call divemode_check_decogases ; Checks for decogases and sets the gases call divemode_prepare_flags_for_deco call set_first_gas ; Set current N2/He/O2 ratios. call set_actual_ppo2 ; Then configure char_I_actual_ppO2 (For CNS) read_int_eeprom d'34' ; Read deco data movlw .6 cpfseq EEDATA bra simulator_calc_deco1 ; in PSCR mode, compute fO2 into char_I_O2_ratio call compute_pscr_ppo2 ; pSCR ppO2 into sub_c:2 movff sub_c+0,xA+0 movff sub_c+1,xA+1 movlw d'100' movwf xB+0 clrf xB+1 call div16x16 ; /100 tstfsz xC+1 ; Is ppO2 > 2.55bar ? setf xC+0 ; yes: bound to 2.55... better than wrap around. movff xC+0,char_I_actual_ppO2 ; copy last ppO2 to buffer register (for pSCR CNS) movff sub_c+0,xA+0 movff sub_c+1,xA+1 movlw LOW .10 movwf xB+0 movlw HIGH .10 movwf xB+1 call mult16x16 ;xA*xB=xC -> xC:4 = ppO2*1000 SAFE_2BYTE_COPY amb_pressure, xB call div32x16 ; xC:4 / xB:2 = xC+3:xC+2 with xC+1:xC+0 as remainder ; xC+0 has O2 in percent movff xC+0,char_I_O2_ratio simulator_calc_deco1: ; First minute is special: init everything. movlw d'3' ; Begin of deco cycle (reset table). movff WREG,char_O_deco_status ; Reset Deco module. movlw d'1' movff WREG,char_I_step_is_1min ; 1 minute mode. call deco_calc_hauptroutine ; Reset table + sim one minute for descent. call deco_calc_CNS_fraction ; Also calculate CNS (in 1min loop) movlb b'00000001' ; rambank 1 selected decf sim_btm_time,F ; One minute done. bz simulator_calc_deco_loop_end ; Loop for bottom time duration simulator_calc_deco_loop2: call DISP_simulator_data ; Update display of bottom time. call deco_calc_tissue ; JUST calc tissue (faster). call deco_calc_CNS_fraction ; Also calculate CNS (in 1min loop) movlb b'00000001' ; rambank 1 selected ostc_debug 'C' ; Sends debug-information to screen if debugmode active decfsz sim_btm_time,F ; Decrement bottom time, bra simulator_calc_deco_loop2 ; and loop while not finished. ; Now the bottom time is finish, restart a full ascent simulation: simulator_calc_deco_loop_end: movlw d'0' movff WREG,char_I_step_is_1min ; Back to 2 second deco mode clrf timeout_counter2 ; timeout used as maxloop here movff char_I_bottom_depth,char_O_deco_last_stop simulator_calc_deco2: call deco_calc_hauptroutine ; calc_tissue movlb b'00000001' ; rambank 1 selected movff char_O_deco_last_stop,sim_btm_depth call DISP_simulator_data ; Animate ascent simu. dcfsnz timeout_counter2,F ; Abort loop (max. 256 tries)? bra simulator_calc_deco3 ; Yes... movff char_O_deco_status,WREG iorwf WREG ; deco_status=0 if decompression calculation done bnz simulator_calc_deco2 ; Not finished ; Finished simulator_calc_deco3: call deco_calc_CNS_planning ; Compute cNS after full ascent. movlb 0x01 ; Back to RAM Bank1 movff char_O_CNS_fraction,sim_CNS ; Save calculated CNS. rcall simulator_restore_tissue_data ; Restore CNS & 32 floats "pre_tissue" from vault bcf simulatormode_active ; normal simulator mode bcf standalone_simulator ; Standalone Simulator active bcf no_sensor_int ; Re-enable sensor interrupt WAITMS d'250' WAITMS d'250' WAITMS d'250' ; Wait for Pressure Sensor to get real pressure again... movlw d'5' ; Pre-Set Cursor to "Show Decoplan" movwf menupos movff char_I_bottom_time,sim_btm_time ; Restore bottom time, movff char_I_bottom_depth,sim_btm_depth ; and depth. clrf timeout_counter2 ; Restart menu timeout. bra simulator_show_decoplan ; Done. ;============================================================================= simulator_save_tissue_data: bsf restore_deco_data ; Set restore flag ostc_debug 'S' ; Sends debug-information to screen if debugmode active call deco_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 deco_pull_tissues_from_vault ; Restore CNS too... 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_calc_desaturation_time ; calculate desaturation time movlb b'00000001' ; select ram bank 1 ; Reset gradient factor until next computation, to avoid spurious ; displays after simulation. clrf WREG movff WREG,char_O_gradient_factor movff WREG,char_O_relative_gradient_GF ; Note: should not reset nofly-time here: the true value have continued to be decremented ; during simulation, which is the right thing to do... ostc_debug 'H' ; Sends debug-information to screen if debugmode active return