Mercurial > public > hwos_code
view src/divemode.asm @ 592:05053910d668
BUGFIX: Re-enable Sensors after sleep in PSCR mode
| author | heinrichsweikamp |
|---|---|
| date | Wed, 18 Apr 2018 17:03:52 +0200 |
| parents | bf0c76e9b01b |
| children | 08a0162d3ca1 |
line wrap: on
line source
;============================================================================= ; ; File divemode.asm REFACTORED VERSION V2.98 ; ; Divemode ; ; Copyright (c) 2011, JD Gascuel, HeinrichsWeikamp, all right reserved. ;============================================================================= ; HISTORY ; 2011-08-15 : [mH] moving from OSTC code #include "hwos.inc" ; Mandatory header #include "shared_definitions.h" ; Mailbox from/to p2_deco.c #include "tft_outputs.inc" #include "strings.inc" #include "tft.inc" #include "eeprom_rs232.inc" #include "isr.inc" #include "math.inc" #include "wait.inc" #include "customview.inc" #include "start.inc" #include "adc_lightsensor.inc" #include "ghostwriter.inc" #include "i2c.inc" #include "calibrate.inc" #include "convert.inc" extern TFT_dive_compass_heading extern do_line_menu extern do_main_divemenu extern option_save_all extern init_recording_params ;---- Private local variables ------------------------------------------------- CBLOCK local1 ; max size is 16 Byte !!! apnoe_timeout_counter ; timeout counter for apnoe mode average_depth_hold:4 ; used in calculation of the average depth sensor_setpoint ; sensor ppo2 in 0.01bar for deco routine active_diluent ; backup of diluent gas for when switching back from bailout to CCR/pSCR loop average_depth_hold_total:4 ; used to calculate the average depth ENDC ; used: 11 byte, remaining: 5 byte gui CODE ;============================================================================= global diveloop diveloop: banksel common call speed_normal call diveloop_boot ; Boot tasks for all modes ; Startup Tasks for all modes call TFT_boot ; Initialize TFT (includes clear screen) bsf FLAG_TFT_divemode_mask ; Display mask movff customview_divemode,menupos3; Reload last customview call customview_mask ; Redraw last custom view btfsc FLAG_apnoe_mode bsf realdive ; Set Realdive flag in Apnoe mode btfsc FLAG_apnoe_mode ; Done for Apnoe or Gauge mode bra diveloop_loop_start btfsc FLAG_gauge_mode ; Done for Apnoe or Gauge mode bra diveloop_loop_start bsf FLAG_TFT_display_ndl_mask ; display "NDL" ; +@5 init clrf WREG ; WAIT marker: display "---" movff WREG,char_I_sim_advance_time movff WREG,int_O_alternate_ascenttime+0 bsf WREG,int_not_yet_computed bsf WREG,int_invalid_flag movff WREG,int_O_alternate_ascenttime+1 diveloop_loop_start: btfsc FLAG_TFT_display_ndl_mask call TFT_display_ndl_mask diveloop_loop: ; The diveloop starts here btfss quarter_second_update bra diveloop_loop1 ; tasks any 1/4 second, any mode bcf quarter_second_update ; clear flag movlw .6 cpfseq menupos3 ; in compass view? bra diveloop_loop1 ; No, done. btfsc alternative_divelayout ; In alternative layout mode? bra diveloop_loop1 ; Yes, done. No Compass. ; TFT Output routines call TFT_dive_compass_heading ; Yes, update compass heading value bsf FLAG_TFT_temp_divemode ; Redraw temperature (is slightly affected from compass heading arrow) ; TFT Output routines diveloop_loop1: btfss onesecupdate bra diveloop_loop3 ; tasks any new second... bcf onesecupdate ; one seconds update, clear flag here in case it's set again in ISR before all tasks are done. ;bsf LEDg ; ### USE FOR DEBUG ONLY - RESETS RX CIRCUITRY ### ; display depth based on full seconds interval (nicer blinking) btfss alternative_divelayout rcall TFT_output4_normal btfsc alternative_divelayout rcall TFT_output4_alternative btfsc FLAG_apnoe_mode ; Only in apnoe mode bra diveloop_loop1_nonedeco ; One Second Tasks in Apnoe mode ; tasks any new second - only for deco modes diveloop_loop1_decomodes: bsf FLAG_TFT_divemins ; Display (new) divetime! btfsc show_safety_stop ; Show the safety stop? bsf FLAG_TFT_show_safety_stop ; Yes, show/delete if done. btfss alternative_divelayout rcall TFT_output1_normal btfsc alternative_divelayout rcall TFT_output1_alternative btfsc FLAG_ccr_mode ; in CCR mode... call check_dive_autosp ; ...check for Auto-SP call calc_deko_divemode ; calculate decompression and set resulting display flags btfss alternative_divelayout rcall TFT_output2_normal btfsc alternative_divelayout rcall TFT_output2_alternative call divemode_check_for_warnings ; Check for any warnings bra diveloop_loop2 ; Common Tasks ; tasks any new second - only for apnoe mode diveloop_loop1_nonedeco: rcall divemode_apnoe_tasks ; 1 sec. Apnoe tasks call customview_second ; Do every-second tasks for the custom view area ;bra diveloop_loop2 ; Common Tasks ; continue tasks any new second, any mode diveloop_loop2: rcall timeout_divemode ; ** menu timeout? ** This routine sets the required flags rcall set_dive_modes ; tests if depth > threshold rcall set_min_temp ; store min. temp if required (Future hardware will need this to be checked 1/second...) btfsc oneminupdate ; one minute tasks rcall update_divemode60 ; Update clock, etc. btfss alternative_divelayout rcall TFT_output3_normal btfsc alternative_divelayout rcall TFT_output3_alternative ;bcf LEDg ; ### USE FOR DEBUG ONLY - RESETS RX CIRCUITRY ### ; tasks any round, any mode diveloop_loop3: call test_switches_divemode ; Check switches in divemode global diveloop_loop4 diveloop_loop4: ; Menu-Exit returns here... btfsc divemode_menu ; in the big divemode menu? bra diveloop_loop4b ; YES - no space for CCR/pSCR info btfsc menuview ; NO - in the small yellow menu? bra diveloop_loop4b ; YES - no space for CCR/pSCR info btfsc alternative_divelayout ; NO - in the alternative layout? bra diveloop_loop4b ; YES - no space for CCR/pSCR info call TFT_show_mode_divemode ; NO - (re)write CCR/pSCR mode info to display diveloop_loop4b: btfsc toggle_customview ; Next view? call customview_toggle ; Yes, show next customview (and delete this flag) btfsc divemode_gaschange ; Gas switch flag set? call gas_switched_common ; YES btfsc toggle_gf ; Toggle GF/aGF? rcall divemodemode_togglegf ; YES btfsc FLAG_set_marker ; shall a marker be set? call set_logbook_marker ; YES btfsc store_sample ; store new sample? call store_dive_data ; Store profile data btfss divemode ; Dive finished? goto ghostwriter_end_dive ; Dive finished! btfsc pressure_refresh ; new pressure available? rcall set_max_depth ; update max. depth if required btfsc pressure_refresh ; new pressure available? bsf FLAG_TFT_depth ; Yes, update depth bcf pressure_refresh ; clear flag btfsc temp_changed bsf FLAG_TFT_temp_divemode ; Displays temperature ; display depth based on as-fast-as-possible (no nice blinking) ;btfss alternative_divelayout ;rcall TFT_output4_normal ;btfsc alternative_divelayout ;rcall TFT_output4_alternative btfsc enable_screen_dumps ; =1: Ignore vin_usb, wait for "l" command (Screen dump) bra diveloop_loop5 bra diveloop_loop6 diveloop_loop5: btfss vusb_in ; USB (still) plugged in? bcf enable_screen_dumps ; No, clear flag call rs232_get_byte btfsc rs232_receive_overflow bra diveloop_loop6 movlw "l" cpfseq RCREG1 bra diveloop_loop6 call TFT_dump_screen ; Dump the screen contents diveloop_loop6: bra diveloop_loop ; Loop the divemode ;-------------------------------------------------------------------------------------------------------- TFT_output1_normal: ; beginning of any new second - only for deco modes btfsc FLAG_TFT_divemode_mask call TFT_divemode_mask btfsc FLAG_TFT_divemins call TFT_divemins ; Display (new) divetime! call customview_second ; Do every-second tasks for the custom view area (In sync with the divetime) mH btfsc FLAG_TFT_show_safety_stop call TFT_show_safety_stop ; Show safety stop btfsc FLAG_TFT_clear_safety_stop call TFT_clear_safety_stop ; Clear safety stop return TFT_output1_alternative: ; beginning of any new second - only for deco modes btfsc FLAG_TFT_divemins call TFT_divemins_alternative ; Display (new) divetime! btfsc FLAG_TFT_divemode_mask_alt call TFT_divemode_mask_alternative ; Alt. mask call customview_alternative_second ; Do every-second tasks for the custom view area (In sync with the divetime) mH btfsc FLAG_TFT_big_deco_alt call TFT_big_deco_alt ; Big deco and safety stop return TFT_output2_normal: ; any new second - only for deco modes btfsc FLAG_TFT_display_ndl_mask call TFT_display_ndl_mask btfsc FLAG_TFT_display_ndl call TFT_display_ndl btfsc FLAG_TFT_display_deko_mask call TFT_display_deko_mask btfsc FLAG_TFT_display_deko call TFT_display_deko btfsc FLAG_TFT_display_tts call TFT_display_tts return TFT_output2_alternative: ; any new second - only for deco modes return TFT_output3_normal: ; tasks any new second, any mode btfsc FLAG_TFT_max_depth call TFT_max_depth ; use normal max. depth btfsc FLAG_TFT_divemode_warning call TFT_divemode_warning btfsc FLAG_TFT_divemode_warning_clear call TFT_divemode_warning_clear btfsc FLAG_TFT_active_gas_divemode call TFT_active_gas_divemode ; Display gas/Setpoint btfsc FLAG_TFT_dive_warning_text_clear call TFT_clear_warning_text ; clear complete warnings area btfsc FLAG_TFT_dive_warning_text_clr2 call TFT_clear_warning_text_2nd_row; clear 2nd row of warnings return TFT_output3_alternative: ; tasks any new second, any mode btfsc FLAG_TFT_max_depth_alt call TFT_max_depth_alternative ; big max. depth btfsc FLAG_TFT_dive_warning_text_clear call TFT_clear_warning_text ; clear complete warnings area (In alt mode only 2nd. row...) return TFT_output4_normal: ; tasks any round, any mode btfsc FLAG_TFT_depth call TFT_depth ; Displays new depth btfsc FLAG_TFT_temp_divemode call TFT_temp_divemode ; Update temperature return TFT_output4_alternative: ; tasks any round, any mode btfsc FLAG_TFT_depth call TFT_depth ; Displays new depth return ;-------------------------------------------------------------------------------------------------------- divemode_apnoe_tasks: ; 1 sec. Apnoe tasks call TFT_display_apnoe_descent ; Yes, Show descent timer call TFT_max_depth ; use normal max. depth btfsc divemode2 ; Time running? bra divemode_apnoe_tasks2 ; New descent, reset data if flag is set rcall apnoe_calc_maxdepth call TFT_display_apnoe_surface call TFT_display_apnoe_last_max ; Show last max. depth incf apnoe_surface_secs,F movlw d'60' cpfseq apnoe_surface_secs bra divemode_apnoe_tasks1 clrf apnoe_surface_secs incf apnoe_surface_mins,F divemode_apnoe_tasks1: bcf FLAG_active_descent ; Clear flag btfsc divemode2 ; Time running? return ; Yes, return bsf FLAG_active_descent ; Set Flag return divemode_apnoe_tasks2: btfss FLAG_active_descent ; Are we descending? return ; No, We are at the surface rcall apnoe_calc_maxdepth ; Yes! call TFT_apnoe_clear_surface ; Clear Surface timer clrf apnoe_timeout_counter ; Delete timeout clrf apnoe_surface_secs clrf apnoe_surface_mins clrf apnoe_secs clrf apnoe_mins ; Reset Descent time movlw .0 movff WREG,max_pressure+0 movff WREG,max_pressure+1 ; Reset Max. Depth bcf FLAG_active_descent ; Clear flag return global apnoe_calc_maxdepth apnoe_calc_maxdepth: movff apnoe_max_pressure+0,sub_a+0 movff apnoe_max_pressure+1,sub_a+1 movff max_pressure+0,sub_b+0 movff max_pressure+1,sub_b+1 call subU16 ; sub_c = sub_a - sub_b ; apnoe_max_pressure<max_pressure -> neg_flag=1 ; max_pressure<=apnoe_max_pressure -> neg_flag=0 btfss neg_flag return ;apnoe_max_pressure<max_pressure movff max_pressure+0,apnoe_max_pressure+0 movff max_pressure+1,apnoe_max_pressure+1 return ; -------------------------------------------------------------------------------------- calc_deko_divemode: rcall calc_deko_divemode2 ; all deco relevant code is now invoked every second btfsc twosecupdate bra calc_deko_divemode1 bsf twosecupdate return calc_deko_divemode1: ; the following code is invoked every 2 seconds bcf twosecupdate call calc_average_depth ; calculate average depth call calc_velocity ; calculate vertical velocity and display if > threshold (every two seconds) call set_reset_safety_stop ; Set flags for safety stop and/or reset safety stop call TFT_debug_output btfsc FLAG_apnoe_mode ; Done for Apnoe or Gauge mode return btfsc FLAG_gauge_mode ; Done for Apnoe or Gauge mode return ; Check for a gas change goto check_gas_change ; Checks if a better gas should be selected (by user) and return... calc_deko_divemode2: btfsc FLAG_gauge_mode ; Done for Apnoe or Gauge mode return btfsc FLAG_ccr_mode ; In CCR mode? rcall calc_deko_divemode_sensor ; do sensor data acquisition if applicable by OSTC model btfsc FLAG_pscr_mode ; In PSCR mode? rcall calc_deko_divemode_sensor ; do sensor data acquisition if applicable by OSTC model SAFE_2BYTE_COPY amb_pressure,int_I_pres_respiration ; transfer ambient pressure to deco engine ; check deco engine state and switch between normal and alternative plan calculations ; ; Remark: Any reconfigurations done here do only affect the ascent & deco calculation settings, ; not the settings for the calculations done on the real tissues. The later ones are only ; altered in case of a gas change, or in case of a real bailout or switchback to setpoint ; or sensor, respectively. ; In case of a gas change or real bailout/switchback, the settings for the deco calculations ; are also changed to match the settings for the real tissues. This is done on signal through ; 'divemode_gaschange' and will also leave the deco engine status in state as if having done ; the alternative plan last. ; check state of ascent/deco calculations movff char_O_deco_status,lo ; get a working copy of char_O_deco_status into bank common movlw DECO_STATUS_MASK ; load bit mask covering the deco status bits andwf lo,W ; mask out bits showing deco engine computations state tstfsz WREG ; check if the last compute cycle has finished (bits 1 and 0 cleared) bra calc_deko_divemode2e ; NO - computations still in progress, needs more computation cycles btfss lo,DECO_PLAN_FLAG ; YES - computation cycle finished, so check what has been computed bra calc_deko_divemode2b ; PLAN bit is cleared i.e. normal plan was done, may do alternative next ; The PLAN bit is set, i.e. an alternative plan was computed in the last cycle, or the deco engine has ; been restarted because of a gas change etc. --> Reconfigure to normal plan for next computation cycle. ; reset flags for special calculations bcf lo,DECO_PLAN_FLAG ; clear flag for alternative plan bcf lo,DECO_ASCENT_FLAG ; clear flag for delayed ascent calculation bcf lo,DECO_VOLUME_FLAG ; clear flag for gas needs calculation movff lo,char_O_deco_status ; write-back char_O_deco_status to deco engine interface ; check if a switchback from CCR or pSCR bailout calculation is to be done btfsc FLAG_ccr_mode ; may a switchback from a CCR bailout calculation be needed? bra calc_deko_divemode2a ; in CCR mode, so may need to switch back from bailout calculation btfsc FLAG_pscr_mode ; may a switchback from a pSCR bailout calculation be needed? bra calc_deko_divemode2a ; in pSCR mode, so may need to switch back from bailout calculation bra calc_deko_divemode2e ; not in CCR nor pSCR, so no switchback needed, start normal plan now ; (first cycle omits gas needs calculation in OC without delayed ascent) ; switch back to loop calculation if last cycle was doing a bailout calculation calc_deko_divemode2a: movff opt_calc_asc_gasvolume,hi ; get the gas volume needs calculation setting movf hi,W ; are gas volume calculations turned on? bz calc_deko_divemode2e ; NO - can't have done a bailout calculation then, start normal plan btfsc is_bailout ; YES - check if a real bailout situation is present bra calc_deko_divemode2e ; YES - OC gases have been set by bailout action then, start normal plan movff active_gas,WREG ; NO - switch back to loop calculation: get current (diluent) gas, ... call deco_setup_cc_diluents ; ... set up deco calculations in CCR/pSCR mode with diluents, bra calc_deko_divemode2e ; ... and start in normal plan mode ; The PLAN bit was cleared, i.e. a normal plan was computed in the last cycle. For the next ; computation cycle the mode may be switched to alternative plan, or stay in normal mode... calc_deko_divemode2b: bcf lo,DECO_ASCENT_FLAG ; clear flag for delayed ascent calculation (for safety only) btfsc is_bailout ; check if a real bailout situation is present bra calc_deko_divemode2c ; YES - stay in normal plan mode and preclude delayed ascent calculation movff char_I_extra_time,hi ; NO - get the delayed ascent setting tstfsz hi ; check if delayed ascent calculation is enabled bsf lo,DECO_ASCENT_FLAG ; YES - set flag for delayed ascent calculation tstfsz hi ; check if delayed ascent calculation is enabled (again) bsf lo,DECO_PLAN_FLAG ; YES - set flag for alternative plan ; check if a gas needs calculation shall be done calc_deko_divemode2c: bsf lo,DECO_VOLUME_FLAG ; set gas needs calculation flag (may be cleared again next) TSTOSS opt_calc_asc_gasvolume ; check if gas needs calculation is enabled bcf lo,DECO_VOLUME_FLAG ; NO - reset flag again movff lo,char_O_deco_status ; write-back char_O_deco_status to deco engine interface TSTOSS opt_calc_asc_gasvolume ; check if gas volume calculation is enabled (again) bra calc_deko_divemode2e ; NO - no volume calculation, no simulated bailout plan in no case ; check if conditions are met to calculate a bailout plan btfsc is_bailout ; check if a real bailout situation is present bra calc_deko_divemode2e ; YES - normal plan already does bailout (OC) calculation "for real" btfss lo,DECO_MODE_LOOP_FLAG ; NO - have loop mode calculation been done during the normal plan? bra calc_deko_divemode2e ; NO - when not in loop mode, no simulated bailout to be done bsf lo,DECO_PLAN_FLAG ; YES - set flag for alternative plan movff lo,char_O_deco_status ; write-back char_O_deco_status to deco engine interface call get_first_gas_to_WREG ; get first OC gas, ... call deco_setup_oc_gases ; ... set up deco calculations in OC mode with OC gases, ;bra calc_deko_divemode2e ; ... and start in alternative plan mode calc_deko_divemode2e: clrf TMR5L clrf TMR5H ; 30,51757813µs/bit in TMR5L:TMR5H call deco_calc_hauptroutine ; calc_tissue banksel common ; Check if deco stops are necessary movff char_O_first_deco_depth,WREG; get ceiling tstfsz WREG ; ceiling < 0m (aka in deco) ? bra calc_deko_divemode3 ; YES ; NO - within NDL btfsc decostop_active ; already in no deco mode ? bsf FLAG_TFT_display_ndl_mask ; NO - clear deco data, display NDL time bsf FLAG_TFT_display_ndl ; display NDL time bcf decostop_active ; clear flag (again) return calc_deko_divemode3: ; YES - in deco btfss decostop_active ; already in deco mode ? bsf FLAG_TFT_display_deko_mask ; NO - clear NDL time, display deco data bsf FLAG_TFT_display_deko ; display deco data bsf FLAG_TFT_display_tts ; display TTS bsf decostop_active ; set flag (again) return ; -------------------------------------------------------------------------------------- global calc_deko_divemode_sensor calc_deko_divemode_sensor: ; sensor acquisition code btfss s8_digital ; check if we have a digital interface to the sensors bra calc_deko_divemode_sensor_analog ; NO - check if we have an analog interface btfss new_s8_data_available ; YES - check if a new data frame was received bra calc_deko_divemode_sensor_common ; NO - use old values -- TODO: add timeout for no new data call compute_mvolts_for_all_sensors ; YES - compute mV values from digital data bra calc_deko_divemode_sensor_common calc_deko_divemode_sensor_opt: btfss optical_input ; do we have an optical input? return ; No, return (We have no sensors at all. Not analog, not S8 and not optical) ;o2_ppo2_sensor1, o2_ppo2_sensor2 and o2_ppo2_sensor3 are already filled in ISR ;clear use_O2_sensorX for timeout case btfss sensor1_active bcf use_O2_sensor1 btfss sensor2_active bcf use_O2_sensor2 btfss sensor3_active bcf use_O2_sensor3 bra calc_deko_divemode_sensor1 calc_deko_divemode_sensor_analog: btfss analog_o2_input ; do we have an analog input? bra calc_deko_divemode_sensor_opt ; NO - check if we have an optical interface call get_analog_inputs ; YES - get the analog voltages and continue with the common part calc_deko_divemode_sensor_common: ; Check for each sensor if it is calibrated and if its mv value is within min_mv and max_mv limits. ; If ok: compute o2_ppo2_sensorX := o2_mv_sensorX * opt_x_sX / 1000 ; If not ok: reset o2_ppo2_sensorX, reset use_O2_sensorX and show the customview 1 in case the sensor was ok before ; Check min_mv of sensor 1 btfss sensor1_calibrated_ok ; check if sensor is usable at all bra check_sensor_1_fail ; NO - handle it as failed movff o2_mv_sensor1+0, sub_a+0 ; load sensor mV value movff o2_mv_sensor1+1, sub_a+1 movlw LOW min_mv ; load minimum mV value movwf sub_b+0 movlw HIGH min_mv movwf sub_b+1 call sub16 ; sub_c = sensor_mv - min_mv btfsc neg_flag ; check if result is negative, i.e. sensor_mv < min_mv bra check_sensor_1_fail ; YES - declare sensor as failed ; Check max_mv of sensor 1 ; NO - continue with next check movff o2_mv_sensor1+0, sub_a+0 movff o2_mv_sensor1+1, sub_a+1 movlw LOW max_mv movwf sub_b+0 movlw HIGH max_mv movwf sub_b+1 call sub16 ; sub_c = sensor_mv - max_mv btfss neg_flag ; check if result is negative, i.e. sensor_mv < max_mv bra check_sensor_1_fail ; NO - declare sensor as failed ; Check HUD data, if available ; YES - continue with next check btfss hud_connection_ok ; check if there is a HUD connected bra check_sensor_1_ok ; NO - all checks done then and positive btfss sensor1_active ; YES - check HUD report on sensor bra check_sensor_1_fail ; HUD reports a fail check_sensor_1_ok: ; o2_ppo2_sensor1 := o2_mv_sensor1:2 * opt_x_s1:2 / 1000 movff o2_mv_sensor1+0,xA+0 movff o2_mv_sensor1+1,xA+1 movff opt_x_s1+0,xB+0 movff opt_x_s1+1,xB+1 rcall compute_ppo2_helper movff xC+0,o2_ppo2_sensor1 ; result in 0.01bar bra check_sensor_2 ; continue with next sensor check_sensor_1_fail: clrf WREG movff WREG,o2_ppo2_sensor1 ; set ppO2 reading to zero btfss use_O2_sensor1 ; check if sensor was in use before bra check_sensor_1_fail_1 ; NO - no new news then call check_sensor_custview_helper; YES - show customview 1 (sensor values) on further conditions met check_sensor_1_fail_1: bcf use_O2_sensor1 ; revoke sensor from usage ;bra check_sensor_2 ; continue with next sensor check_sensor_2: ; Check min_mv of sensor 2 btfss sensor2_calibrated_ok ; check if sensor is usable at all bra check_sensor_2_fail ; NO - handle it as failed movff o2_mv_sensor2+0, sub_a+0 ; load sensor mV value movff o2_mv_sensor2+1, sub_a+1 movlw LOW min_mv ; load minimum mV value movwf sub_b+0 movlw HIGH min_mv movwf sub_b+1 call sub16 ; sub_c = sensor_mv - min_mv btfsc neg_flag ; check if result is negative, i.e. sensor_mv < min_mv bra check_sensor_2_fail ; YES - declare sensor as failed ; Check max_mv of sensor 2 ; NO - continue with next check movff o2_mv_sensor2+0, sub_a+0 movff o2_mv_sensor2+1, sub_a+1 movlw LOW max_mv movwf sub_b+0 movlw HIGH max_mv movwf sub_b+1 call sub16 ; sub_c = sensor_mv - max_mv btfss neg_flag ; check if result is nagative, i.e. sensor_mv < max_mv bra check_sensor_2_fail ; NO - declare sensor as failed ; Check HUD data, if available ; YES - continue with next check btfss hud_connection_ok ; check if there is a HUD connected bra check_sensor_2_ok ; NO - all checks done then and positive btfss sensor2_active ; YES - check HUD report on sensor bra check_sensor_2_fail ; HUD reports a fail check_sensor_2_ok: ; o2_ppo2_sensor2 := o2_mv_sensor2:2 * opt_x_s2:2 / 1000 movff o2_mv_sensor2+0,xA+0 movff o2_mv_sensor2+1,xA+1 movff opt_x_s2+0,xB+0 movff opt_x_s2+1,xB+1 rcall compute_ppo2_helper movff xC+0,o2_ppo2_sensor2 ; result in 0.01bar bra check_sensor_3 ; continue with next sensor check_sensor_2_fail: clrf WREG movff WREG,o2_ppo2_sensor2 ; set ppO2 reading to zero btfss use_O2_sensor2 ; check if sensor was in use before bra check_sensor_2_fail_1 ; NO - no new news then call check_sensor_custview_helper; YES - show customview 1 (sensor values) on further conditions met check_sensor_2_fail_1: bcf use_O2_sensor2 ; revoke sensor from usage ;bra check_sensor_3 ; continue with next sensor check_sensor_3: ; Check min_mv of sensor 2 btfss sensor3_calibrated_ok ; check if sensor is usable at all bra check_sensor_3_fail ; NO - handle it as failed movff o2_mv_sensor3+0, sub_a+0 ; load sensor mV value movff o2_mv_sensor3+1, sub_a+1 movlw LOW min_mv ; load minimum mV value movwf sub_b+0 movlw HIGH min_mv movwf sub_b+1 call sub16 ; sub_c = sensor_mv - min_mv btfsc neg_flag ; check if result is negative, i.e. sensor_mv < min_mv bra check_sensor_3_fail ; YES - declare sensor as failed ; Check max_mv of sensor 2 ; NO - continue with next check movff o2_mv_sensor3+0, sub_a+0 movff o2_mv_sensor3+1, sub_a+1 movlw LOW max_mv movwf sub_b+0 movlw HIGH max_mv movwf sub_b+1 call sub16 ; sub_c = sensor_mv - max_mv btfss neg_flag ; check if result is negative, i.e. sensor_mv < max_mv bra check_sensor_3_fail ; NO - declare sensor as failed ; Check HUD data, if available ; YES - continue with next check btfss hud_connection_ok ; check if there is a HUD connected bra check_sensor_3_ok ; NO - all checks done then and positive btfss sensor3_active ; YES - check HUD report on sensor bra check_sensor_3_fail ; HUD reports a fail check_sensor_3_ok: ; o2_ppo2_sensor3 := o2_mv_sensor3:2 * opt_x_s1:2 / 1000 movff o2_mv_sensor3+0,xA+0 movff o2_mv_sensor3+1,xA+1 movff opt_x_s3+0,xB+0 movff opt_x_s3+1,xB+1 rcall compute_ppo2_helper movff xC+0,o2_ppo2_sensor3 ; result in 0.01bar bra calc_deko_divemode_sensor1 ; continue with calculating sensor average check_sensor_3_fail: clrf WREG movff WREG,o2_ppo2_sensor3 ; set ppO2 reading to zero btfss use_O2_sensor3 ; check if sensor was in use before bra check_sensor_3_fail_1 ; NO - no new news then call check_sensor_custview_helper; YES - show customview 1 (sensor values) on further conditions met check_sensor_3_fail_1: bcf use_O2_sensor3 ; revoke sensor from usage ;bra calc_deko_divemode_sensor1 ; continue with calculating sensor average calc_deko_divemode_sensor1: ; calculate sensor average ; exit here if not in divemode btfss divemode return ; compute sensor_setpoint := average of all o2_ppo2_sensorX of those sensors that have use_O2_sensorX == true ; sum up sensor values (in xA:2) and active sensors in (xB:2) clrf xB+0 clrf xB+1 clrf xA+0 clrf xA+1 btfss use_O2_sensor1 ; Sensor1 active? bra divemode_setup_sensor_values2 ; No movf o2_ppo2_sensor1,W addwf xA+0 movlw .0 addwfc xA+1 ; Add into xA:2 incf xB+0,F ; Add a sensor divemode_setup_sensor_values2: btfss use_O2_sensor2 ; Sensor2 active? bra divemode_setup_sensor_values3 ; No movf o2_ppo2_sensor2,W addwf xA+0 movlw .0 addwfc xA+1 ; Add into xA:2 incf xB+0,F ; Add a sensor divemode_setup_sensor_values3: btfss use_O2_sensor3 ; Sensor3 active? bra divemode_setup_sensor_values4 ; No movf o2_ppo2_sensor3,W addwf xA+0 movlw .0 addwfc xA+1 ; Add into xA:2 incf xB+0,F ; Add a sensor ; Divide sum of sensor values by number of active sensors found. divemode_setup_sensor_values4: call div16x16 ; xA/xB=xC with xA+0 as remainder movff xC+0,sensor_setpoint ; copy result ; set default value for pSCR mode: 0 = let p2_deco.c compute the ppO2 based on current dil gas and depth ; will be overwritten later in case we are in sensor mode and have at least one usable sensor clrf WREG ; preload a zero btfsc FLAG_pscr_mode ; check if we are in pSCR mode movff WREG,char_I_const_ppO2 ; YES - write 0 to char_I_const_ppo2, ; it will be overwritten if we have a usable sensor reading btfsc is_bailout ; check if we are in bailout bra calc_deko_divemode_sensor2 ; YES - no sensor data transfer to char_I_const_ppO2 in this case movff opt_ccr_mode,WREG ; =0: Fixed SP, =1: Sensor, =2: Auto SP sublw .1 ; opt_ccr_mode = 1 (Sensor)? bnz calc_deko_divemode_sensor2 ; not in sensor mode - no transfer of sensor data to char_I_const_ppO2 tstfsz xB+0 ; check if we have found at least one usable sensor bra calc_deko_divemode_sensor1a ; YES - we have at least one usable sensor bsf setpoint_fallback ; NO - we have NO usable sensors -> initiate fallback btfss FLAG_ccr_mode ; check if we are in CCR mode bra calc_deko_divemode_sensor2 ; NO - continue with voting logic flags movff char_I_setpoint_cbar+0,char_I_const_ppO2 ; YES - select fixed setpoint no. 1 for fallback bra calc_deko_divemode_sensor2 ; done - continue with voting logic flags calc_deko_divemode_sensor1a: ; we have at least one usable sensor with a value > 0 bcf setpoint_fallback ; clear fallback condition movff sensor_setpoint,char_I_const_ppO2 ; transfer average sensor value to p2_deco.c code ;bra calc_deko_divemode_sensor2 calc_deko_divemode_sensor2: bsf voting_logic_sensor1 movff o2_ppo2_sensor1,lo rcall check_sensor_voting_helper incfsz WREG ; Was WREG = 255? bcf voting_logic_sensor1 ; No, ignore this sensor bsf voting_logic_sensor2 movff o2_ppo2_sensor2,lo rcall check_sensor_voting_helper incfsz WREG ; Was WREG=255? bcf voting_logic_sensor2 ; No, ignore this sensor bsf voting_logic_sensor3 movff o2_ppo2_sensor3,lo rcall check_sensor_voting_helper incfsz WREG ; Was WREG=255? bcf voting_logic_sensor3 ; No, ignore this sensor ; check if a warning shall be issued on sensor disagreement btfsc FLAG_ccr_mode ; check if we are in CCR mode bra check_warn_sensor_1 ; YES - continue with further checks btfsc FLAG_pscr_mode ; check if we are in pSCR mode bra check_warn_sensor_1 ; YES - continue with further checks bra check_warn_sensor_agree ; not in CCR and not in pSCR, so no warning check_warn_sensor_1: ; we are in CCR or pSCR mode btfsc is_bailout ; check if we are in bailout bra check_warn_sensor_agree ; YES - no warning in this case movff opt_ccr_mode,WREG ; =0: Fixed SP, =1: Sensor, =2: Auto SP sublw .1 ; opt_ccr_mode = 1 (Sensor)? bnz check_warn_sensor_agree ; not in sensor mode - no warning in this case ; check sensor 1 btfss sensor1_calibrated_ok ; check if sensor has a valid calibration bra check_warn_sensor_2 ; NO - sensor can not cause a warning then btfss use_O2_sensor1 ; YES - check if sensor is in use bra check_warn_sensor_2 ; NO - sensor can not cause a warning then btfsc voting_logic_sensor1 ; YES - check if sensor value is within agreement range bra check_warn_sensor_2 ; YES - continue with next sensor bcf sensors_agree ; NO - issue a warning return check_warn_sensor_2: ; check sensor 2 btfss sensor2_calibrated_ok ; check if sensor has a valid calibration bra check_warn_sensor_3 ; NO - sensor can not cause a warning then btfss use_O2_sensor2 ; YES - check if sensor is in use bra check_warn_sensor_3 ; NO - sensor can not cause a warning then btfsc voting_logic_sensor2 ; YES - check if sensor value is within agreement range bra check_warn_sensor_3 ; YES - continue with next sensor bcf sensors_agree ; NO - issue a warning return check_warn_sensor_3: ; check sensor 2 btfss sensor3_calibrated_ok ; check if sensor has a valid calibration bra check_warn_sensor_agree ; NO - sensor can not cause a warning then btfss use_O2_sensor3 ; YES - check if sensor is in use bra check_warn_sensor_agree ; NO - sensor can not cause a warning then btfsc voting_logic_sensor3 ; YES - check if sensor value is within agreement range bra check_warn_sensor_agree ; YES - continue with next sensor bcf sensors_agree ; NO - issue a warning return check_warn_sensor_agree: bsf sensors_agree return compute_ppo2_helper: call mult16x16 ; xA:2*xB:2=xC:4 movlw LOW .1000 movwf xB+0 movlw HIGH .1000 movwf xB+1 call div32x16 ; xC:4 / xB:2 = xC+3:xC+2 with xC+1:xC+0 as remainder movlw d'1' addwf xC+0,W ; we are just interested in the carry flag movlw d'0' addwfc xC+1,W ; we are still just interested in the carry flag tstfsz WREG ; ppO2 is higher than 2.55bar? setf xC+0 ; Yes. return check_sensor_custview_helper: btfss divemode ; check if we are in divemode return ; NO - not in dive mode, return movff opt_ccr_mode,WREG ; =0: Fixed SP, =1: Sensor, =2: Auto SP sublw .1 ; opt_ccr_mode = 1 (Sensors)? bnz check_sensor_helper_1 ; NO - not using the sensors in the moment clrf menupos3 ; YES - arm customview 1 (sensor values) bsf toggle_customview ; and request a customview toggle check_sensor_helper_1: return check_sensor_voting_helper: movf lo,W cpfsgt sensor_setpoint bra check_sensor_voting_common2 ; lo < sensor_setpoint ; lo > sensor_setpoint movf lo,W subwf sensor_setpoint,W movwf lo check_sensor_voting_common1: movlw sensor_voting_logic_threshold ; Threshold in 0.01 bar cpfsgt lo retlw .255 ; Within range retlw .0 ; Out of range check_sensor_voting_common2: ; lo<sensor_setpoint movf sensor_setpoint,W subwf lo,F bra check_sensor_voting_common1 ;----------------------------------------------------------------------------- divemodemode_togglegf: ; Toggle aGF/GF bcf toggle_gf ; clear flag btg use_agf ; toggle GF btfsc use_agf ; switch to aGF? bra divemodemode_togglegf_1 ; YES - branch to using aGF movff opt_GF_low,char_I_GF_Low_percentage ; NO - use normal GF factors movff opt_GF_high,char_I_GF_High_percentage ; bra divemodemode_togglegf_2 ; continue with common part divemodemode_togglegf_1: ; use alternative GF factors movff opt_aGF_low,char_I_GF_Low_percentage movff opt_aGF_high,char_I_GF_High_percentage divemodemode_togglegf_2: call TFT_gf_mask ; update customview mask to show which one is in use ; the customview itself has been called from divemenu_tree before goto restart_deco_engine ; ...and return calc_velocity: ; called every two seconds btfsc display_velocity bra calc_velocity1 ; Always update if already displayed btfss divemode2 return ; display velocity only if deeper then 1m (Not at the surface after the dive) calc_velocity1: SAFE_2BYTE_COPY amb_pressure, sub_a movff last_pressure_velocity+0,sub_b+0 movff last_pressure_velocity+1,sub_b+1 movff sub_a+0,last_pressure_velocity+0 ; store old value for velocity movff sub_a+1,last_pressure_velocity+1 call subU16 ; sub_c = amb_pressure - last_pressure bcf neg_flag_velocity btfsc neg_flag bsf neg_flag_velocity movff sub_c+0,xA+0 movff sub_c+1,xA+1 movlw d'39' ; 77 when called every second.... movwf xB+0 clrf xB+1 call mult16x16 ; differential pressure in mbar*77... movff xC+0,divA+0 movff xC+1,divA+1 movlw d'7' movwf divB+0 call div16 ; divided by 2^7 equals velocity in m/min movlw d'99' cpfsgt divA+0 ; limit to 99m/min bra calc_velocity3 movwf divA+0 ; divA=99 calc_velocity3: ; Copy old speeds movff old_velocity+2,old_velocity+3 movff old_velocity+1,old_velocity+2 movff old_velocity+0,old_velocity+1 movff divA+0,old_velocity+0 ; movff old_velocity+3,WREG ; addwf divA+0,F ; add old speed ; bcf STATUS,C ; rrcf divA+0,F ; /2 ; movff old_velocity+2,WREG ; addwf divA+0,F ; add old speed ; bcf STATUS,C ; rrcf divA+0,F ; /2 ; movff old_velocity+1,WREG ; addwf divA+0,F ; add old speed ; bcf STATUS,C ; rrcf divA+0,F ; /2 ; movff old_velocity+0,WREG ; addwf divA+0,F ; add old speed ; bcf STATUS,C ; rrcf divA+0,F ; /2 goto TFT_display_velocity ; With divA+0 = m/min..., and return... ;============================================================================= set_reset_safety_stop: ; Set flags for safety stop and/or reset safety stop TSTOSS opt_enable_safetystop ; =1: A safety stop is shown bra delete_safety_stop ; No, don't show safety stop btfsc decostop_active ; Is a deco stop displayed? bra delete_safety_stop ; Yes, don't show safety stop ; Below "opt_safety_stop_reset"? Set flag and reset count-down timer SAFE_2BYTE_COPY rel_pressure, lo call adjust_depth_with_salinity ; computes salinity setting into lo:hi [mbar] movff lo,sub_a+0 movff hi,sub_a+1 movff opt_safety_stop_reset,WREG ; [cbar] mullw .10 ; mbar in PRODL:H movff PRODL,sub_b+0 movff PRODH,sub_b+1 call subU16 ; sub_c = sub_a - sub_b btfss neg_flag bra reset_safety_stop ; Below 10m, reset safety stop ; Above "opt_safety_stop_end"? Clear flag. SAFE_2BYTE_COPY rel_pressure, lo call adjust_depth_with_salinity ; computes salinity setting into lo:hi [mbar] movff lo,sub_a+0 movff hi,sub_a+1 movff opt_safety_stop_end,WREG ; [cbar] mullw .10 ; mbar in PRODL:H movff PRODL,sub_b+0 movff PRODH,sub_b+1 call subU16 ; sub_c = sub_a - sub_b btfsc neg_flag bra delete_safety_stop ; Above 3m, remove safety stop ; Above "opt_safety_stop_start"? Activate safety stop SAFE_2BYTE_COPY rel_pressure, lo call adjust_depth_with_salinity ; computes salinity setting into lo:hi [mbar] movff lo,sub_a+0 movff hi,sub_a+1 movff opt_safety_stop_start,WREG ; [cbar] mullw .10 ; mbar in PRODL:H movff PRODL,sub_b+0 movff PRODH,sub_b+1 call subU16 ; sub_c = sub_a - sub_b btfsc neg_flag bra acivate_safety_stop ; Above 5m, activate safety stop bra reset_safety_stop2 ; Pause safety stop acivate_safety_stop: tstfsz safety_stop_countdown ; Countdown at zero? bsf show_safety_stop ; No, Set flag! return delete_safety_stop: clrf safety_stop_countdown ; reset timer bra reset_safety_stop2 ; Remove safety stop from display reset_safety_stop: movff opt_safety_stop_length,safety_stop_countdown ; reset timer reset_safety_stop2: bcf show_safety_stop ; Clear flag btfss safety_stop_active ; Safety stop shown return ; No, don't delete it bcf safety_stop_active ; Clear flag bsf FLAG_TFT_clear_safety_stop ; Clear safety stop return ;============================================================================= timeout_menuview: decfsz timeout_counter2,F ; timeout for menuview return ; No timeout, return ; Timeout, clear e.g. "Menu?" goto menuview_toggle_reset ; "returns" timeout_divemode_menu: decfsz timeout_counter2,F ; timeout for divemode menu return global timeout_divemode_menu2 timeout_divemode_menu2: ; Called from divemenu_tree.asm bcf divemode_menu ; Timeout! Clear flag call TFT_clear_divemode_menu ; Clear menu bsf FLAG_TFT_active_gas_divemode; Redraw gas/setpoint/diluent bcf blinking_better_gas ; Clear flag to have temperature updated once bsf FLAG_TFT_temp_divemode ; Displays temperature call TFT_draw_gassep_line ; Gas separator grid in spec mode only btfss decostop_active ; In deco mode ? bra timeout_divemode_menu_ndl ; No, show NDL again ; Show deco bsf FLAG_TFT_display_deko_mask bsf FLAG_TFT_display_deko bsf FLAG_TFT_display_tts return timeout_divemode_menu_ndl: ; Show NDL bsf FLAG_TFT_display_ndl_mask bsf FLAG_TFT_display_ndl return timeout_divemode: btfsc divemode_menu ; Divemode menu active? rcall timeout_divemode_menu ; Yes, check the timeout for it... btfsc menuview ; is a menuview shown? rcall timeout_menuview ; Yes, check the timeout for it... btfss realdive ; Dive longer then one minute return btfsc FLAG_apnoe_mode ; In Apnoe mode? bra timeout_divemode2 ; Yes, use apnoe_timeout [min] for timeout ifndef __DEBUG btfsc simulatormode_active ; In Simulator mode? bra timeout_divemode3 ; Yes, use simulator timeout endif bcf divemode infsnz timeout_counter1+0,F incf timeout_counter1+1,F ; timeout is 16 bit counter movff opt_diveTimeout,WREG ; in [min] mullw .60 movff PRODL,sub_a+0 movff PRODH,sub_a+1 ; in [s] movff timeout_counter1+0,sub_b+0 movff timeout_counter1+1,sub_b+1 call subU16 ; sub_c = sub_a - sub_b btfss neg_flag ; Result negative? bsf divemode ; No, set flag return timeout_divemode2: incf timeout_counter1+0,F ; seconds... movlw d'60' cpfseq timeout_counter1+0 ; timeout_counter1+0 = 60 ? return ; No ; one minute timeout done clrf timeout_counter1+0 bcf divemode incf apnoe_timeout_counter,F movlw apnoe_timeout ; apnoe timeout [min] cpfseq apnoe_timeout_counter bsf divemode return timeout_divemode3: bcf divemode incf timeout_counter1+0,F movlw simulator_timeout ; simulator timeout cpfsgt timeout_counter1+0 bsf divemode return update_divemode60: ; update any minute call get_battery_voltage ; gets battery voltage rcall set_powersafe ; Battery low? call customview_minute ; Do every-minute tasks for the custom view area bcf oneminupdate btfss simulatormode_active ; in simulator mode? return ; No ; Yes, quite dive mode simulation after 21*256s=89min:36s movlw .20 cpfsgt total_divetime_seconds+1 ; Timeout? return ; No ifdef __DEBUG return ; No simulator timeout in debug mode endif bra divemode_option1 ; Yes, set to 0m and "return" set_max_depth: movff max_pressure+0,sub_a+0 movff max_pressure+1,sub_a+1 SAFE_2BYTE_COPY rel_pressure, sub_b call subU16 ; sub_c = sub_a - sub_b ; max_pressure<rel_pressure -> neg_flag=1 ; rel_pressure<=max_pressure -> neg_flag=0 btfss neg_flag return ; max_pressure<rel_pressure movff sub_b+0,max_pressure+0 movff sub_b+1,max_pressure+1 bsf FLAG_TFT_max_depth ; Set flag return set_min_temp: movff minimum_temperature+0,sub_a+0 movff minimum_temperature+1,sub_a+1 SAFE_2BYTE_COPY temperature,sub_b call sub16 ; sub_c = sub_a - sub_b ; minimum_temperature<T -> neg_flag=1 ; T<=minimum_temperature -> neg_flag=0 btfsc neg_flag return ; minimum_temperature >= T movff sub_b+0,minimum_temperature+0 movff sub_b+1,minimum_temperature+1 return global set_dive_modes set_dive_modes: btfsc high_altitude_mode ; In high altitude (Fly) mode? bra set_dive_modes3 ; Yes! set_dive_modes0: movlw LOW start_dive_threshold movwf sub_a+0 ; dive_treshold is in cm movlw HIGH start_dive_threshold movwf sub_a+1 ; dive_treshold is in cm set_dive_modes1: SAFE_2BYTE_COPY rel_pressure, sub_b call subU16 ; sub_c = sub_a - sub_b btfss neg_flag bra set_dive_modes2 ; too shallow (rel_pressure < dive_threshold) btfsc realdive ; Dive longer than one minute? clrf timeout_counter1+0 ; Yes, reset timeout counter +++ bsf divemode ; (Re-)Set divemode flag bsf divemode2 ; displayed divetime is running return set_dive_modes2: bcf divemode2 ; Stop time btfss realdive ; dive longer then one minute? bcf divemode ; no -> this was no real dive return ; No, return set_dive_modes3: ; High-altitude mode btfsc realdive ; dive longer then one minute? bra set_dive_modes0 ; Yes -> this is a real dive -> Use start_dive_threshold or ascend movlw LOW high_altitude_dive_threshold movwf sub_a+0 movlw HIGH high_altitude_dive_threshold movwf sub_a+1 bra set_dive_modes1 set_powersafe: movlw color_code_battery_low+1; [%] cpfslt batt_percent return movlw d'7' ; Type of Alarm (Battery Low) movwf AlarmType ; Copy to Alarm Register bsf event_occured ; set event flag movlw .0 movff WREG,opt_brightness ; Set Brightness to ECO return ; return calc_average_depth: btfsc reset_average_depth ; Reset the Average depth? rcall reset_average1 ; Reset the resettable average depth ; 1. Add new 2xdepth to the Sum of depths registers SAFE_2BYTE_COPY rel_pressure,xB ; Buffer... bcf STATUS,C rlcf xB+0,F rlcf xB+1,F ; x2 movf xB+0,w addwf average_depth_hold+0,F movf xB+1,w addwfc average_depth_hold+1,F movlw d'0' addwfc average_depth_hold+2,F addwfc average_depth_hold+3,F ; Will work up to 9999mbar*60*60*24=863913600mbar ; Do the same for the _total registers (Non-Resettable) movf xB+0,w addwf average_depth_hold_total+0,F movf xB+1,w addwfc average_depth_hold_total+1,F movlw d'0' addwfc average_depth_hold_total+2,F addwfc average_depth_hold_total+3,F; Will work up to 9999mbar*60*60*24=863913600mbar ; 2. Compute Average Depth on base of average_divesecs:2 movff average_divesecs+0,xB+0 movff average_divesecs+1,xB+1 ; Copy movff average_depth_hold+0,xC+0 movff average_depth_hold+1,xC+1 movff average_depth_hold+2,xC+2 movff average_depth_hold+3,xC+3 call div32x16 ; xC:4 / xB:2 = xC+3:xC+2 with xC+1:xC+0 as remainder movff xC+0,avg_rel_pressure+0 movff xC+1,avg_rel_pressure+1 btfss divemode2 ; displayed divetime is running? return ; No (e.g. too shallow) ; 3. Compute Total Average Depth on base of total_divetime_seconds:2 movff total_divetime_seconds+0,xB+0 movff total_divetime_seconds+1,xB+1 ; Copy movff average_depth_hold_total+0,xC+0 movff average_depth_hold_total+1,xC+1 movff average_depth_hold_total+2,xC+2 movff average_depth_hold_total+3,xC+3 call div32x16 ; xC:4 / xB:2 = xC+3:xC+2 with xC+1:xC+0 as remainder movff xC+0,avg_rel_pressure_total+0 movff xC+1,avg_rel_pressure_total+1 return reset_average1: clrf average_depth_hold+0 clrf average_depth_hold+1 clrf average_depth_hold+2 clrf average_depth_hold+3 ; Clear average depth register movlw d'2' movwf average_divesecs+0 clrf average_divesecs+1 bcf reset_average_depth ; Clear flag return test_switches_divemode: ; checks switches in divemode btfsc divemode_menu ; Divemode menu shown? bra test_switches_divemode_menu ; Yes, use menu processor btfsc switch_left ;bra test_switches_divemode2 ; Enter button pressed, check if we need to do something goto menuview_toggle ; Menu or Simulator tasks; and return... btfss switch_right return ; No button press tstfsz menupos2 ; any option shown? bra test_switches_divemode1 ; Yes, do option tasks bsf toggle_customview ; No, toggle custom view return test_switches_divemode_menu: btfsc switch_left bra test_switches_divemode_menu2; Move cursor btfsc switch_right bra test_switches_divemode_menu3; Enter submenu or do something return ; No button press test_switches_divemode_menu1: clrf menupos1 test_switches_divemode_menu2: incf menupos1,F incf menupos4,W ; menupos4+1 -> WREG cpfslt menupos1 ; > menupos4 (Set in menu_processor.asm)? bra test_switches_divemode_menu1; > Yes, set to 1 call TFT_divemode_menu_cursor ; Update the cursor bcf switch_left movlw divemode_menu_timeout ; Reload timeout movwf timeout_counter2 ; timeout for divemode menu return test_switches_divemode_menu3: ; Enter submenu or do something bcf switch_right ; decf menupos1,F ; menu_processor needs 0-5... goto do_line_menu ; Warning! Trashes STKPTR and returns to diveloop_loop4: test_switches_divemode1: bcf switch_right movlw divemode_menuview_timeout movwf timeout_counter2 ; Reload timeout movff menupos2,WREG ; menupos2 holds number of customview/divemode menu function dcfsnz WREG,F bra divemode_option_gaschange ; Switch to the indicated "better gas" dcfsnz WREG,F bra divemode_option0 ; Start/Setup Divemode menu dcfsnz WREG,F bra divemode_option1 ; Quit Simulation? dcfsnz WREG,F bra divemode_option2 ; Descent 1m dcfsnz WREG,F bra divemode_option3 ; Ascend 1m dcfsnz WREG,F bra divemode_option4 ; Quit Apnoe mode dcfsnz WREG,F bra divemode_option5 ; Reset Stopwatch (In Gauge mode) dcfsnz WREG,F bra divemode_option6 ; +5mins simulation dcfsnz WREG,F bra divemode_option7 ; Store heading dcfsnz WREG,F bra divemode_option8 ; Switch to alt. layout return gas_switched_common: bcf divemode_gaschange ; Clear flag btfss FLAG_back_to_loop ; check if it is a switchback from OC bailout to loop bra gas_switched_common0 ; NO - continue with checking if selected gas is valid bcf FLAG_back_to_loop ; YES - clear flag movff active_diluent,menupos1 ; reload last diluent bra gas_switched_common1 ; continue with common part gas_switched_common0: tstfsz menupos1 ; menupos1=0? bra gas_switched_common1 ; NO - valid gas return ; YES - something went wrong, invalid gas, abort gas_switched_common1: movf menupos1,W ; get selected gas into WREG (1-6) btfsc FLAG_ccr_mode ; in CCR mode? bra gas_switched_common2 ; YES - configure diluent or bailout btfsc FLAG_pscr_mode ; in pSCR mode? bra gas_switched_common2 ; YES - configure diluent or bailout ; OC rcall setup_gas_registers ; With WREG = Gas 1-6 rcall deco_setup_oc_gases ; With WREG = Gas 1-6 bra gas_switched_common3 ; loop or bailout gas_switched_common2: rcall setup_dil_registers ; With WREG = diluent 1-6, in case of is_bailout reverts to OC gases rcall deco_setup_cc_diluents ; With WREG = diluent 1-6, in case of is_bailout reverts to OC gases gas_switched_common3: bsf FLAG_TFT_active_gas_divemode ; Redraw gas/setpoint/diluent call restart_deco_engine_wo_ceiling ; abort any running deco calculations and restart the deco engine ; Set flags for profile recording bsf event_occured ; set event flag btfsc is_bailout ; Choose OC Bailouts (OC Gases) bsf bailoutgas_event ; Bailout gas change btfss is_bailout ; Choose OC Bailouts (OC Gases) bsf stored_gas_changed ; OC gas change return ; Code to pass all parameters to the C code global get_first_gas_to_WREG get_first_gas_to_WREG: ; Gets first gas (1-5) into WREG lfsr FSR1,opt_gas_type ; Point to gas types clrf lo ; start with Gas0 get_first_gas_to_WREG2: movf lo,W movf PLUSW1,W ; Get Type of Gas #lo sublw .1 ; it is = 1 (First Gas) bz get_first_gas_to_WREG3 ; Found the first gas! incf lo,F ; ++ movlw NUM_GAS+1 cpfseq lo ; All done? bra get_first_gas_to_WREG2 ; Not yet ; No first gas found, use #1 movlw .0 movff WREG,opt_gas_type+0 ; Set Gas1 to First incf WREG,W ; 0 -> 1 return get_first_gas_to_WREG3: movf lo,W ; Put into Wreg incf WREG,W ; 0-4 -> 1-5 return ; Done global get_first_dil_to_WREG get_first_dil_to_WREG: ; Gets first dil (1-5) into WREG lfsr FSR1,opt_dil_type ; Point to dil types clrf lo ; start with Gas0 get_first_dil_to_WREG2: movf lo,W movf PLUSW1,W ; Get Type of Dil #lo sublw .1 ; it is = 1 (First Dil) bz get_first_dil_to_WREG3 ; Found the first dil! incf lo,F ; ++ movlw NUM_GAS+1 cpfseq lo ; All done? bra get_first_dil_to_WREG2 ; Not yet ; No first dil found, use #1 movlw .0 movff WREG,opt_dil_type+0 ; Set Dil1 to First incf WREG,W ; 0 -> 1 return get_first_dil_to_WREG3: movf lo,W ; Put into Wreg incf WREG,W ; 0-4 -> 1-5 return ; Done global deco_setup_oc_gases deco_setup_oc_gases: ; with currently breathed gas in WREG (1-5 or 6) movff WREG,char_I_current_gas ; gas to start with when doing the deco calculations banksel opt_gas_type ; opt_gas_type[] and opt_OC_bail_gas_change[] are together in bank common2 movff opt_gas_He_ratio+0,char_I_deco_He_ratio+0 movff opt_gas_O2_ratio+0,char_I_deco_O2_ratio+0 movlw .3 ; 3=Deco cpfseq opt_gas_type+0 ; Gas is deco type? clrf opt_OC_bail_gas_change+0 ; No, clear depth for 0=Disabled, 1=First and 2=Travel movff opt_gas_He_ratio+1,char_I_deco_He_ratio+1 movff opt_gas_O2_ratio+1,char_I_deco_O2_ratio+1 movlw .3 ; 3=Deco cpfseq opt_gas_type+1 ; Gas is deco type? clrf opt_OC_bail_gas_change+1 ; No, clear depth for 0=Disabled, 1=First and 2=Travel movff opt_gas_He_ratio+2,char_I_deco_He_ratio+2 movff opt_gas_O2_ratio+2,char_I_deco_O2_ratio+2 movlw .3 ; 3=Deco cpfseq opt_gas_type+2 ; Gas is deco type? clrf opt_OC_bail_gas_change+2 ; No, clear depth for 0=Disabled, 1=First and 2=Travel movff opt_gas_He_ratio+3,char_I_deco_He_ratio+3 movff opt_gas_O2_ratio+3,char_I_deco_O2_ratio+3 movlw .3 ; 3=Deco cpfseq opt_gas_type+3 ; Gas is deco type? clrf opt_OC_bail_gas_change+3 ; No, clear depth for 0=Disabled, 1=First and 2=Travel movff opt_gas_He_ratio+4,char_I_deco_He_ratio+4 movff opt_gas_O2_ratio+4,char_I_deco_O2_ratio+4 movlw .3 ; 3=Deco cpfseq opt_gas_type+4 ; Gas is deco type? clrf opt_OC_bail_gas_change+4 ; No, clear depth for 0=Disabled, 1=First and 2=Travel banksel common ; Setup char_I_deco_gas_change array movff opt_OC_bail_gas_change+0, char_I_deco_gas_change+0 movff opt_OC_bail_gas_change+1, char_I_deco_gas_change+1 movff opt_OC_bail_gas_change+2, char_I_deco_gas_change+2 movff opt_OC_bail_gas_change+3, char_I_deco_gas_change+3 movff opt_OC_bail_gas_change+4, char_I_deco_gas_change+4 ; switch to oc mode movff char_O_deco_status,lo ; working copy of char_O_deco_status in bank common bcf lo,DECO_MODE_PSCR_FLAG ; clear the pSCR-mode flag (may not be set, but never mind) bcf lo,DECO_MODE_LOOP_FLAG ; clear the loop/CCR-mode flag movff lo,char_O_deco_status ; bank safe write-back of char_O_deco_status return global deco_setup_cc_diluents deco_setup_cc_diluents: ; with currently breathed gas in WREG (1-5 or 6) btfsc is_bailout ; check if in bailout condition bra deco_setup_oc_gases ; revert to setting up OC gases in bailout condition movff WREG,char_I_current_gas ; gas to start with when doing the deco calculations movff opt_dil_He_ratio+0,char_I_deco_He_ratio+0 movff opt_dil_O2_ratio+0,char_I_deco_O2_ratio+0 movff opt_dil_type+0,WREG ; 0=Disabled, 1=First, 2=Normal tstfsz WREG ; Disabled? bra $+4 ; No movff WREG,char_I_dil_change+0 ; Yes, clear char_I_deco_gas_change (Bank safe) movff opt_dil_He_ratio+1,char_I_deco_He_ratio+1 movff opt_dil_O2_ratio+1,char_I_deco_O2_ratio+1 movff opt_dil_type+1,WREG ; 0=Disabled, 1=First, 2=Normal tstfsz WREG ; Disabled? bra $+4 ; No movff WREG,char_I_dil_change+1 ; Yes, clear char_I_dil_change movff opt_dil_He_ratio+2,char_I_deco_He_ratio+2 movff opt_dil_O2_ratio+2,char_I_deco_O2_ratio+2 movff opt_dil_type+2,WREG ; 0=Disabled, 1=First, 2=Normal tstfsz WREG ; Disabled? bra $+4 ; No movff WREG,char_I_dil_change+2 ; Yes, clear char_I_dil_change movff opt_dil_He_ratio+3,char_I_deco_He_ratio+3 movff opt_dil_O2_ratio+3,char_I_deco_O2_ratio+3 movff opt_dil_type+3,WREG ; 0=Disabled, 1=First, 2=Normal tstfsz WREG ; Disabled? bra $+4 ; No movff WREG,char_I_dil_change+3 ; Yes, clear char_I_dil_change movff opt_dil_He_ratio+4,char_I_deco_He_ratio+4 movff opt_dil_O2_ratio+4,char_I_deco_O2_ratio+4 movff opt_dil_type+4,WREG ; 0=Disabled, 1=First, 2=Normal tstfsz WREG ; Disabled? bra $+4 ; No movff WREG,char_I_dil_change+4 ; Yes, clear char_I_dil_change ; Setup char_I_deco_gas_change array movff char_I_dil_change+0, char_I_deco_gas_change+0 movff char_I_dil_change+1, char_I_deco_gas_change+1 movff char_I_dil_change+2, char_I_deco_gas_change+2 movff char_I_dil_change+3, char_I_deco_gas_change+3 movff char_I_dil_change+4, char_I_deco_gas_change+4 ; switch to CCR / pSCR mode movff char_O_deco_status,lo ; working copy of char_O_deco_status in bank common bsf lo,DECO_MODE_LOOP_FLAG ; loop flag is set in both, CCR and pSCR mode bcf lo,DECO_MODE_PSCR_FLAG ; clear pSCR mode flag by default btfsc FLAG_pscr_mode ; check if we are in pSCR mode bsf lo,DECO_MODE_PSCR_FLAG ; YES - set additional flag for pSCR mode movff lo,char_O_deco_status ; bank safe write-back of char_O_deco_status return global setup_gas_registers setup_gas_registers: ; with currently breathed gas in WREG (1-5 or 6) movwf active_gas ; set as current gas movlw .6 cpfseq active_gas ; gas = gas6 ? bra setup_gas_registers_15 ; NO - load gas 1-5 movff gas6_O2_ratio,char_I_O2_ratio ; copy gas6 O2 ratio to deco engine movff gas6_He_ratio,char_I_He_ratio ; copy gas6 H2 ratio to deco engine bra setup_gas_registers_com ; continue with common part setup_gas_registers_15: decf active_gas,W ; 1-5 -> 0-4 lfsr FSR1,opt_gas_O2_ratio+0 movff PLUSW1,char_I_O2_ratio ; copy gas 1-5 O2 ratio to deco engine lfsr FSR1,opt_gas_He_ratio+0 movff PLUSW1,char_I_He_ratio ; copy gas 1-5 He ratio to deco engine setup_gas_registers_com: ;lfsr FSR1,opt_gas_type ; commented out - currently not used anywhere ;movff PLUSW1,active_gas_type ; 0=Disabled, 1=First, 2=Travel, 3=Deco movff char_O_main_status,lo ; working copy of char_O_main_status in bank common bcf lo,DECO_MODE_PSCR_FLAG ; clear the pSCR-mode flag (may not be set, but never mind) bcf lo,DECO_MODE_LOOP_FLAG ; clear the loop/CCR-mode flag movff lo,char_O_main_status ; bank safe write-back of char_O_main_status movf active_gas,W ; reload WREG with diluent 1-5 or 6 (important!) return global setup_dil_registers setup_dil_registers: ; with currently breathed gas in WREG (1-5 or 6) btfsc is_bailout ; check if in bailout condition bra setup_gas_registers ; revert to setting up OC gases in bailout condition movwf active_gas ; set as current gas movff WREG,active_diluent ; remember for when switching back from bailout to loop movlw .6 cpfseq active_gas ; diluent = gas6 ? bra setup_dil_registers_15 ; NO - load diluent 1-5 movff gas6_O2_ratio,char_I_O2_ratio ; copy gas6 O2 ratio to deco engine movff gas6_He_ratio,char_I_He_ratio ; copy gas6 H2 ratio to deco engine bra setup_dil_registers_com ; continue with common part setup_dil_registers_15: decf active_gas,W ; 1-5 -> 0-4 lfsr FSR1,opt_dil_O2_ratio+0 movff PLUSW1,char_I_O2_ratio ; copy diluent 1-5 O2 ratio to deco engine lfsr FSR1,opt_dil_He_ratio+0 movff PLUSW1,char_I_He_ratio ; copy diluent 1-5 He ratio to deco engine setup_dil_registers_com: ;lfsr FSR1,opt_dil_type ; commented out - currently not used anywhere ;movff PLUSW1,active_gas_type ; 0=Disabled, 1=First, 2=Normal (there is no type 3 for diluents) movff char_O_main_status,lo ; working copy of char_O_main_status in bank common bsf lo,DECO_MODE_LOOP_FLAG ; loop flag is set in both, CCR and pSCR mode bcf lo,DECO_MODE_PSCR_FLAG ; clear pSCR mode flag by default btfsc FLAG_pscr_mode ; check if we are in pSCR mode bsf lo,DECO_MODE_PSCR_FLAG ; YES - set additional flag for pSCR mode movff lo,char_O_main_status ; bank safe write-back of char_O_main_status movf active_gas,W ; reload WREG with diluent 1-5 or 6 (important!) return divemode_option_gaschange: ; Switch to the better gas movff better_gas_number,menupos1 ; 1-5 bsf divemode_gaschange ; Change the gas in the dive mode loop... call menuview_toggle_reset ; Reset to zero (Zero=no menuview) bcf better_gas_available ; Clear flag immediately return divemode_option0: ; Start/Setup Divemode menu call TFT_clear_divemode_menu ; Clear menu area bcf menuview call do_main_divemenu global divemode_option0_return divemode_option0_return: ; movlw .1 ; movwf menupos1 ; Set to first option in divemode menu call TFT_divemode_menu_cursor ; Show the cursor movlw divemode_menu_timeout movwf timeout_counter2 ; timeout for divemode menu bsf divemode_menu ; Set flag clrf menupos2 ; Clear option counter goto diveloop_loop4 ; Goto back to diveloop (menu processor trashes STKPTR!) divemode_option4: movlw d'58' ; two seconds left movwf timeout_counter1+0 movlw apnoe_timeout-1 ; apnoe timeout [min] movwf apnoe_timeout_counter btfss simulatormode_active ; in simulator mode? return ; No divemode_option1: ; Quit simulation mode banksel isr_backup movlw LOW .1000 movwf sim_pressure+0 movlw HIGH .1000 movwf sim_pressure+1 ; Set to 0m -> End of Dive banksel common call menuview_toggle_reset ; Reset to zero (Zero=no menuview) btfss FLAG_apnoe_mode ; In Apnoe mode? return ; No movlw d'58' ; two seconds left movwf timeout_counter1+0 movlw apnoe_timeout-1 ; apnoe timeout [min] movwf apnoe_timeout_counter return divemode_option3: ; minus 1m banksel isr_backup movlw d'100' subwf sim_pressure+0 movlw .0 subwfb sim_pressure+1 rcall divemode_simulator_check_limits banksel common return divemode_option2: ; plus 1m banksel isr_backup movlw d'100' addwf sim_pressure+0 movlw .0 addwfc sim_pressure+1 rcall divemode_simulator_check_limits banksel common return divemode_option5: call menuview_toggle_reset ; Reset to zero (Zero=no menuview) bsf reset_average_depth ; Set Flag return divemode_option6: bcf divemode2 ; Stop divetime movlw .5 addwf divemins+0,F movlw .0 addwfc divemins+1,F ; Add 5 mins movlw LOW (.5*.60) addwf average_divesecs+0,F movlw HIGH (.5*.60) addwfc average_divesecs+1,F ; Add 5*60 seconds movlw LOW (.5*.60) addwf total_divetime_seconds+0,F movlw HIGH (.5*.60) addwfc total_divetime_seconds+1,F ; Add 5*60 seconds ; 1. Add 300xdepth to the sum of depths registers SAFE_2BYTE_COPY rel_pressure, xB ; Buffer... movlw LOW (.5*.60) movwf xA+0 movlw HIGH (.5*.60) movwf xA+1 call mult16x16 ; xA*xB=xC movf xC+0,w addwf average_depth_hold+0,F movf xC+1,w addwfc average_depth_hold+1,F movf xC+2,w addwfc average_depth_hold+2,F movf xC+3,w addwfc average_depth_hold+3,F ; Will work up to 9999mbar*60*60*24=863913600mbar ; Do the same for the _total registers (Non-Resettable) movf xC+0,w addwf average_depth_hold_total+0,F movf xC+1,w addwfc average_depth_hold_total+1,F movf xC+2,w addwfc average_depth_hold_total+2,F movf xC+3,w addwfc average_depth_hold_total+3,F; Will work up to 9999mbar*60*60*24=863913600mbar movlw .5 ; + 5 minutes movff WREG,char_I_sim_advance_time; copy to mailbox bsf divemode2 ; continue divetime call restart_deco_engine goto menuview_toggle_reset ; and return... divemode_option7: ; Store heading for compass view movff compass_heading_shown+0,compass_bearing+0 movff compass_heading_shown+1,compass_bearing+1 bsf compass_bearing_set ; set flag goto menuview_toggle_reset ; Done and return... divemode_option8: bsf alternative_divelayout ; Set flag for mode bsf FLAG_TFT_divemode_mask_alt ; Set flag for mask movlw .1 movwf menupos3 ; For the customviews... call TFT_ClearScreen ; Clear screen goto menuview_toggle_reset ; Done and return... divemode_simulator_check_limits: ; Check limits (150m and 0m) movlw LOW d'16000' ; Compare to 16bar=16000mbar (150m). subwf sim_pressure+0,W movlw HIGH d'16000' subwfb sim_pressure+1,W bnc divemode_simulator_check_limits2 ; No-carry = borrow = not deeper ; Too deep, limit to 150m movlw LOW d'16000' movwf sim_pressure+0 movlw HIGH d'16000' movwf sim_pressure+1 return divemode_simulator_check_limits2: movlw LOW d'1000' ; Compare to 1bar == 0m == 1000 mbar. subwf sim_pressure+0,W movlw HIGH d'1000' subwfb sim_pressure+1,W btfsc STATUS,C ; No-carry = borrow = not deeper. return ; Deeper than 0m == Ok. ; Too shallow, limit to 0m movlw LOW d'1000' movwf sim_pressure+0 movlw HIGH d'1000' movwf sim_pressure+1 return ;============================================================================= ; Compare all enabled gas in list, to see if a better one is available. ; ; Output: better_gas_available, better_gas_number ; check_gas_change: ; Checks if a better gas should be selected (by user) bcf better_gas_available ; =1: A better gas is available and a gas change is advised in divemode clrf WREG movff WREG,better_gas_number ; clear better gas register SAFE_2BYTE_COPY rel_pressure,xA movlw d'100' movwf xB+0 clrf xB+1 call div16x16 ; compute depth in full m -> result in xC+0 btfsc FLAG_pscr_mode ; in PSCR mode? bra check_gas_change2 ; YES - check for diluents btfss FLAG_ccr_mode ; in CCR mode? bra check_gas_change_OC_bail ; NO - check for OC check_gas_change2: btfsc is_bailout ; in bailout? bra check_gas_change_OC_bail ; YES - check for OC ; Check Diluents movlw .0 rcall check_dil_common ; With Gas 0-4 in WREG movlw .1 rcall check_dil_common ; With Gas 0-4 in WREG movlw .2 rcall check_dil_common ; With Gas 0-4 in WREG movlw .3 rcall check_dil_common ; With Gas 0-4 in WREG movlw .4 rcall check_dil_common ; With Gas 0-4 in WREG bra check_gas_change_exit check_gas_change_OC_bail: movlw .0 rcall check_gas_common ; With Gas 0-4 in WREG movlw .1 rcall check_gas_common ; With Gas 0-4 in WREG movlw .2 rcall check_gas_common ; With Gas 0-4 in WREG movlw .3 rcall check_gas_common ; With Gas 0-4 in WREG movlw .4 rcall check_gas_common ; With Gas 0-4 in WREG ;bra check_gas_change_exit check_gas_change_exit: bsf FLAG_TFT_active_gas_divemode; redraw gas/setpoint/diluent btfss better_gas_available ; is a better gas available? bcf blinking_better_gas ; NO - clear blinking flag btfsc better_gas_available ; is a better gas available? return ; YES clrf WREG ; NO - clear better_gas_number (for gaslist display) movff WREG,better_gas_number return check_gas_common: ; With Gas 0-4 in WREG btfsc better_gas_available ; Better Gas already found? return ; Yes, return lfsr FSR1,opt_gas_type ; 0=Disabled, 1=First, 2=Travel, 3=Deco btfss PLUSW1,0 ; Test for Bit0 and 1 -> type=3 -> Deco return ; No btfss PLUSW1,1 ; Test for Bit0 and 1 -> type=3 -> Deco return ; No incf WREG,W ; 1-5 cpfseq active_gas ; is this gas current gas? bra check_gas_common2 ; No return ; Yes, skip test for active gas check_gas_common2: decf WREG,W ; 0-4 movwf hi ; Save tested gas 0-4 lfsr FSR1,opt_OC_bail_gas_change movff PLUSW1,lo ; Change depth into lo movlw minimum_change_depth cpfsgt lo ; Change depth>minimum_change_depth? return ; No, Change depth not deep enough, skip! movf xC+0,W ; load depth in m into WREG cpfsgt lo ; gas_change_depth < current depth? bra check_gas_common3 ; No, check if we are within the better_gas_window_pos window incf hi,W ; 1-5 movff WREG,better_gas_number ; number (1-5) of the "better gas" in divemode, =0: no better gas available movlw better_gas_window_neg subwf lo,W ; Change depth-better_gas_window_neg cpfslt xC+0 ; current depth<Change depth-better_gas_window_neg? bra check_gas_common4 ; Ok, now check the better gas ppO2<char_I_ppO2_max return check_gas_common3: incf hi,W ; 1-5 movff WREG,better_gas_number ; number (1-5) of the "better gas" in divemode, =0: no better gas available movlw better_gas_window_pos addwf lo,W ; Change depth+better_gas_window_pos cpfsgt xC+0 ; current depth>Change depth+better_gas_window_pos? bra check_gas_common4 ; Ok, now check the better gas ppO2<char_I_ppO2_max return check_gas_common4: movf hi,W ; gas 0-4 into WREG lfsr FSR1,char_I_deco_O2_ratio ; load base address char_I_deco_O2_ratio array movff PLUSW1,lo ; read O2 ratio from array into lo SAFE_2BYTE_COPY amb_pressure, xA movlw d'10' movwf xB+0 clrf xB+1 call div16x16 ; xC=p_amb/10 movff xC+0,xA+0 movff xC+1,xA+1 movff lo,xB+0 ; =O2 ratio clrf xB+1 call mult16x16 ; lo * p_amb/10 ; Check very high ppO2 manually tstfsz xC+2 ; char_I_O2_ratio * p_amb/10 > 65536, ppO2>6,55bar? return ; Done. ; Check if ppO2>3,30bar btfsc xC+1,7 return ; Done. ; Check for low ppo2 movff xC+0,sub_b+0 movff xC+1,sub_b+1 movff char_I_ppO2_min,WREG mullw d'100' ; char_I_ppO2_min*100 movff PRODL,sub_a+0 movff PRODH,sub_a+1 call subU16 ; sub_c = sub_a - sub_b btfss neg_flag return ; Done (Too low). ;check if we are within our warning thresholds! movff xC+0,sub_a+0 movff xC+1,sub_a+1 movff char_I_ppO2_max_deco,WREG ; ppO2 max for MOD calculation and color coding in divemode addlw .1 ; e.g. >1.60 mullw d'100' ; char_I_ppO2_max*100 movff PRODL,sub_b+0 movff PRODH,sub_b+1 call subU16 ; sub_c = sub_a - sub_b btfsc neg_flag bsf better_gas_available ;=1: A better gas is available and a gas change is advised in divemode return ; Done. check_dil_common: ; With Dil 0-4 in WREG btfsc better_gas_available ; Better Diluent already found? return ; Yes, return lfsr FSR1,opt_dil_type ; 0=Disabled, 1=First, 2=Normal tstfsz PLUSW1 ; =0? bra check_dil_common1 ; No return ; Yes, skip inactive diluents for test check_dil_common1: incf WREG,W ; 1-5 cpfseq active_gas ; is this the current diluent? bra check_dil_common2 ; No return ; Yes, skip test for active diluent check_dil_common2: decf WREG,W ; 0-4 movwf hi ; Save tested diluent 0-4 lfsr FSR1,char_I_dil_change movff PLUSW1,lo ; Change depth into lo movlw minimum_change_depth cpfsgt lo ; Change depth>minimum_change_depth? return ; No, Change depth not deep enough, skip! movf xC+0,W ; load depth in m into WREG cpfsgt lo ; gas_change_depth < current depth? return ; No, check next gas incf hi,W ; 1-5 movff WREG,better_gas_number ; number (1-5) of the "better gas" in divemode, =0: no better gas available movlw better_gas_window_neg subwf lo,W ; Change depth-better_gas_window_neg cpfslt xC+0 ; current depth<Change depth-better_gas_window_neg? bsf better_gas_available ;=1: A better gas is available and a gas change is advised in divemode return ;============================================================================= ; Check for Auto-SP ; check_dive_autosp: ; Check for Auto-SP movff opt_ccr_mode,WREG ; =0: Fixed SP, =1: Sensor, =2: Auto SP sublw .2 ; opt_ccr_mode = 2 (Auto SP)? bz check_dive_autosp2 ; Yes, check return ; No, return for Sensor or Fixed mode check_dive_autosp2: SAFE_2BYTE_COPY rel_pressure,xA movlw d'100' movwf xB+0 clrf xB+1 call div16x16 ; compute depth in full m -> result in xC+0 ; Check SP2 btfsc sp2_switched ; =1: This setpoint has been autoselected already bra check_dive_autosp3 ; Skip check movff char_I_setpoint_change+1,lo ; Get depth in m tstfsz lo ; =0? bra check_dive_autosp2a ; No, continue bra check_dive_autosp3 ; Skip check check_dive_autosp2a: decf lo,W ; -1 -> WREG cpfsgt xC+0 ; Compare with depth bra check_dive_autosp3 ; lower depth, do not switch ; auto switch to SP2 movff char_I_setpoint_cbar+1,char_I_const_ppO2 ; Use SetPoint rcall xmit_sp_set_flag bsf sp2_switched ; Set flag check_dive_autosp3: ; Check SP3 btfsc sp3_switched ;=1: This setpoint has been autoselected already bra check_dive_autosp4 ; Skip check movff char_I_setpoint_change+2,lo ; Get depth in m tstfsz lo ; =0? bra check_dive_autosp3a ; No, continue bra check_dive_autosp4 ; Skip check check_dive_autosp3a: decf lo,W ; -1 -> WREG cpfsgt xC+0 ; Compare with depth bra check_dive_autosp4 ; lower depth, do not switch ; auto switch to SP3 movff char_I_setpoint_cbar+2,char_I_const_ppO2 ; Use SetPoint rcall xmit_sp_set_flag bsf sp3_switched ; Set flag check_dive_autosp4: ; Check SP4 btfsc sp4_switched ;=1: This setpoint has been autoselected already bra check_dive_autosp5 ; Skip check movff char_I_setpoint_change+3,lo ; Get depth in m tstfsz lo ; =0? bra check_dive_autosp4a ; No, continue bra check_dive_autosp5 ; Skip check check_dive_autosp4a: decf lo,W ; -1 -> WREG cpfsgt xC+0 ; Compare with depth bra check_dive_autosp5 ; lower depth, do not switch ; auto switch to SP4 movff char_I_setpoint_cbar+3,char_I_const_ppO2 ; Use SetPoint rcall xmit_sp_set_flag bsf sp4_switched ; Set flag check_dive_autosp5: ; Check SP5 btfsc sp5_switched ;=1: This setpoint has been autoselected already bra check_dive_autosp6 ; Skip check movff char_I_setpoint_change+4,lo ; Get depth in m tstfsz lo ; =0? bra check_dive_autosp5a ; No, continue bra check_dive_autosp6 ; Skip check check_dive_autosp5a: decf lo,W ; -1 -> WREG cpfsgt xC+0 ; Compare with depth bra check_dive_autosp6 ; lower depth, do not switch ; auto switch to SP5 movff char_I_setpoint_cbar+4,char_I_const_ppO2 ; Use SetPoint rcall xmit_sp_set_flag bsf sp5_switched ; Set flag check_dive_autosp6: return xmit_sp_set_flag: movff char_I_const_ppO2,WREG call transmit_setpoint ; Transmit current setpoint from WREG (in cbar) to external electronics bsf setpoint_changed ; Set flag (for profile) bsf event_occured ; Set event flag return set_logbook_marker: bcf FLAG_set_marker ; clear flag movlw d'6' ; set type of Alarm (manual marker) movwf AlarmType ; copy to Alarm Register bsf event_occured ; Set event flag return ;============================================================================= ; Setup everything to enter divemode. ; dive_boot_oc: rcall get_first_gas_to_WREG ; Gets first gas (1-5) into WREG rcall setup_gas_registers ; set-up of gas parameters of currently breathed gas (with WREG = gas 1-5) rcall deco_setup_oc_gases ; set-up of gas list for deco calculations (with WREG = gas 1-5) return dive_boot_cc: bcf is_bailout ; =1: Bailout bcf setpoint_fallback ; =1: Fallback to SP1 due to external O2 sensor failure bcf blinking_setpoint ; Reset blinking SP flag ; revoke sensors from usage if they do not have a valid calibration bsf use_O2_sensor1 bsf use_O2_sensor2 bsf use_O2_sensor3 btfss sensor1_calibrated_ok bcf use_O2_sensor1 btfss sensor2_calibrated_ok bcf use_O2_sensor2 btfss sensor3_calibrated_ok bcf use_O2_sensor3 btfss optical_input ; do we have an optical input? bra dive_boot_cc_0 ; No ; Copy (initial) valid flags from HUD/ppO2 Monitor btfsc sensor1_active bsf use_O2_sensor1 btfsc sensor2_active bsf use_O2_sensor2 btfsc sensor3_active bsf use_O2_sensor3 dive_boot_cc_0: ; In pSCR mode, only settings 0 (calculated ppO2) and 1 (ppO2 from sensors) are defined. ; In case we still have 3 (auto SP) selected out of previous ccr mode, we reset to 0. btfss FLAG_pscr_mode bra dive_boot_cc_1 movff opt_ccr_mode,WREG ; =0: Fixed SP (CCR) / calculated SP (pSCR), =1: Sensor, =2: Auto SP sublw .2 ; opt_ccr_mode = 1 (Auto SP)? bnz dive_boot_cc_1 movlw .0 movff WREG,opt_ccr_mode dive_boot_cc_1: bsf setpoint_changed ; set flag (for profile) bcf sp2_switched ; =1: This setpoint has been auto-selected already bcf sp3_switched ; =1: This setpoint has been auto-selected already bcf sp4_switched ; =1: This setpoint has been auto-selected already bcf sp5_switched ; =1: This setpoint has been auto-selected already rcall get_first_dil_to_WREG ; get first gas (1-5) into WREG rcall setup_dil_registers ; set-up of gas parameters for currently breathed gas (with WREG = current gas 1-5) rcall deco_setup_cc_diluents ; set-up of gas list for deco calculations (with WREG = current gas 1-5) ; Start with SP1 (CCR) or 0 (pSCR) as default. ; If in sensor mode, this value will be overwritten by calc_deko_divemode_sensor clrf WREG ; preload WREG with setpoint value 0 for pSCR calculated btfss FLAG_ccr_mode ; are we in CCR mode? bra dive_boot_cc_2 ; NO - keep preloaded value movff char_I_setpoint_cbar+0,WREG ; YES - get value of setpoint 1 dive_boot_cc_2: movff WREG,char_I_const_ppO2 ; write setpoint to deco engine call transmit_setpoint ; transmit current setpoint from WREG (in cbar) to external electronics goto calc_deko_divemode_sensor ; read & process sensor data (and return) diveloop_boot: call restart_set_modes_and_flags call I2C_sleep_accelerometer ; stop accelerometer call I2C_sleep_compass ; stop compass clrf WREG movff WREG,max_pressure+0 ; clear some variables movff WREG,max_pressure+1 ; init in invalid data state clrf WREG ; set WREG to 0 bsf WREG,int_invalid_flag ; set invalid flag bsf WREG,int_is_zero ; set zero flag movff WREG,int_O_tank_pres_need+1 ; Set flags for tank pressure needs = 0 before p2_deco.c movff WREG,int_O_tank_pres_need+3 ; can do it. If this is not done here and the gas needs movff WREG,int_O_tank_pres_need+5 ; custom view is shown before p2_deco.c completes the first movff WREG,int_O_tank_pres_need+7 ; deco calculation, some rubbish numbers from last dive of movff WREG,int_O_tank_pres_need+9 ; simulation may be shown ; configure the deco engine: movff char_O_deco_status,WREG ; bank-safe copy bsf WREG,DECO_STATUS_0_FLAG ; configure init ... bsf WREG,DECO_STATUS_1_FLAG ; ... state, bcf WREG,DECO_PLAN_FLAG ; normal plan mode, bsf WREG,DECO_CNS_FLAG ; enable CNS calculation (CNS at end of dive), bcf WREG,DECO_VOLUME_FLAG ; disable gas volume calculation, and bcf WREG,DECO_ASCENT_FLAG ; disable delayed ascent calculation movff WREG,char_O_deco_status ; bank-safe copy back clrf WREG movff WREG,char_O_main_status ; reset char_O_main_status movlw deco_distance movff WREG,char_I_deco_distance movff opt_last_stop,char_I_depth_last_deco movff opt_GF_low,char_I_GF_Low_percentage movff opt_GF_high,char_I_GF_High_percentage bcf use_agf ; Start with normal GF set bcf divemode_menu ; clear divemode menu flag bcf alternative_divelayout ; Start with default layout bcf blinking_depth_prev ; clear flag for blinking depth bcf blinking_depth_warning ; clear flag for blinking depth bcf blinking_depth_toggle ; clear flag for blinking depth movlw d'1' movwf apnoe_max_pressure+0 clrf apnoe_max_pressure+1 ; clrf apnoe_surface_mins ; clrf apnoe_surface_secs clrf apnoe_mins clrf divemins+0 clrf divemins+1 ; Copy date and time for logbook movff year,start_year movff month,start_month movff day,start_day movff hours,start_hours movff mins,start_mins movff int_O_CNS_fraction+0,CNS_start+0 ; save CNS value at beginning of dive movff int_O_CNS_fraction+1,WREG ; get high byte to WREG bcf WREG,int_warning_flag ; clear warning flag bit movff WREG,CNS_start+1 ; move high byte on movff int_O_gradient_factor+0,GF_start ; save GF value at beginning of dive (only lower byte used for value) bcf no_more_divesecs ; =1: do no longer show seconds in divemode bcf divemode_menu_active clrf menupos1 clrf menupos2 ; Reset to zero (Zero=no premenu or simulator task) bsf sensors_agree ; init of sensors disagree warning system btfsc FLAG_ccr_mode bra diveloop_boot_cc btfsc FLAG_pscr_mode bra diveloop_boot_cc rcall dive_boot_oc bra diveloop_boot_cont diveloop_boot_cc: rcall dive_boot_cc diveloop_boot_cont: ; Copy opt_dil_types into backup (For "lost gas" feature) movff opt_dil_type+0,opt_dil_type_backup+0 ; 0=Disabled, 1=First, 2=Normal movff opt_dil_type+1,opt_dil_type_backup+1 ; 0=Disabled, 1=First, 2=Normal movff opt_dil_type+2,opt_dil_type_backup+2 ; 0=Disabled, 1=First, 2=Normal movff opt_dil_type+3,opt_dil_type_backup+3 ; 0=Disabled, 1=First, 2=Normal movff opt_dil_type+4,opt_dil_type_backup+4 ; 0=Disabled, 1=First, 2=Normal ; Copy opt_gas_types into backup (For "lost gas" feature) movff opt_gas_type+0,opt_gas_type_backup+0 ; 0=Disabled, 1=First, 2=Travel, 3=Deco movff opt_gas_type+1,opt_gas_type_backup+1 ; 0=Disabled, 1=First, 2=Travel, 3=Deco movff opt_gas_type+2,opt_gas_type_backup+2 ; 0=Disabled, 1=First, 2=Travel, 3=Deco movff opt_gas_type+3,opt_gas_type_backup+3 ; 0=Disabled, 1=First, 2=Travel, 3=Deco movff opt_gas_type+4,opt_gas_type_backup+4 ; 0=Disabled, 1=First, 2=Travel, 3=Deco ; Also copy change depths into backup (For "lost gas" feature) movff char_I_dil_change+0,opt_dil_change_backup+0 ; Gas change depths Diluents movff char_I_dil_change+1,opt_dil_change_backup+1 ; Gas change depths Diluents movff char_I_dil_change+2,opt_dil_change_backup+2 ; Gas change depths Diluents movff char_I_dil_change+3,opt_dil_change_backup+3 ; Gas change depths Diluents movff char_I_dil_change+4,opt_dil_change_backup+4 ; Gas change depths Diluents ; Also copy change depths into backup (For "lost gas" feature) movff opt_OC_bail_gas_change+0,opt_OC_bail_gas_change_backup+0; Gas change depths OC/Bailout movff opt_OC_bail_gas_change+1,opt_OC_bail_gas_change_backup+1; Gas change depths OC/Bailout movff opt_OC_bail_gas_change+2,opt_OC_bail_gas_change_backup+2; Gas change depths OC/Bailout movff opt_OC_bail_gas_change+3,opt_OC_bail_gas_change_backup+3; Gas change depths OC/Bailout movff opt_OC_bail_gas_change+4,opt_OC_bail_gas_change_backup+4; Gas change depths OC/Bailout clrf WREG movff WREG,better_gas_number ; clear better gas register bcf show_safety_stop ; =1: Show the safety stop clrf safety_stop_countdown ; Clear count-down clrf samplesecs clrf apnoe_timeout_counter ; timeout in minutes clrf timeout_counter1+0 ; takes care of the timeout (low byte) clrf timeout_counter1+1 ; takes care of the timeout (high byte) clrf AlarmType ; Clear all alarms bcf event_occured ; clear flag clrf average_depth_hold_total+0 clrf average_depth_hold_total+1 clrf average_depth_hold_total+2 clrf average_depth_hold_total+3 ; Clear Non-Resettable Average rcall reset_average1 ; Reset the resettable average depth bcf decostop_active bcf better_gas_available ; =1: A better gas is available and a gas change is advised in divemode call ghostwriter_short_header ; Write short header with divenumber into profile memory btfsc simulatormode_active bra diveloop_boot_1 ; Normal mode = Surface pressure is the pressure 30mn before dive. SAFE_2BYTE_COPY last_surfpressure_30min, int_I_pres_surface ;copy surfacepressure to deco routine SAFE_2BYTE_COPY last_surfpressure_30min, last_surfpressure ;copy surfacepressure to last_surfpressure for correct depth bra diveloop_boot_2 diveloop_boot_1: ; Simulator mode: Surface pressure is 1bar. movlw LOW .1000 movff WREG,int_I_pres_surface+0 ; LOW copy surface pressure to deco routine movlw HIGH .1000 movff WREG,int_I_pres_surface+1 ; HIGH copy surface pressure to deco routine diveloop_boot_2: SAFE_2BYTE_COPY temperature,minimum_temperature ; Reset Min-Temp registers call init_recording_params ; set up all the divisors bsf ccr_diluent_setup ; For CCR mode (Required to have better gas working) btfsc FLAG_ccr_mode ; =1: CCR mode (Fixed ppO2 or Sensor) active bra divemode_boot2 btfsc FLAG_pscr_mode bra divemode_boot2 bcf ccr_diluent_setup ; For OC mode (Required to have better gas working) divemode_boot2: bcf LEDg ; switch off green LED / release reset to RX circuitry bcf LEDr ; switch off red LED bcf realdive btfss simulatormode_active ; do not disable in simulator mode! call disable_rs232 ; Disable RS232 btfsc enable_screen_dumps ; =1: Ignore vin_usb, wait for "l" command (Screen dump) call enable_rs232 ; Also sets to speed_normal ... ; Reset divetime seconds movlw .2 ; Start at 2seconds movwf total_divetime_seconds+0 clrf total_divetime_seconds+1 movwf divesecs movwf apnoe_secs bsf divemode2 ; displayed divetime is running (Divetime starts HERE) return ; Done with divemode boot divemode_check_for_warnings: movlw .1 ; One warning at a time in alt. layout mode btfss alternative_divelayout movlw .2 ; Two warnings at a time in default layout mode cpfsgt warning_counter ; only one (or two) warnings active? bra divemode_check_for_warnings1 ; Yes, update every second btfss secs,0 ; Every two seconds... return btfss secs,1 ; Every four seconds... return divemode_check_for_warnings1: bcf warning_active ; Clear flag clrf warning_counter ; Clear counter ; warnings sorted by severity, highest severity first ; Warnings for all modes call check_warn_battery ; Check if the battery level should be displayed/warned call check_divetimeout ; Not actually a warning. Check and show the divemode timeout btfsc FLAG_apnoe_mode ; Done for Apnoe or Gauge mode bra divemode_check_for_warnings2 btfsc FLAG_gauge_mode ; Done for Apnoe or Gauge mode bra divemode_check_for_warnings2 ; Warnings only in deco modes rcall check_ppO2 ; check ppO2 and displays warning, if required btfss sensors_agree ; are the sensor values within the threshold range? rcall check_warn_sensors_disagree ; NO - further evaluate btfsc sensors_agree ; are the sensor values within the threshold range? bcf sensor_warning ; YES - revoke memorized sensor warning movff char_O_deco_warnings,WREG ; bank-safe copy for deco warnings btfsc WREG,outside_warning_lock ; are we outside of the ZH-L16 model? rcall warn_outside ; YES rcall check_IBCD ; check for IBCD attention or warning btfsc decostop_active ; In deco mode? rcall check_and_store_gf_violation; Yes, sets warnings, if required movff char_O_deco_warnings,WREG ; bank-safe copy for deco warnings btfsc WREG,mbubble_warning_lock ; do we have a microbubbles warning? rcall warn_mbubbles ; YES rcall check_cns_violation ; Check CNS value and display it, if required ;btfsc decostop_active ; In deco mode? rcall check_gas_needs ; show gas needs warning if any gas need is > threshold rcall check_eod_cns_violation ; Check CNS values for end-of-dive and display warning, if required call TFT_display_ftts ; Show @+x time btfsc use_agf ; In aGF mode? rcall warn_agf ; Yes, show a warning for it btfsc setpoint_fallback ; =1: Fallback to SP1 due to external O2 sensor failure rcall warn_fallback ; Show the warning divemode_check_for_warnings2: ; Display the warning icon? btfsc warning_active ; Any warning active? bsf FLAG_TFT_divemode_warning ; Yes btfss warning_active ; Any warning active? bsf FLAG_TFT_divemode_warning_clear ; No, clear warning icon ; Setup warning_page number incf warning_page,F movf warning_page,W bcf STATUS,C btfss alternative_divelayout rlcf warning_page,W ; *2 (But only in standard layout mode) cpfsgt warning_counter ; > warning_counter clrf warning_page ; No, clear ; Clear both rows of warnings if there is nothing to show at all tstfsz warning_counter ; any warnings? bra divemode_check_for_warnings3 ; YES - look if second row needs to be cleared bsf FLAG_TFT_dive_warning_text_clear ; Set flag return divemode_check_for_warnings3: ; Clear 2nd row of warnings if there is nothing to show (on this page) btfss second_row_warning ; =1: The second row contains a warning bsf FLAG_TFT_dive_warning_text_clr2 ; Set flag for 2nd row return ; Done. global check_warn_battery check_warn_battery: movff batt_percent,lo movlw battery_show_level+1 cpfslt lo return ; No Display, no warning ; Display Battery, but warn? movff batt_percent,lo movlw color_code_battery_low+1 cpfsgt lo bsf warning_active ; Set Warning flag movlw .4 cpfseq menupos3 ; battery shown in Custom View 4? bra check_warn_battery2 ; No return ; Yes, do not show twice (in custom view and in warning area) check_warn_battery2: incf warning_counter,F ; increase counter goto TFT_update_batt_percent_divemode ; Show percent (And return) check_divetimeout: btfsc divemode2 return ; displayed divetime is not running incf warning_counter,F ; increase counter goto TFT_divetimeout ; Show timeout counter (and return) check_ppO2: btfsc FLAG_ccr_mode ; are we in CCR mode? bra check_ppO2_loop ; YES btfsc FLAG_pscr_mode ; are we in pSCR mode? bra check_ppO2_loop ; YES bra check_ppO2_oc_1 ; NO - neither CCR nor pSCR check_ppO2_loop: btfsc is_bailout ; in bailout? bra check_ppO2_oc_1 ; YES - continue with OC movff int_O_pure_ppO2+1,hi ; NO - get upper part of int_O_pure_ppO2 btfsc hi,int_warning_flag ; ppO2 of the pure diluent to low or high? rcall check_ppo2_display ; YES - show warning and return on next line btfsc hi,int_attention_flag ; ppO2 of the pure diluent close to setpoint? rcall check_ppo2_display ; YES - show warning and return on next line bra check_ppO2_oc_2 ; skip attention threshold test on breathed ppO2 check_ppO2_oc_1: movff int_O_breathed_ppO2+1,WREG ; get upper part of int_O_breathed_ppO2 btfsc WREG,int_attention_flag ; breathed ppO2 just above attention threshold? bra check_ppo2_display ; YES - show ppO2 check_ppO2_oc_2: movff int_O_breathed_ppO2+1,WREG ; get upper part of int_O_breathed_ppO2 (perhaps again) btfsc WREG,int_low_flag ; breathed ppO2 to low? bra check_ppO2_low ; YES - record the warning and show ppO2 btfsc WREG,int_high_flag ; breathed ppO2 to high? bra check_ppO2_high ; YES - record the warning and show ppO2 TSTOSS opt_showppo2 ; show ppO2 anyhow? (0 = no, 1 = show always) return ; NO - no warnings, no show bra check_ppo2_display ; YES - just show ppO2 check_ppO2_low: movlw d'4' ; set type of alarm (ppO2 low) bra check_ppO2_common ; continue with common part check_ppO2_high: movlw d'5' ; set type of alarm (ppO2 high) check_ppO2_common: movwf AlarmType ; copy alarm type to alarm register bsf event_occured ; set event flag bsf warning_active ; set warning flag btfsc is_bailout ; are we in bailout? bra check_ppo2_display ; YES - skip CCR/pSCR checks btfsc FLAG_ccr_mode ; are we in CCR mode? return ; YES - no extra warning required btfsc FLAG_pscr_mode ; are we in pSCR mode? return ; YES - no extra warning required check_ppo2_display: ; display warning if ppO2 is not already shown in custom view movlw .9 cpfseq menupos3 ; ppO2 shown in Custom View 9? bra check_ppO2_a ; No return ; Yes, do not show twice (in custom view and in warning area) check_ppO2_a: movlw .11 cpfseq menupos3 ; ppO2 shown in Custom View 11? bra check_ppO2_b ; No return ; Yes, do not show twice (in custom view and in warning area) check_ppO2_b: movlw .12 cpfseq menupos3 ; ppO2 shown in Custom View 12? bra check_ppO2_c ; No return ; Yes, do not show twice (in custom view and in warning area) check_ppO2_c: movlw .10 cpfseq menupos3 ; ppO2 shown in Custom View 10? bra check_ppO2_d ; No return ; Yes, do not show twice (in custom view and in warning area) check_ppO2_d: incf warning_counter,F ; increase counter goto TFT_display_ppo2 ; show breathed gas or diluent ppO2 warning (and return) global check_cns_violation check_cns_violation: ; Check if CNS should be displayed movff int_O_CNS_fraction+1,WREG ; get high byte btfsc WREG,int_warning_flag ; warning flag set? bra check_cns_violation2 ; Yes - issue warning btfsc WREG,int_attention_flag ; attention flag set? bra display_cns_violation ; YES - just display CNS return ; No - no display, no warning check_cns_violation2: bsf warning_active ; Set Warning flag display_cns_violation: ; Show CNS if not shown in the custom view movlw .11 cpfseq menupos3 ; CNS shown in Custom View? bra display_cns_violation2 ; No return ; Yes, do not show twice (in custom view and in warning area) display_cns_violation2: movlw .8 cpfseq menupos3 ; CNS shown through Custom View 8 right now? bra display_cns_violation3 ; No return ; Yes, do not show twice (in custom view and in warning area) display_cns_violation3: incf warning_counter,F ; increase counter goto TFT_display_cns ; Show CNS (and return) global check_eod_cns_violation ; check end-of-dive CNS values check_eod_cns_violation: movff int_O_CNS_fraction+1,WREG ; get high-byte of current CNS value btfsc WREG,int_warning_flag ; current CNS value in warning state? return ; YES - inhibit eod warning if current CNS is already in warning movff int_O_normal_CNS_fraction+1,WREG btfsc WREG,int_invalid_flag ; flag for invalid value set? bra check_eod_cns_violation1 ; YES - continue with checking the other CNS value btfsc WREG,int_warning_flag ; NO - flag for warning set? bra check_eod_cns_violation2 ; YES - issue warning check_eod_cns_violation1: ; NO - continue with checking the other CNS value movff int_O_alternate_CNS_fraction+1,WREG btfsc WREG,int_invalid_flag ; flag for invalid value set? return ; YES - done with CNS checking btfsc WREG,int_warning_flag ; NO - flag for warning set? bra check_eod_cns_violation2 ; Yes - issue warning return ; NO - done with CNS checking check_eod_cns_violation2: ; YES - issue warning bsf warning_active ; set Warning flag movlw .8 ; issue textual warning if CNS values are not shown in the custom view right now cpfseq menupos3 ; CNS values shown through Custom View 8 right now? bra display_eod_cns_violation ; NO - issue textual warning return ; YES - do not show twice (in custom view and in warning area) display_eod_cns_violation: incf warning_counter,F ; increase counter goto TFT_display_eod_cns ; issue CNS at end-of-dive warning (and return) global check_and_store_gf_violation check_and_store_gf_violation: movff int_O_gradient_factor+1,WREG ; get upper byte of gradient factor btfss WREG,int_warning_flag ; check if the warning flag is set bra check_and_store_gf_violation2 ; NO - continue with checking for attention flag movlw d'2' ; YES - set type of alarm movwf AlarmType ; copy to alarm register bsf event_occured ; set event flag bsf warning_active ; set warning flag bra check_and_store_gf_violation3 ; show gf warning check_and_store_gf_violation2: btfsc WREG,int_attention_flag ; check if the attention flag is set bra check_and_store_gf_violation3 ; YES - show gf TSTOSS opt_enable_IBCD ; NO - IBCD warning activated? bra check_and_store_gf_violation4 ; NO - continue checking of deco info movff char_O_deco_warnings,WREG ; YES - get the deco warnings vector btfss WREG,IBCD_warning ; is the IBCD warning flag set? bra check_and_store_gf_violation4 ; NO - continue checking for deco info check_and_store_gf_violation3: ; YES - show gf bsf warning_active ; set Warning flag incf warning_counter,F ; increase counter goto TFT_warning_gf ; show GF (and return) check_and_store_gf_violation4: ; check for deco info btfss divemode ; in divemode? return ; NO - done, return movff char_O_deco_warnings,WREG ; YES - get the deco warnings vector btfss WREG,deco_flag ; check if the deco flag is set return ; NO - all done, return incf warning_counter,F ; YES - increase counter goto TFT_info_deco ; show deco info warn_outside: incf warning_counter,F ; increase counter bsf warning_active ; Set Warning flag goto TFT_warning_outside ; show outside warning (and return) global warn_mbubbles warn_mbubbles: incf warning_counter,F ; increase counter bsf warning_active ; Set Warning flag goto TFT_warning_mbubbles ; show microbubbles warning (and return) warn_agf: incf warning_counter,F ; increase counter goto TFT_warning_agf ; Show aGF warning (and return) warn_fallback: incf warning_counter,F ; increase counter bsf warning_active ; Set Warning flag goto TFT_warning_fallback ; Show fallback warning (and return) check_gas_needs: banksel int_O_tank_pres_need movf int_O_tank_pres_need+1,w ; get HIGH(pres need of 1st tank) iorwf int_O_tank_pres_need+3,w ; inclusive or with HIGH(pres need of 2nd tank) iorwf int_O_tank_pres_need+5,w ; inclusive or with HIGH(pres need of 3rd tank) iorwf int_O_tank_pres_need+7,w ; inclusive or with HIGH(pres need of 4th tank) iorwf int_O_tank_pres_need+9,w ; inclusive or with HIGH(pres need of 5th tank) banksel common btfsc WREG,int_invalid_flag ; check if invalid flag is set return ; YES - no further checking required btfsc WREG,int_warning_flag ; NO - check if any gas has a pres_need >= pres_fill bsf warning_active ; YES - set warning flag btfsc WREG,int_warning_flag ; NO - check if any gas has a pres_need >= pres_fill goto TFT_warning_gas_needs_warn ; Yes - show a warning btfsc WREG,int_attention_flag ; NO - check if any gas has a pres_need >= pres_fill * threshold goto TFT_warning_gas_needs_att ; YES - show an attention bcf gas_needs_attention ; NO - clear flag for a new attention bcf gas_needs_warning ; clear flag for a new warning return check_warn_sensors_disagree: incf warning_counter,F ; increase counter bsf warning_active ; YES - set Warning flag goto TFT_warning_sensor_disagree ; show sensor disagree warning (and return) check_IBCD: TSTOSS opt_enable_IBCD ; IBCD warning activated? return ; NO - done movff char_O_deco_warnings,WREG ; YES - get deco warnings vector btfss WREG,IBCD_warning ; IBCD warning flag set? return ; NO - return incf warning_counter,F ; YES - increase counter goto TFT_warning_IBCD ; write warning to display global restart_deco_engine global restart_deco_engine_wo_ceiling restart_deco_engine: ; make bank save copies and set flags for invalid data movff int_O_ceiling+1,WREG bsf WREG,char_invalid_flag ; int_O_ceiling has its invalid flag on a char's position! movff WREG,int_O_ceiling+1 restart_deco_engine_wo_ceiling: ; make more bank save copies and set more flags for invalid data movff char_O_deco_gas+0,WREG bsf WREG,char_invalid_flag movff WREG,char_O_deco_gas+0 movff int_O_ascenttime+1,WREG bsf WREG,int_invalid_flag movff WREG,int_O_ascenttime+1 movff int_O_alternate_ascenttime+1,WREG bsf WREG,int_invalid_flag movff WREG,int_O_alternate_ascenttime+1 movff int_O_normal_CNS_fraction+1,WREG bsf WREG,int_invalid_flag movff WREG,int_O_normal_CNS_fraction+1 movff int_O_alternate_CNS_fraction+1,WREG bsf WREG,int_invalid_flag movff WREG,int_O_alternate_CNS_fraction+1 movff int_O_tank_pres_need+1,WREG bsf WREG,int_invalid_flag movff WREG,int_O_tank_pres_need+1 ; restart deco engine movff char_O_deco_status,WREG ; get current deco engine configuration bcf WREG,DECO_STATUS_0_FLAG ; set status flags to... bcf WREG,DECO_STATUS_1_FLAG ; ... DECO_STATUS_START bsf WREG,DECO_PLAN_FLAG ; fake we came from alternative plan to force normal plan to be done next movff WREG,char_O_deco_status ; write back new configuration to restart deco computations return ;============================================================================= ; simulator mode ; global do_demo_divemode do_demo_divemode: call option_save_all ; Save all settings into EEPROM before starting simulation call deco_push_tissues_to_vault ; C-code: back-up status of the real tissues banksel common ; Bank1 ; +++ COMMENTED OUT FOR TESTING PURPOSE ONLY !!! +++ ; +++ DO NOT COMMENT OUT IN OPERATIONAL USE !!! +++ ; bsf restore_deco_data ; Restore tissue and CNS after simulator use bcf pressure_refresh btfss pressure_refresh ; Wait for sensor bra $-2 bsf simulatormode_active ; Set Flag ; Compute dive ambient conditions banksel char_I_bottom_depth movf char_I_bottom_depth,W mullw .100 movff PRODL,rel_pressure+0 movff PRODH,rel_pressure+1 movlw LOW (.1000) addwf PRODL,W movff WREG,sim_pressure+0 movlw HIGH (.1000) addwfc PRODH,W movff WREG,sim_pressure+1 banksel common ; Bank1 bsf divemode goto diveloop ; Switch into Divemode! END