Mercurial > public > hwos_code
view src/divemode.asm @ 628:cd58f7fc86db
3.05 stable work
| author | heinrichsweikamp |
|---|---|
| date | Thu, 19 Sep 2019 12:01:29 +0200 |
| parents | c40025d8e750 |
| children | 185ba2f91f59 |
line wrap: on
line source
;============================================================================= ; ; File divemode.asm combined next generation V3.04.3 ; ; Dive Mode ; ; 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 "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" #include "surfmode.inc" #include "rx_ops.inc" extern do_line_menu extern do_main_divemenu extern menu_draw_lines_divemode extern option_save_all extern init_recording_params IFDEF _compass extern TFT_dive_compass_heading ENDIF ;---- Private local Variables ------------------------------------------------- CBLOCK local1 ; max size is 16 Byte !!! sensor_setpoint ; sensor ppo2 in 0.01bar for deco routine check_gas_num ; used in search for best gas/dil: current gas/dil number (1-5) check_gas_depth ; used in search for best gas/dil: current gas/dil change depth check_gas_type ; used in search for best gas/dil: current gas/dil type check_gas_O2_ratio ; used in search for best gas/dil: current gas/dil O2 ratio best_gas_num ; used in search for best gas/dil: best gas/dil number (1-5) CAUTION: there is also a variable named best_gas_number ! best_gas_depth ; used in search for best gas/dil: best gas/dil change depth last_pressure_velocity:2 ; cached last absolute pressure for velocity calculation TFT_output_flags_1 ; TFT update flags for output phase 1 TFT_output_flags_2 ; TFT update flags for output phase 2 TFT_output_flags_3 ; TFT update flags for output phase 3 TFT_output_flags_4 ; TFT update flags for output phase 4 DM_flags_local ; various dive mode flags ENDC ; used: 14 byte, remaining: 2 byte CBLOCK local2 ; max size is 16 Byte !!! pressure_rel_accu_trip:4 ; pressure accumulator for calculating the resettable average depth pressure_rel_accu_total:4 ; pressure accumulator for calculating the total dive average depth xmitter_flags_stat ; pressure transmitter flags for status xmitter_flags_mesg ; pressure transmitter flags for messages ppO2_min:2 ; used in search for best gas/dil: minimum ppO2 required ppO2_max_default:2 ; used in search for best gas/dil: default maximum ppO2 ppO2_max_deco:2 ; used in search for best gas/dil: deco maximum ppO2 ENDC ; used: 16 byte, remaining: 0 byte ==> FULL ;---- Private local Flags ---------------------------------------------------- ; TFT_output_flags_1 - phase 1: every second - before deco calculations, all modes #DEFINE FLAG_TFT_depth_current TFT_output_flags_1,0 ; =1: show current depth #DEFINE FLAG_TFT_depth_maximum TFT_output_flags_1,1 ; =1: show maximum depth #DEFINE FLAG_TFT_active_gas_divemode TFT_output_flags_1,2 ; =1: show active gas and dive mode #DEFINE FLAG_TFT_apnoe_surface_time TFT_output_flags_1,3 ; =1: show apnoe mode surface time #DEFINE FLAG_TFT_depth_maximum_apnoe TFT_output_flags_1,4 ; =1: show maximum depth of last apnoe dive #DEFINE FLAG_TFT_clear_apnoe_surface TFT_output_flags_1,5 ; =1: clear apnoe mode surface data from screen #DEFINE FLAG_TFT_apnoe_divetime TFT_output_flags_1,6 ; =1: show apnoe mode dive times ; TFT_output_flags_1,7 ; --- unused ; TFT_output_flags_2 - phase 2: every second - before deco calculations, deco modes only #DEFINE FLAG_TFT_divemode_mask TFT_output_flags_2,0 ; =1: show dive mode mask #DEFINE FLAG_TFT_divetime TFT_output_flags_2,1 ; =1: show dive time #DEFINE FLAG_TFT_safety_stop_show TFT_output_flags_2,2 ; =1: show safety stop #DEFINE FLAG_TFT_safety_stop_clear TFT_output_flags_2,3 ; =1: clear safety stop #DEFINE FLAG_TFT_temperature TFT_output_flags_2,4 ; =1: show temperature (or resettable dive time when in compass view) ; TFT_output_flags_2,5 ; --- unused ; TFT_output_flags_2,6 ; --- unused ; TFT_output_flags_2,7 ; --- unused ; TFT_output_flags_3 - phase 3: every second - after deco calculations, deco modes only #DEFINE FLAG_TFT_clear_deco_data TFT_output_flags_3,0 ; =1: clear deco data (NDL or stop & TTS) #DEFINE FLAG_TFT_display_ndl_mask TFT_output_flags_3,1 ; =1: show NDL mask #DEFINE FLAG_TFT_display_deco_mask TFT_output_flags_3,2 ; =1: show deco mask #DEFINE FLAG_TFT_display_ndl TFT_output_flags_3,3 ; =1: show NDL data #DEFINE FLAG_TFT_display_deco TFT_output_flags_3,4 ; =1: show deco stop data #DEFINE FLAG_TFT_display_tts TFT_output_flags_3,5 ; =1: show deco TTS data ; TFT_output_flags_3,6 ; --- unused ; TFT_output_flags_3,7 ; --- unused ; TFT_output_flags_4 - phase 4: every second - after deco calculations, all modes #DEFINE FLAG_TFT_customview_mask TFT_output_flags_4,0 ; =1: show the custom view mask #DEFINE FLAG_TFT_sign_show TFT_output_flags_4,1 ; =1: show the advice / attention / warning sign #DEFINE FLAG_TFT_sign_clear TFT_output_flags_4,2 ; =1: clear the advice / attention / warning sign #DEFINE FLAG_TFT_message_clear_both TFT_output_flags_4,3 ; =1: clear messages, both rows #DEFINE FLAG_TFT_message_clear_2nd TFT_output_flags_4,4 ; =1: clear messages, 2nd row only #DEFINE FLAG_TFT_velocity_show TFT_output_flags_4,5 ; =1: show vertical velocity #DEFINE FLAG_TFT_velocity_clear TFT_output_flags_4,6 ; =1: clear vertical velocity ; TFT_output_flags_4,7 ; --- unused ; Pressure Transmitter Status #DEFINE transmitter1_lost xmitter_flags_stat,0 ; =1: transmitter 1 lost is an old message #DEFINE transmitter1_battery xmitter_flags_stat,1 ; =1: transmitter 1 battery low is an old message #DEFINE transmitter1_pres_warn xmitter_flags_stat,2 ; =1: transmitter 1 pressure warning is an old message #DEFINE transmitter1_pres_att xmitter_flags_stat,3 ; =1: transmitter 1 pressure attention is an old message #DEFINE transmitter2_lost xmitter_flags_stat,4 ; =1: transmitter 2 lost is an old message #DEFINE transmitter2_battery xmitter_flags_stat,5 ; =1: transmitter 2 battery low is an old message #DEFINE transmitter2_pres_warn xmitter_flags_stat,6 ; =1: transmitter 2 pressure warning is an old message #DEFINE transmitter2_pres_att xmitter_flags_stat,7 ; =1: transmitter 2 pressure attention is an old message ; Pressure Transmitter Messages #DEFINE pres_customview_shown xmitter_flags_mesg,0 ; =1: pressure readings custom view has been shown before #DEFINE show_transmitter_attention xmitter_flags_mesg,1 ; =1: show transmitter attention #DEFINE show_pres_warning xmitter_flags_mesg,2 ; =1: show transmitter pressure warning #DEFINE show_pres_attention xmitter_flags_mesg,3 ; =1: show transmitter pressure attention ; xmitter_flags_mesg,4 ; --- unused ; xmitter_flags_mesg,5 ; --- unused ; xmitter_flags_mesg,6 ; --- unused ; xmitter_flags_mesg,7 ; --- unused ; various Flags #DEFINE FLAG_backtrack_full DM_flags_local,0 ; =1: the backtracking storage is full #DEFINE new_deco_data_avail DM_flags_local,1 ; =1: new NDL or deco data available #DEFINE o2_sensors_agree DM_flags_local,2 ; =1: the ppO2 of all sensors are within the threshold range #DEFINE update_menu DM_flags_local,3 ; =1: redraw the dive menu #DEFINE FLAG_SP2_used DM_flags_local,4 ; =1: setpoint 2 has been auto-selected already #DEFINE FLAG_SP3_used DM_flags_local,5 ; =1: setpoint 3 has been auto-selected already #DEFINE FLAG_SP4_used DM_flags_local,6 ; =1: setpoint 4 has been auto-selected already #DEFINE FLAG_SP5_used DM_flags_local,7 ; =1: setpoint 5 has been auto-selected already dmode CODE ;============================================================================= global diveloop diveloop: clrf STKPTR ; clear return addresses stack ; start with a clean time base bsf reset_timebase ; request ISR to reset the main timebase, ; as we are in dive mode the dive timers will be reset as well ; reset global flags clrf DM_flags_state ; clear all flags for dive mode status clrf DM_flags_request ; clear all flags for user requests clrf DM_flags_event ; clear all flags for data recording events clrf DM_flags_layout1 ; clear all flags for display control / layout (1) clrf DM_flags_layout2 ; clear all flags for display control / layout (2) clrf DM_flags_message ; clear all flags for display control / messages clrf DM_flags_gas_dil ; clear all flags for display control / gases and diluents bcf dive_main_menu ; clear dive main menu flag bcf dive_options_menu ; clear dive options menu flag ; reset local flags clrf TFT_output_flags_1 ; clear all flags for TFT output phase 1 clrf TFT_output_flags_2 ; clear all flags for TFT output phase 2 clrf TFT_output_flags_3 ; clear all flags for TFT output phase 3 clrf TFT_output_flags_4 ; clear all flags for TFT output phase 4 clrf xmitter_flags_stat ; clear all pressure transmitter status flags clrf xmitter_flags_mesg ; clear all pressure transmitter message flags clrf DM_flags_local ; clear all the various other flags, too ; set initial screen layout bcf alt_layout_active ; default to normal layout TSTOSC opt_layout ; alternative layout enabled? bsf alt_layout_active ; YES - start with alternative layout IFDEF _gas_contingency ; disable gas contingency mode (may be left over activated by deco calculator) clrf WREG movff WREG,char_I_gas_contingency ENDIF ; boot tasks for all modes call diveloop_boot ; startup tasks for all modes ; clrf CCP1CON ; stop PWM ; bcf PORTC,2 ; pull PWM output to GND ; clrf CCPR1L ; backlight off call TFT_boot ; initialize TFT (includes clear screen) call TFT_show_divemode_mask ; display static dive mode mask call TFT_Display_FadeIn ; dim up the display ; reload and redraw last custom view movff customview_divemode,active_customview bsf FLAG_TFT_customview_mask bcf divetime_longer_1min ; the dive has just begun btfsc FLAG_apnoe_mode ; in apnea mode? bsf divetime_longer_1min ; YES - force dive to have lasted for longer than 1 minute already btfsc sensor_override_active ; in simulator mode? bsf divetime_longer_1min ; YES - force dive to have lasted for longer than 1 minute already bsf trigger_pres_cur_changed ; flag that the pressures have changed to have all data... bsf trigger_pres_max_changed ; ... written to the display on the first output round bsf trigger_temp_changed ; flag that the temperature has changed to have the temperature ... ; ... written to the display on the first output round bsf new_deco_data_avail ; flag that new deco engine results are available to have the initial data ... ; ... written to the display on the first output round ; clear the resettable average depth call clear_resettable_average_depth ; ; initial caching of new absolute and relative pressure, ISR-safe 2 byte copies ; SMOVII pressure_abs, pressure_abs_cached ; SMOVII pressure_rel_cur,pressure_rel_cur_cached ; ; initial transfer of absolute pressure to deco engine ; MOVII pressure_abs_cached,int_I_pres_respiration btfsc FLAG_apnoe_mode ; in apnoe mode? bra diveloop_1 ; YES - done with initialization btfsc FLAG_gauge_mode ; NO - in gauge mode? bra diveloop_1 ; YES - done with initialization bsf FLAG_TFT_display_ndl_mask ; NO - in deco mode then, display NDL mask bsf FLAG_TFT_active_gas_divemode; - request initial display of gas and setpoint diveloop_1: btfsc reset_timebase ; has the ISR confirmed reset of the timebase meanwhile? bra $-2 ; NO - not yet, loop waiting for confirmation before entering the dive loop diveloop_loop: ; ### the dive loop starts here ### btfsc trigger_full_second ; new 1/1 second? bra diveloop_loop_2 ; YES - continue with tasks every 1/1 second btfsc trigger_half_second ; NO - new 1/2 second? bra diveloop_loop_1 ; YES - continue with tasks every 1/2 second ; tasks every round except every 1/1 or 1/2 second IFDEF _compass movlw index_compass_dm ; index of compass view cpfseq active_customview ; in compass view? bra diveloop_loop_11 ; NO - continue with tasks every round call TFT_dive_compass_heading ; YES - update compass heading value bsf FLAG_TFT_temperature ; - redraw temperature (will show resettable dive time now) ENDIF bra diveloop_loop_11 ; - continue tasks every round diveloop_loop_1: ; tasks every 1/2 second bcf trigger_half_second ; clear flag btfsc FLAG_gauge_mode ; in gauge mode? bra diveloop_loop_11 ; YES - done with 1/2 second tasks btfsc FLAG_apnoe_mode ; NO - in apnoe mode? bra diveloop_loop_11 ; YES - done with 1/2 second tasks ; tasks every 1/2 second in deco modes call calc_deco_engine ; ##### calculate decompression ##### bra diveloop_loop_11 ; done with 1/2 second tasks diveloop_loop_2: ; tasks every 1/1 second (code includes tasks every 1/2 second that fall onto the full second) bcf trigger_full_second ; clear flag for new 1/1 second bcf trigger_half_second ; clear flag for new 1/2 second as well btfss trigger_temp_changed ; has the temperature changed? bra diveloop_loop_3 ; NO - continue with tasks every 1/1 second bsf FLAG_TFT_temperature ; YES - display temperature bcf trigger_temp_changed ; - clear flag ; "future hardware will need min temperature checked every second..." (?) MOVII temperature_min,sub_a ; - copy last temperature_min to sub_a SMOVII temperature_cur,sub_b ; - ISR-safe 2 byte copy of current temperature to sub_b call sub16 ; - sub_c = sub_a - sub_b = temperature_min - temperature btfsc neg_flag ; - temperature > temperature_min ? bra diveloop_loop_3 ; YES - done MOVII sub_b,temperature_min ; NO - store new minimum temperature diveloop_loop_3: ; tasks every 1/1 second btfss trigger_pres_cur_changed ; has the pressure changed? bra diveloop_loop_4 ; NO - continue with tasks every 1/1 second ; set flags bcf trigger_pres_cur_changed ; clear flag for pressure change bsf FLAG_TFT_depth_current ; set flag to display updated depth ; cache new absolute and relative pressure, ISR-safe 2 byte copies SMOVII pressure_abs, pressure_abs_cached SMOVII pressure_rel_cur,pressure_rel_cur_cached ; transfer absolute pressure to deco engine MOVII pressure_abs_cached,int_I_pres_respiration ; compute absolute pressure / 10, will be used later on a couple of times MOVII pressure_abs_cached,xA MOVLI .10,xB call div16x16 ; xC = xA / xB = absolute pressure / 10 MOVII xC,pressure_abs_10 ; store result for later use ; compute current depth in meters MOVII pressure_rel_cur_cached,xA ; copy current relative pressure to xA ADDLI .50, xA ; add 0.5 meter = 50 mbar for rounding up/down at 0.5 meters MOVLI .100,xB ; divide by 100 to turn mbar into meters call div16x16 ; xC = xA / xB = depth in full meters movff xC+0,depth_meter ; store result in depth_meter, only LSB of result needed IFDEF _ccr_pscr ; adjust auto-setpoint btfsc FLAG_ccr_mode ; in CCR mode? call check_dive_autosp ; YES - check for Auto-SP ENDIF ; check for new max pressure btfss trigger_pres_max_changed ; has the max pressure changed? bra diveloop_loop_4 ; NO - continue with tasks every 1/1 second bcf trigger_pres_max_changed ; YES - clear flag for new max pressure bsf FLAG_TFT_depth_maximum ; - set flag for displaying new max depth SMOVII pressure_rel_max,pressure_rel_max_cached ; - cache new max depth diveloop_loop_4: ; continue tasks every 1/1 second IFDEF _external_sensor btfsc FLAG_ccr_mode ; in CCR mode? rcall calc_deko_divemode_sensor ; YES - do sensor data acquisition if applicable btfsc FLAG_pscr_mode ; in pSCR mode? rcall calc_deko_divemode_sensor ; YES - do sensor data acquisition if applicable ENDIF btfsc FLAG_apnoe_mode ; in apnoe mode? rcall divemode_apnoe_tasks ; YES - do 1 sec. apnoe tasks ; display all animated (blinking) values at the beginning of each full second to have a stable timebase rcall TFT_output_1 ; do display updates btfss FLAG_apnoe_mode ; in apnoe mode? bra diveloop_loop_5 ; NO - continue with deco mode tasks every 1/1 second ; apnoe mode tasks every 1/1 second call dive_customview_second ; do every second tasks for the custom view area bra diveloop_loop_10 ; continue with common tasks every 1/1 second diveloop_loop_5: ; deco mode tasks every 1/1 second bsf FLAG_TFT_divetime ; display (new) dive time rcall safety_stop_show ; serve safety stop rcall TFT_output_2 ; do display updates call divemode_check_warnings ; check for warnings IFDEF _rx_functions btfss tr_functions_activated ; TR functions activated? bra diveloop_loop_6 ; NO - continue with deco mode tasks every 1/2 second call get_pressure_readings ; YES - get pressure readings call configure_sac_calculation ; - set up SAC calculation ENDIF diveloop_loop_6: ; deco mode tasks every 1/1 second INCI divesecs_avg_trip ; increment the resettable dive time INCI divesecs_avg_total ; increment the total dive time btfsc FLAG_gauge_mode ; in gauge mode? bra diveloop_loop_7 ; YES - skip deco calculations call calc_deco_engine ; ##### calculate decompression ##### btfsc new_deco_data_avail ; new NDL or deco data available? call show_new_deco_data ; YES - update the display and update the decostop_active flag btfsc decostop_active ; in deco mode? bsf FLAG_TFT_display_deco ; YES - update deco stop depth & time every second because of depth-dependent color-coding bsf FLAG_TFT_depth_current ; set flag to display depth (in next round, needed in deco modes irrespectively of a pressure change for color-coding and blinking effects) diveloop_loop_7: ; deco mode tasks alternating every 2 seconds on timebase btfss timebase_1sec ; on even second of timebase? rcall calc_velocity ; YES - calculate velocity and display if > threshold btfsc timebase_1sec ; on odd second of timebase? call check_gas_best ; YES - check if a better gas cue can be given diveloop_loop_8: ; deco mode tasks alternating every 2 seconds on resettable dive time btfss divesecs_avg_trip+0,0 ; on even second of resettable dive time? rcall calc_average_depth ; YES - calculate average depth btfsc divesecs_avg_trip+0,0 ; on odd second of resettable dive time? rcall safety_stop_control ; YES - exercise safety stop control diveloop_loop_9: ; deco mode tasks every 1/1 second rcall check_deco_states ; check and lock if in deco and in the deco stops region rcall TFT_output_3 ; do display updates diveloop_loop_10: ; common tasks every 1/1 second rcall timeout_divemode ; check for timeout condition rcall check_dive_modes ; test if depth still deeper than threshold btfsc trigger_full_minute ; has next minute begun? rcall update_divemode60 ; YES - update clock, etc. btfss FLAG_oc_mode ; are we in OC mode? bsf FLAG_TFT_active_gas_divemode; NO - have the gas and setpoint redrawn on every second to update setpoint display, animate the blinking, etc. btfsc dive_main_menu ; dive mode menu shown? bsf update_menu ; YES - request update rcall TFT_output_4 ; do display updates ; tasks every round, every mode diveloop_loop_11: call test_switches_divemode ; check switches in dive mode bra diveloop_loop_12 global diveloop_menu_exit diveloop_menu_exit: ; jump-in from menu exit bsf FLAG_TFT_temperature ; restore temperature display or resettable dive time (was overwritten by menu) diveloop_loop_12: bsf FLAG_TFT_active_gas_divemode; redraw gas and setpoint (eventually needed to restore the "Bailout" text) btfsc request_next_custview ; shall show next custom view? call dive_customview_toggle ; YES - show next custom view (and delete this flag) btfsc request_gaschange ; shall change gas? call gas_switched_common ; YES btfsc request_toggle_GF ; shall toggle GF/aGF? rcall divemodemode_togglegf ; YES IFDEF _cave_mode btfsc request_turn_dive ; shall turn dive? rcall divemodemode_toggleturn ; YES ENDIF btfsc request_set_marker ; shall set a marker? call set_logbook_marker ; YES btfsc trigger_sample_divedata ; shall store new sample of dive data? call store_dive_data ; YES - store profile data btfss divemode ; dive finished? goto ghostwriter_end_dive ; YES - dive finished IFDEF _screendump btfsc screen_dump_avail ; screen dump function enabled? call TFT_dump_screen_check ; YES - check if requested and do it ENDIF bra diveloop_loop ; loop in dive mode ;-------------------------------------------------------------------------------------------------------- TFT_output_1: ; every second - before deco calculations, all mode btfsc FLAG_TFT_clear_apnoe_surface ; shall clear apnoe mode surface data from screen? call TFT_clear_apnoe_surface ; YES - clear apnoe mode surface data from screen btfsc FLAG_TFT_depth_current ; shall show depth? call TFT_show_depth ; YES - display depth btfsc FLAG_TFT_depth_maximum ; shall show max depth? call TFT_show_max_depth ; YES - display max depth btfsc FLAG_TFT_active_gas_divemode ; shall show active gas and dive mode? call TFT_show_active_gas_divemode ; YES - display gas, setpoint and mode btfsc FLAG_TFT_apnoe_surface_time ; shall show apnoe mode surface time? call TFT_show_apnoe_surface ; YES - show apnoe mode surface time btfsc FLAG_TFT_depth_maximum_apnoe ; shall show max. depth of last dive? call TFT_show_apnoe_max_depth ; YES - show max. depth of last dive btfsc FLAG_TFT_apnoe_divetime ; shall show apnoe dive time? call TFT_show_apnoe_times ; YES - show apnoe dive time? clrf TFT_output_flags_1 ; mark all TFT updates done return ; done TFT_output_2: ; every second - before deco calculations, deco modes only btfsc FLAG_TFT_divemode_mask ; shall re-draw mask? call TFT_show_divemode_mask ; YES - re-draw mask btfsc FLAG_TFT_divetime ; shall show dive time? call TFT_show_divetime ; YES - show dive time btfsc FLAG_TFT_safety_stop_show ; shall show safety stop? call TFT_safety_stop_show ; YES - show safety stop btfsc FLAG_TFT_safety_stop_clear ; shall clear safety stop? call TFT_safety_stop_clear ; YES - clear safety stop btfsc FLAG_TFT_temperature ; shall show temperature? call TFT_show_temp_divemode ; YES - display temperature (or resettable dive time) clrf TFT_output_flags_2 ; mark all TFT updates done goto dive_customview_second ; do every-second tasks for the custom view area (in sync with the dive time) and return TFT_output_3: ; every second - after deco calculations, deco modes only btfsc FLAG_TFT_clear_deco_data ; shall clear deco data (NDL or stop & TTS)? call TFT_clear_deco_data ; YES - clear deco data (NDL or stop & TTS) btfsc FLAG_TFT_display_ndl_mask ; shall show NDL mask? call TFT_show_ndl_mask ; YES - show NDL mask btfsc FLAG_TFT_display_ndl ; shall show NDL data? call TFT_show_ndl ; YES - show NDL data btfsc FLAG_TFT_display_deco_mask ; shall show deco mask? call TFT_show_deco_mask ; YES - show deco mask btfsc FLAG_TFT_display_deco ; shall show deco stop? call TFT_show_deco ; YES - show deco stop btfsc FLAG_TFT_display_tts ; shall show deco TTS? call TFT_show_tts ; YES - show deco TTS clrf TFT_output_flags_3 ; mark all TFT updates done return ; done TFT_output_4: ; every second - after deco calculations, all modes btfsc FLAG_TFT_customview_mask ; shall redraw the custom view mask? call dive_customview_mask ; YES - redraw custom view mask btfsc FLAG_TFT_velocity_show ; shall show vertical velocity? call TFT_velocity_show ; YES - show vertical velocity? btfsc FLAG_TFT_velocity_clear ; shall clear vertical velocity? call TFT_velocity_clear ; YES - clear vertical velocity? btfsc FLAG_TFT_sign_show ; shall show the advice / attention / warning sign? call TFT_divemode_sign_show ; YES - show sign btfsc FLAG_TFT_sign_clear ; shall clear the advice / attention / warning sign? call TFT_divemode_sign_clear ; YES - clear sign btfsc FLAG_TFT_message_clear_both ; shall clear all messages? call TFT_clear_message_window ; YES - clear complete message area btfsc FLAG_TFT_message_clear_2nd ; shall clear 2nd row of message area? call TFT_clear_message_window_row2 ; YES - clear 2nd row of message area clrf TFT_output_flags_4 ; mark all TFT updates done return ; done ;-------------------------------------------------------------------------------------------------------- divemode_apnoe_tasks: ; 1 sec. apnoe tasks bsf FLAG_TFT_apnoe_divetime ; show apnoe dive times (current/last dive and total) btfsc apnoe_at_surface ; at the surface? bra divemode_apnoe_tasks_surf ; YES - at the surface ;bra divemode_apnoe_tasks_dive ; NO - in dive phase divemode_apnoe_tasks_dive: ; apnoe mode, submerged btfss apnoe_new_dive ; new dive begun? return ; NO - done bcf apnoe_new_dive ; YES - clear flag bsf FLAG_TFT_clear_apnoe_surface ; - clear apnoe mode surface data from screen return ; - done divemode_apnoe_tasks_surf: ; apnoe mode, at the surface bsf FLAG_TFT_apnoe_surface_time ; show apnoe mode surface time ; TODO: these outputs would need to be done only once after surfacing... bsf FLAG_TFT_depth_maximum_apnoe ; show max. depth of last dive bsf FLAG_TFT_depth_maximum ; show max. depth of all dives ;bra apnoe_calc_maxdepth ; calculate overall max. depth and return global apnoe_calc_maxdepth apnoe_calc_maxdepth: MOVII apnoe_max_pressure, sub_a ; get max depth from all dives to far MOVII pressure_rel_max_cached,sub_b ; get max depth of last dive call cmpU16 ; sub_a - sub_b = apnoe_max_pressure - pressure_rel_max_cached btfss neg_flag ; last dive deeper than all the others before? return ; NO - done MOVII pressure_rel_max_cached,apnoe_max_pressure ; YES - store new overall max depth return ; - done ; -------------------------------------------------------------------------------------- calc_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 ; 'request_gaschange' and will also leave the deco engine status in state as if having done ; the alternative plan last. ; get working copies of char_O_main_status and char_O_deco_status movff char_O_main_status,hi ; get char_O_main_status into hi movff char_O_deco_status,lo ; get char_O_deco_status into lo ; check state of deco calculations btfsc lo,DECO_COMPLETED_NORM ; finished calculations for normal plan? bra calc_deco_engine_alt ; YES - do an alternative plan next (or a normal one with more features enabled) btfsc lo,DECO_COMPLETED_ALT ; finished calculations for alternative plan? bra calc_deco_engine_norm ; YES - do a normal plan next bra calc_deco_engine_cont ; NO to both - continue calculations / do first invocation in INIT mode calc_deco_engine_norm: ; Last cycle did an alternative plan, or the deco engine has been restarted because of a gas change etc. ; --> Reconfigure to normal plan for next computation cycle. bcf lo,DECO_COMPLETED_ALT ; clear flag indicating last plan was an alternative one bsf lo,DECO_START_NORM ; set flag to calculate a normal deco plan next bcf lo,DECO_ASCENT_FLAG ; clear flag for delayed ascent calculation bcf lo,DECO_BAILOUT_FLAG ; clear flag for bailout mode bcf hi,DECO_VOLUME_FLAG ; clear flag for gas needs calculation IFDEF _cave_mode bcf hi,DECO_CAVE_MODE ; clear flag for cave mode ENDIF IFDEF _ccr_pscr btfsc FLAG_ccr_mode ; in CCR mode? bra calc_deco_engine_norm_loop ; YES - reload diluents and reconfigure CCR mode if not in bailout btfsc FLAG_pscr_mode ; in pSCR mode? bra calc_deco_engine_norm_loop ; YES - reload diluents and reconfigure pSCR mode if not in bailout ;bra calc_deco_engine_norm_OC ; neither in CCR nor pSCR mode, so reload OC gases and reconfigure OC mode ; (first cycle omits gas needs calculation for faster first deco results) ENDIF calc_deco_engine_norm_OC: movff active_gas,WREG ; get current OC gas call deco_setup_oc_gases_pre ; set up deco calculations in OC mode with OC gases bra calc_deco_engine_start ; start deco engine IFDEF _ccr_pscr calc_deco_engine_norm_loop: ; switch to loop calculation if not in a real bailout situation btfsc bailout_mode ; check if a real bailout situation is present bra calc_deco_engine_norm_OC ; YES - revert to OC mode ; NO - switch to loop calculation: movff active_dil,WREG ; - get current diluent call deco_setup_cc_diluents_pre ; - set up deco calculations in CCR/pSCR mode with diluents bra calc_deco_engine_start ; - start deco engine ENDIF calc_deco_engine_alt: ; A normal plan was computed in the last cycle. For the next calculation cycle the mode may be switched ; to alternative plan, or stay in normal plan but with certain features enabled... bcf lo,DECO_ASCENT_FLAG ; clear flag for delayed ascent calculation bcf lo,DECO_BAILOUT_FLAG ; clear flag for bailout mode bcf hi,DECO_VOLUME_FLAG ; clear flag for gas needs calculation IFDEF _cave_mode bcf hi,DECO_CAVE_MODE ; clear flag for cave mode ENDIF btfsc bailout_mode ; check if a real bailout situation is present bra calc_deco_engine_alt_1 ; YES - stay in normal plan mode and preclude delayed ascent calculation TSTOSS char_I_extra_time ; NO - check if a delayed ascent is enabled bra calc_deco_engine_alt_1 ; NO - stay in normal plan mode and preclude delayed ascent calculation bcf lo,DECO_COMPLETED_NORM ; YES - clear flag indicating last plan was a normal one bsf lo,DECO_START_ALT ; - set flag to calculate an alternative deco plan next bsf lo,DECO_ASCENT_FLAG ; - set flag for delayed ascent calc_deco_engine_alt_1: TSTOSS opt_calc_asc_gasvolume ; check if gas volume calculation is enabled bra calc_deco_engine_start ; NO - no volume calculation, no simulated bailout plan in this case bsf hi,DECO_VOLUME_FLAG ; YES - set gas needs calculation flag btfsc bailout_mode ; check if a real bailout situation is present bra calc_deco_engine_start ; YES - normal plan already does bailout (OC) calculation "for real" IFDEF _cave_mode bsf hi,DECO_CAVE_MODE ; activate cave mode by default btfss cave_mode ; cave mode switched on? bcf hi,DECO_CAVE_MODE ; NO - deactivate p2deco cave mode again btfsc dive_turned ; dive turned? bcf hi,DECO_CAVE_MODE ; YES - deactivate p2deco cave mode again btfsc FLAG_backtrack_full ; backtracking storage full? bcf hi,DECO_CAVE_MODE ; YES - deactivate p2deco cave mode again ENDIF btfss lo,DECO_MODE_LOOP_FLAG ; NO - has a loop mode calculation been done during the normal plan? bra calc_deco_engine_start ; NO - when not in loop mode, no simulated bailout to be done decf best_gas_number,W ; YES - get best gas number -1 into WREG. If not available, WREG will be 255 now. If not computed yet, WREG will be 254 now. btfsc WREG,7 ; - WREG < 128 (a bailout gas is available)? bra calc_deco_engine_alt_2 ; NO - no simulated bailout possible because no bailout gas available to switch to bcf lo,DECO_COMPLETED_NORM ; YES - clear flag indicating last plan was a normal one bsf lo,DECO_START_ALT ; - set flag to calculate an alternative deco plan next bsf lo,DECO_BAILOUT_FLAG ; - set flag for bailout mode (enables gas switches before 1st stop) movf best_gas_number,W ; - put number of best gas into WREG call deco_setup_oc_gases_pre ; - set up deco calculations in OC mode with OC gases bra calc_deco_engine_start ; - start in alternative plan mode calc_deco_engine_alt_2: bcf lo,DECO_START_ALT ; clear flag to calculate an alternative deco plan next bsf lo,DECO_START_NORM ; set flag to calculate a normal deco plan next bcf lo,DECO_ASCENT_FLAG ; clear flag for delayed ascent calculation bcf hi,DECO_VOLUME_FLAG ; clear flag for gas needs calculation IFDEF _cave_mode bcf hi,DECO_CAVE_MODE ; clear flag for cave mode ENDIF call inval_alternative_plan_data ; invalidate all alternative (bailout) plan data because they are not applicable any more calc_deco_engine_start: movff hi,char_O_main_status ; write-back char_O_main_status to deco engine interface movff lo,char_O_deco_status ; write-back char_O_deco_status to deco engine interface calc_deco_engine_cont: ; +++++++++++++++++++++++++++++++++++++ call deco_calc_hauptroutine ; invoke the deco engine (C-code) banksel common ; back to bank common ; +++++++++++++++++++++++++++++++++++++ call TFT_debug_output ; debug output of scheduling performance data ; check if new calculation results for normal plan mode are available movff char_O_deco_status,WREG ; get deco status of deco engine btfsc WREG,DECO_COMPLETED_NORM ; new calculation results for normal plan available? bsf new_deco_data_avail ; YES - set flag for new NDL or deco data available return ; done show_new_deco_data: bcf new_deco_data_avail ; reset flag for new NDL or deco data available movff char_O_deco_info,WREG ; get the deco info vector btfsc WREG,deco_stops ; deco stops found? bra show_new_deco_data_deco ; YES - in deco ;bra show_new_deco_data_ndl ; NO - within NDL show_new_deco_data_ndl: ; within NDL btfsc decostop_active ; been in deco mode before? bsf FLAG_TFT_clear_deco_data ; YES - clear old deco data btfsc decostop_active ; been in deco mode before? bsf FLAG_TFT_display_ndl_mask ; YES - display NDL data mask bcf decostop_active ; clear flag for been in deco mode before bsf FLAG_TFT_display_ndl ; display NDL time return show_new_deco_data_deco: ; in deco btfss decostop_active ; been in deco mode before? bsf FLAG_TFT_clear_deco_data ; NO - clear old deco data btfss decostop_active ; been in deco mode before? bsf FLAG_TFT_display_deco_mask ; NO - display deco data mask bsf decostop_active ; set flag for being in deco mode bsf FLAG_TFT_display_tts ; display TTS time (display or stop data is managed somewhere else) return ;============================================================================= IFDEF _external_sensor global calc_deko_divemode_sensor calc_deko_divemode_sensor: ; sensor acquisition code btfss s8_digital_avail ; do we have a digital S8 interface? bra calc_deko_divemode_sensor_analog ; NO - check if we have an analog interface btfss trigger_S8_data_update ; YES - check if a new data frame was received bra calc_deko_divemode_sensor_common ; NO - use old values bcf trigger_S8_data_update ; YES - clear update flag call compute_mvolts_for_all_sensors ; - compute mV values from digital data bra calc_deko_divemode_sensor_common 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 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) btfss sensor1_active ; YES - sensor1_ppO2, sensor2_ppO2 and sensor3_ppO2 are already filled in ISR bcf use_O2_sensor1 ; check HUD status data and eventually clear use_O2_sensorX btfss sensor2_active bcf use_O2_sensor2 btfss sensor3_active bcf use_O2_sensor3 bra calc_deko_divemode_sensor_A ; continue with calculating sensor average calc_deko_divemode_sensor_common: ; Check 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 sensor 1 btfss sensor1_calibrated_ok ; check if sensor is usable at all bra check_sensor_1_fail ; NO - handle it as failed ; check min threshold SMOVII sensor1_mv,sub_a ; load sensor mV value rcall check_min_threshold 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_threshold rcall check_max_threshold 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 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 - HUD status ok? bra check_sensor_1_fail ; NO - HUD reports a fail check_sensor_1_ok: ; sensor1_ppO2 = sensor1_mv:2 * opt_x_s1:2 / 1000 SMOVII sensor1_mv,xA MOVII opt_x_s1, xB rcall compute_ppo2_helper movff xC+0,sensor1_ppO2 ; result in 0.01 bar bra check_sensor_2 ; continue with next sensor check_sensor_1_fail: clrf WREG movff WREG,sensor1_ppO2 ; 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 sensors custom view on further conditions met check_sensor_1_fail_1: bcf use_O2_sensor1 ; revoke sensor from usage 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 ; check min threshold SMOVII sensor2_mv,sub_a ; load sensor mV value rcall check_min_threshold 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_threshold rcall check_max_threshold 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 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 - HUD status ok? bra check_sensor_2_fail ; NO - HUD reports a fail check_sensor_2_ok: ; sensor2_ppO2 = sensor2_mv:2 * opt_x_s2:2 / 1000 SMOVII sensor2_mv,xA MOVII opt_x_s2, xB rcall compute_ppo2_helper movff xC+0,sensor2_ppO2 ; result in 0.01 bar bra check_sensor_3 ; continue with next sensor check_sensor_2_fail: clrf WREG movff WREG,sensor2_ppO2 ; 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 sensors custom view on further conditions met check_sensor_2_fail_1: bcf use_O2_sensor2 ; revoke sensor from usage 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 ; check min threshold SMOVII sensor3_mv,sub_a ; load sensor mV value rcall check_min_threshold 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 threshold rcall check_max_threshold 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 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 - HUD status ok? bra check_sensor_3_fail ; NO - HUD reports a fail check_sensor_3_ok: ; sensor3_ppO2 = sensor3_mv:2 * opt_x_s1:2 / 1000 SMOVII sensor3_mv,xA MOVII opt_x_s3, xB rcall compute_ppo2_helper movff xC+0,sensor3_ppO2 ; result in 0.01 bar bra calc_deko_divemode_sensor_A ; continue with calculating sensor average check_sensor_3_fail: clrf WREG movff WREG,sensor3_ppO2 ; 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 sensors custom view on further conditions met check_sensor_3_fail_1: bcf use_O2_sensor3 ; revoke sensor from usage calc_deko_divemode_sensor_A: ; calculate sensor average btfss divemode ; in dive mode? return ; NO - done here if not in dive mode ; 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) CLRI xA CLRI xB divemode_setup_sensor_1_value: btfss use_O2_sensor1 ; sensor 1 active? bra divemode_setup_sensor_2_value ; NO movff sensor1_ppO2,WREG addwf xA+0,F movlw .0 addwfc xA+1,F ; add into xA:2 incf xB+0,F ; add a sensor divemode_setup_sensor_2_value: btfss use_O2_sensor2 ; sensor 2 active? bra divemode_setup_sensor_3_value ; NO movff sensor2_ppO2,WREG addwf xA+0,F movlw .0 addwfc xA+1,F ; add into xA:2 incf xB+0,F ; add a sensor divemode_setup_sensor_3_value: btfss use_O2_sensor3 ; sensor 3 active? bra divemode_setup_sensor_mean ; NO movff sensor3_ppO2,WREG addwf xA+0,F movlw .0 addwfc xA+1,F ; 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_mean: clrf xC+0 ; set zero as default result tstfsz xB+0 ; pending div/0 ? call div16x16 ; NO - execute xC = xA / xB = summed ppO2 / number of sensors movff xC+0,sensor_setpoint ; copy result (or its default) ; 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 ; pre-load 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 bailout_mode ; check if we are in bailout bra calc_deko_divemode_sensor_V ; YES - no sensor data transfer to char_I_const_ppO2 in this case movff opt_ccr_mode,WREG ; NO - get mode (0: Fixed SP, 1: Sensor, 2: Auto SP) sublw .1 ; - in sensor mode? bnz calc_deko_divemode_sensor_V ; NO - not in sensor mode - no transfer of sensor data to char_I_const_ppO2 tstfsz xB+0 ; YES - check if we have found at least one usable sensor bra divemode_setup_sensor_mean1 ; YES - we have at least one usable sensor bsf sp_fallback ; NO - we have NO usable sensors -> initiate fallback btfss FLAG_ccr_mode ; - check if we are in CCR mode bra calc_deko_divemode_sensor_V ; NO - continue with voting logic flags movff opt_setpoint_cbar+0,char_I_const_ppO2 ; YES - select fixed setpoint no. 1 for fallback bra calc_deko_divemode_sensor_V ; - continue with voting logic flags ; we have at least one usable sensor with a ppO2 value > 0 divemode_setup_sensor_mean1: bcf sp_fallback ; clear fallback condition movff sensor_setpoint,char_I_const_ppO2 ; transfer average sensor value to p2_deco.c code ; vote sensors calc_deko_divemode_sensor_V: bsf voting_logic_sensor1 movff sensor1_ppO2,lo rcall check_sensor_voting_helper tstfsz WREG ; sensor within range (WREG = 0)? bcf voting_logic_sensor1 ; NO - vote out this sensor bsf voting_logic_sensor2 movff sensor2_ppO2,lo rcall check_sensor_voting_helper tstfsz WREG ; sensor within range (WREG = 0)? bcf voting_logic_sensor2 ; NO - vote out this sensor bsf voting_logic_sensor3 movff sensor3_ppO2,lo rcall check_sensor_voting_helper tstfsz WREG ; sensor within range (WREG = 0)? bcf voting_logic_sensor3 ; NO - vote out 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_0 ; YES - continue with further checks btfsc FLAG_pscr_mode ; check if we are in pSCR mode bra check_warn_sensor_0 ; YES - continue with further checks bra check_warn_sensor_done ; not in CCR and not in pSCR, so no warning check_warn_sensor_0: ; we are in CCR or pSCR mode btfsc bailout_mode ; check if we are in bailout bra check_warn_sensor_done ; YES - no warning in this case movff opt_ccr_mode,WREG ; get mode (0: Fixed SP, 1: Sensor, 2: Auto SP) sublw .1 ; in sensor mode? bnz check_warn_sensor_done ; NO - not in sensor mode - no warning in this case ; check sensor 1 check_warn_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 o2_sensors_agree ; NO - issue a warning return ; check sensor 2 check_warn_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 o2_sensors_agree ; NO - issue a warning return ; check sensor 3 check_warn_sensor_3: 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 o2_sensors_agree ; NO - issue a warning return ; no need for a warning check_warn_sensor_done: check_warn_sensor_agree: bsf o2_sensors_agree return check_min_threshold: MOVLI min_mv,sub_b ; load minimum mV value goto sub16 ; sub_c = sensor_mv - min_mv (and return) check_max_threshold: MOVLI max_mv,sub_b ; load maximum mV value goto sub16 ; sub_c = sensor_mv - max_mv (and return) compute_ppo2_helper: call mult16x16 ; xC:4 = xA:2 * xB:2 MOVLI .1000,xB call div32x16 ; xC:4 = xC:4 / xB:2 with xA as remainder tstfsz xC+1 ; is the ppO2 higher than 2.55 bar? setf xC+0 ; YES - set result to 255 aka 2.55 bar return check_sensor_custview_helper: btfss divemode ; check if we are in dive mode return ; NO - not in dive mode, return movff opt_ccr_mode,WREG ; YES - =0: Fixed SP, =1: Sensor, =2: Auto SP decfsz WREG,W ; - opt_ccr_mode = 1 (sensors)? return ; NO - not using the sensors in the moment show_sensors_custview: movlw index_ppo2_sensors-1 ; YES - custom view number one below ppO2 sensors movwf active_customview ; - set custom view number bsf request_next_custview ; - initiate toggle to desired custom view -> ppO2 sensors return check_sensor_voting_helper: movf lo,W cpfsgt sensor_setpoint bra check_sensor_voting_helper2 ; lo < sensor_setpoint ; lo > sensor_setpoint movf lo,W subwf sensor_setpoint,W movwf lo check_sensor_voting_helper1: movlw sensor_voting_logic_threshold ; threshold in 0.01 bar cpfsgt lo retlw .0 ; within range retlw .1 ; out of range check_sensor_voting_helper2: ; lo < sensor_setpoint movf sensor_setpoint,W subwf lo,F bra check_sensor_voting_helper1 ENDIF ; _external_sensor ;============================================================================= divemodemode_togglegf: ; toggle aGF/GF bcf request_toggle_GF ; clear request flag btg use_aGF ; toggle normal / alternative GF factor selection btfsc use_aGF ; alternative GF factors activated? bra divemodemode_togglegf_1 ; YES - branch to using aGF movff opt_GF_low, char_I_GF_Low_percentage ; NO - use normal GF factor low movff opt_GF_high,char_I_GF_High_percentage ; - use normal GF factor high bra divemodemode_togglegf_2 ; - continue with common part divemodemode_togglegf_1: movff opt_aGF_low, char_I_GF_Low_percentage ; YES - use alternative GF factor low movff opt_aGF_high,char_I_GF_High_percentage ; - use alternative GF factor high divemodemode_togglegf_2: call TFT_gf_factors_mask ; update custom view mask to show which one is in use ; the custom view itself has been called from divemenu_tree before goto restart_deco_engine ; ...and return ;============================================================================= IFDEF _cave_mode divemodemode_toggleturn: bcf request_turn_dive ; clear request flag btg dive_turned ; toggle dive turned state btfsc FLAG_backtrack_full ; backtracking storage full? bsf dive_turned ; YES - allow only activating turned state goto set_logbook_marker ; set a logbook marker (and return) ENDIF ;============================================================================= calc_velocity: ; called every two seconds btfsc velocity_active_num ; was velocity shown in last cycle? bra calc_velocity_1 ; YES - always update if shown before btfss count_divetime ; NO - is the dive time counted, i.e. deeper than dive threshold? return ; NO - display velocity only if deeper than 1m, ; i.e. not at the surface after the dive calc_velocity_1: ; calculate pressure difference MOVII pressure_abs_cached, sub_a; current pressure MOVII last_pressure_velocity,sub_b; last pressure call subU16 ; do an unsigned subtraction ; decide if ascending or descending bcf neg_flag_velocity ; set to ascending by default btfsc neg_flag ; pressure differential negative? bsf neg_flag_velocity ; YES - descending ; store current pressure as last pressure for next round MOVII pressure_abs_cached,last_pressure_velocity ; calculate velocity in m/min MOVII sub_c,xA ; copy pressure differential to xA MOVLI .39,xB ; put scale coefficient into xB (use 77 when called every second) call mult16x16 ; compute differential pressure in mbar * scale coefficient MOVII xC,divA ; copy result to divA ADDLI .64,divA ; add some round-up TODO: too sensitive with this? movlw .7 ; divide by 2^7 call div16 ; divA = divA / 2^WREG, yields velocity in m/min movlw .99 ; load a 99 cpfslt divA+0 ; velocity < 99 m/min ? movwf divA+0 ; NO - limit to 99 m/min bcf STATUS,C ; clear carry flag movlw velocity_display_threshold ; get threshold for displaying vertical velocity subwf divA+0,W ; subtract threshold from velocity btfss STATUS,C ; above threshold? bsf FLAG_TFT_velocity_clear ; NO - don't show / request to clear btfsc STATUS,C ; above threshold? bsf FLAG_TFT_velocity_show ; YES - request to show return ; done ;============================================================================= check_deco_states: btfsc deco_region ; been within the deco stops region before? return ; YES - been in deco then before too, done movff char_O_deco_info,WREG ; NO - get deco info vector btfss WREG,deco_stops ; do we have a deco obligation right now? return ; NO - done bsf deco_locked ; YES - memorize dive was in deco movff char_O_deco_depth+0,WREG ; - get depth of first stop in meters into WREG addlw deco_region_distance+.1 ; - add deco region start distance + 1 meter for the negative test to work subwf depth_meter,W ; - compute current depth - (first stop depth + deco distance) btfss STATUS,C ; - result negative? bsf deco_region ; YES - memorize to have entered the deco stops region return ; - done ;============================================================================= safety_stop_control: TSTOSS opt_enable_safetystop ; safety stop enabled? (=1: show safety stop) return ; NO - done btfsc FLAG_gauge_mode ; in gauge mode? return ; YES - omit (well, else fix collision of safety stop output with avg depth label) ; setup bcf safety_stop_enabled ; disable safety stop by default ; check for deco btfsc decostop_active ; in deco mode? bra safety_stop_finish ; YES - shut down safety stop ; below "opt_safety_stop_reset"? MOVII pressure_rel_cur_cached,mpr ; get current depth into hi:lo call adjust_depth_with_salinity ; compute salinity setting into hi:lo [mbar] MOVII mpr,sub_a ; move adjusted depth to sub_a movff opt_safety_stop_reset,WREG ; load safety stop reset threshold [cbar] mullw .10 ; convert threshold from [cbar] to [mbar] MOVII PROD,sub_b ; move threshold to sub_b call cmpU16 ; sub_a - sub_b btfss neg_flag ; below threshold depth? bra safety_stop_reset ; YES - arm safety stop and delete it from display if still shown ; above "opt_safety_stop_end"? movff opt_safety_stop_end,WREG ; load safety stop end threshold [cbar] mullw .10 ; convert threshold from [cbar] to [mbar] MOVII PROD,sub_b ; move threshold to sub_b call cmpU16 ; sub_a - sub_b btfsc neg_flag ; above or at threshold depth? bra safety_stop_finish ; YES - finish with safety stop ; above "opt_safety_stop_start"? movff opt_safety_stop_start,WREG ; load safety stop start threshold [cbar] mullw .10 ; convert threshold from [cbar] to [mbar] MOVII PROD,sub_b ; move threshold to sub_b call cmpU16 ; sub_a - sub_b btfss neg_flag ; above or at threshold depth? return ; NO - pause safety stop tstfsz safety_stop_countdown ; YES - safety stop armed? bsf safety_stop_enabled ; YES - enable safety stop return ; NO - done safety_stop_show: btfss safety_stop_enabled ; safety stop enabled? return ; NO - done dcfsnz safety_stop_countdown,F ; YES - decrement remaining stop time, reached zero? bra safety_stop_finish ; YES - finished with safety stop bsf FLAG_TFT_safety_stop_show ; NO - request to show safety stop return ; - done safety_stop_finish: clrf safety_stop_countdown ; disarm safety stop bcf safety_stop_enabled ; disable safety stop bsf FLAG_TFT_safety_stop_clear ; request to clear safety stop return ; done safety_stop_reset: movff opt_safety_stop_length,safety_stop_countdown ; arm safety stop (load timer) incf safety_stop_countdown,F ; +1 because safety_stop_show does decrement first bsf FLAG_TFT_safety_stop_clear ; request to clear safety stop return ; done ;============================================================================= timeout_menuview: btfss trigger_timeout ; timeout occurred? return ; NO - done goto menuview_toggle_reset ; YES - terminate the pre-menu and return timeout_divemode_menu: btfss trigger_timeout ; timeout occurred? return ; NO - done ;bra timeout_divemode_menu2 ; YES - clean up main menu and restore dive data global timeout_divemode_menu2 timeout_divemode_menu2: ; called from divemenu_tree.asm bcf dive_main_menu ; timeout, clear flag for dive mode menu shown call TFT_clear_divemode_menu ; clear menu bsf FLAG_TFT_active_gas_divemode; redraw gas/setpoint/diluent bcf better_gas_blinking ; clear flag to have temperature updated once bcf better_dil_blinking ; clear flag to have temperature updated once bsf FLAG_TFT_temperature ; display temperature (or resettable dive time when in compass view) request_redraw_NDL_deco_data: btfsc FLAG_gauge_mode ; in gauge mode? return ; YES - done btfss decostop_active ; NO - in deco mode? bra timeout_divemode_menu_ndl ; NO - show NDL again ;bra timeout_divemode_menu_deco ; YES - show deco again timeout_divemode_menu_deco: bsf FLAG_TFT_display_deco_mask ; show deco mask bsf FLAG_TFT_display_deco ; show deco stop bsf FLAG_TFT_display_tts ; show TTS time return ; done timeout_divemode_menu_ndl: bsf FLAG_TFT_display_ndl_mask ; show NDL mask bsf FLAG_TFT_display_ndl ; show NDL time return ; done timeout_divemode: btfsc dive_main_menu ; main dive menu shown? rcall timeout_divemode_menu ; YES - check the timeout for it btfsc dive_options_menu ; pre-menu shown? rcall timeout_menuview ; YES - check the timeout for it btfss divetime_longer_1min ; does dive already last for longer than one minute? return ; NO - suspend timeout btfsc FLAG_apnoe_mode ; in apnoe mode? bra timeout_divemode_apnoe ; YES - use apnoe timeout IFNDEF _DEBUG btfsc sensor_override_active ; in simulator mode? bra timeout_divemode_sim ; YES - use simulator timeout ;bra timeout_divemode_dive ; NO - use normal dive timeout ENDIF timeout_divemode_dive: movff opt_diveTimeout,WREG ; get dive timeout in minutes into WREG ;bra timeout_divemode_com_min timeout_divemode_com_min: mullw .60 ; multiply with 60 to convert minutes in WREG to seconds MOVII PRODL,sub_a ; copy resulting seconds to sub_a timeout_divemode_com_sec: MOVII dive_timeout_timer,sub_b ; copy current timeout timer value to sub_b INCI dive_timeout_timer ; increment timeout timer call cmpU16 ; check sub_a - sub_b btfsc neg_flag ; result negative, i.e. timeout? bcf divemode ; YES - terminate dive mode return ; done timeout_divemode_apnoe: movlw apnoe_timeout ; get apnoe timeout in minutes into WREG bra timeout_divemode_com_min ; continue with common part for minutes timeout_divemode_sim: MOVLI simulator_timeout,sub_a ; get simulator timeout in seconds directly into sub_a bra timeout_divemode_com_sec ; continue with common part for seconds update_divemode60: ; tasks every full minute bcf trigger_full_minute ; clear flag call get_battery_voltage ; get battery voltage rcall set_powersafe ; check if battery is low IFDEF _cave_mode movlw .1 ; prepare to add backtrack data for 1 minute btfsc cave_mode ; cave mode switched on? rcall update_backtrack ; YES - store backtracking data ENDIF btfss sensor_override_active ; in simulator mode? return ; NO - done movlw .20 ; YES - quite dive mode simulation after 21 * 256 sec = 89 min : 36 sec cpfsgt total_divetime_secs+1 ; - timeout? return ; NO - done IFDEF _DEBUG return ; YES - but no timeout in debug mode ENDIF bra divemode_option1 ; YES - set depth to 0 m and "return" ;============================================================================= IFDEF _cave_mode update_backtrack: btfsc dive_turned ; dive turned? return ; YES - done btfsc FLAG_backtrack_full ; NO - backtracking storage full? return ; YES - done movwf lo ; NO - store minutes to add in lo lfsr FSR1,char_I_backtrack_depth ; - load FSR1 with base address of backtrack storage movff char_I_backtrack_time,FSR1L ; - adjust FSR1 to last index update_backtrack_loop: movff depth_meter,PREINC1 ; increment index and write current depth to backtrack storage incfsz FSR1L,W ; increment index once more and dump to WREG, did a wrap-around occur (backtrack storage full)? bra update_backtrack_loop_1 ; NO - continue loop bsf FLAG_backtrack_full ; YES - flag backtracking storage is full return ; - done update_backtrack_loop_1: decfsz lo,F ; decrement loop counter, did it became zero? bra update_backtrack_loop ; NO - loop movff FSR1L,char_I_backtrack_time ; YES - store updated index return ; - done ENDIF ;============================================================================= global set_dive_modes set_dive_modes: SMOVII pressure_rel_cur,sub_a ; ISR-safe 2 byte copy of current relative pressure to sub_a bra set_dive_modes_1 check_dive_modes: MOVII pressure_rel_cur_cached,sub_a; copy cached relative pressure to sub_a set_dive_modes_1: btfss high_altitude_mode ; in high altitude mode? bra set_dive_modes_norm ; NO - use normal start-dive threshold btfsc divetime_longer_1min ; YES - dive lasted longer than one minute? bra set_dive_modes_norm ; YES - this is a real dive -> use normal start-dive threshold ;bra set_dive_modes_high ; NO - use hight-altitude start-dive threshold ; high altitude start/end dive thresholds set_dive_modes_high: btfss count_divetime ; dive time counting, i.e. already in the dive? bra set_dive_modes_high_start ; NO - select start threshold ;bra set_dive_modes_high_end ; YES - select end threshold set_dive_modes_high_end: MOVLI dive_threshold_high_alt_end,sub_b bra set_dive_modes_comm set_dive_modes_high_start: MOVLI dive_threshold_high_alt_start,sub_b bra set_dive_modes_comm ; normal altitude start/end dive thresholds set_dive_modes_norm: btfss count_divetime ; dive time counting, i.e. already in the dive? bra set_dive_modes_norm_start ; NO - select start threshold ;bra set_dive_modes_norm_end ; YES - select end threshold set_dive_modes_norm_end: MOVLI dive_threshold_norm_alt_end,sub_b bra set_dive_modes_comm set_dive_modes_norm_start MOVLI dive_threshold_norm_alt_start,sub_b ;bra set_dive_modes_comm set_dive_modes_comm: call cmpU16 ; sub_a - sub_b = pressure_rel_cur - start-dive threshold btfsc neg_flag ; pressure_rel_cur > dive_threshold, i.e. deeper than threshold? bra set_dive_modes_shallow ; NO - shallower than threshold btfsc divetime_longer_1min ; YES - dive lasted longer than one minute? CLRI dive_timeout_timer ; YES - reset timeout counter bsf divemode ; - set dive mode flag bsf count_divetime ; - count dive time return ; - done set_dive_modes_shallow: bcf count_divetime ; NO - stop counting dive time btfss divetime_longer_1min ; - dive lasted longer than one minute? bcf divemode ; NO - quit dive mode as this was no real dive return ; done set_powersafe: movlw battery_warn_level_36+1 ; get threshold for 3.6 Volt battery warning, incremented by 1 btfss battery_is_36v ; actually a 3.6 Volt battery detected? movlw battery_warn_level_15+1 ; NO - replace with 1.5 Volt battery warning, incremented by 1 cpfslt batt_percent ; current battery level > warning threshold ? return ; YES - ok, done movlw d'7' ; NO - set type of alarm = battery low movwf alarm_type ; - copy to alarm register bsf event_occured ; - set event flag movlw .0 ; - coding of brightness level ECO movff WREG,opt_brightness ; - set brightness to ECO return ; - done clear_resettable_average_depth: ; prime the resettable average depth with 0 CLRI pressure_rel_avg_trip bra reset_resettable_average_depth1 reset_resettable_average_depth: ; clear reset-average request bcf request_reset_avg ; prime the resettable average depth with the current relative pressure (depth) MOVII pressure_rel_cur_cached,pressure_rel_avg_trip reset_resettable_average_depth1: ; clear the resettable depth accumulator clrf pressure_rel_accu_trip+0 clrf pressure_rel_accu_trip+1 clrf pressure_rel_accu_trip+2 clrf pressure_rel_accu_trip+3 ; clear the resettable time accumulator CLRI divesecs_avg_trip return calc_average_depth: ; 1. compute pressure_rel_cur_cached x 2, because this routine is called every 2nd second only ; copy current rel pressure to xB MOVII pressure_rel_cur_cached,xB ; multiply rel pressure x 2 (via shift left) bcf STATUS,C rlcf xB+0,F rlcf xB+1,F ; 2a add (pressure_rel_cur_cached x 2) to the resettable depth accumulator ; will work up to 9999 mbar * 60 * 60 * 24 = 863913600 mbar (24h @ 90 m depth) movf xB+0,W addwf pressure_rel_accu_trip+0,F movf xB+1,W addwfc pressure_rel_accu_trip+1,F movlw .0 addwfc pressure_rel_accu_trip+2,F addwfc pressure_rel_accu_trip+3,F ; 2b add (pressure_rel_cur_cached x 2) to the total depth accumulator ; will work up to 9999 mbar * 60 * 60 * 24 = 863913600 mbar (24h @ 90 m depth) movf xB+0,W addwf pressure_rel_accu_total+0,F movf xB+1,W addwfc pressure_rel_accu_total+1,F movlw .0 addwfc pressure_rel_accu_total+2,F addwfc pressure_rel_accu_total+3,F ; 3a compute the resettable average depth ; get the accumulated depth movff pressure_rel_accu_trip+0,xC+0 movff pressure_rel_accu_trip+1,xC+1 movff pressure_rel_accu_trip+2,xC+2 movff pressure_rel_accu_trip+3,xC+3 ; get the accumulated time MOVII divesecs_avg_trip,xB ; divide accumulated depth by accumulated time call div32x16 ; xC:4 / xB:2 = xC+3:xC+2 with xC+1:xC+0 as remainder ; store result MOVII xC,pressure_rel_avg_trip ; resettable average depth btfss count_divetime ; is dive time counted? return ; NO (e.g. too shallow) ; 3b compute the dive total average depth ; get accumulated depth movff pressure_rel_accu_total+0,xC+0 movff pressure_rel_accu_total+1,xC+1 movff pressure_rel_accu_total+2,xC+2 movff pressure_rel_accu_total+3,xC+3 ; get accumulated time MOVII divesecs_avg_total,xB ; divide accumulated depth by accumulated time call div32x16 ; xC:4 = xC:4 / xB:2 with xA as remainder ; store result MOVII xC,pressure_rel_avg_total ; total dive average depth btfsc request_reset_avg ; shall reset the resettable average depth? rcall reset_resettable_average_depth ; YES - reset the resettable average depth TSTOSC opt_2ndDepthDisp ; drawing average depth instead of max depth? bsf FLAG_TFT_depth_maximum ; YES - flag to update display btfsc FLAG_gauge_mode ; in gauge mode? bsf FLAG_TFT_depth_maximum ; YES - flag to update display (needed for alternative layout) return ; done test_switches_divemode: ; checks switches in dive mode, called every second btfsc dive_main_menu ; dive mode menu shown? bra test_switches_divemode_menu ; YES - use menu processor btfsc switch_left ; NO - left button pressed? goto menuview_toggle ; YES - menu or simulator tasks; and return... btfss switch_right ; NO - right button pressed? return ; NO - done bcf switch_right ; YES - clear button event tstfsz active_premenu ; - any pre-menu task selected? bra test_switches_divemode1 ; YES - do option or menu tasks bsf request_next_custview ; NO - request next custom view return ; - done test_switches_divemode_menu: btfsc switch_left ; left button pressed? bra test_switches_divemode_menu2 ; YES - move cursor btfsc switch_right ; NO - right button pressed? bra test_switches_divemode_menu3 ; YES - enter sub-menu or do something btfss update_menu ; NO - shall update the menu? return ; NO - done bcf update_menu ; YES - clear request goto menu_draw_lines_divemode ; - redraw the menu (to update color coding) and return test_switches_divemode_menu1: clrf menu_pos_cur test_switches_divemode_menu2: bcf switch_left incf menu_pos_cur,F incf menu_pos_max,W ; menu_pos_max + 1 -> WREG cpfslt menu_pos_cur ; > menu_pos_max ? bra test_switches_divemode_menu1 ; YES - set to 1 call TFT_show_menu_cursor_divemode ; update the cursor movlw divemode_timeout_mainmenu ; get timeout for main menu call reset_timeout_time ; reset timeout return test_switches_divemode_menu3: ; enter sub-menu or do something bcf switch_right ; decf menu_pos_cur,F ; menu_processor needs 0-5... goto do_line_menu ; Warning! trashes STKPTR and returns to diveloop_menu_exit test_switches_divemode1: movlw divemode_timeout_premenu ; get timeout for pre-menu call reset_timeout_time ; reset timeout movff active_premenu,WREG ; get number of active pre-menu dcfsnz WREG,F bra divemode_option_gaschange ; switch to the the "better gas" / "better diluent" dcfsnz WREG,F bra divemode_option0 ; start/setup dive mode 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 (gauge mode only) dcfsnz WREG,F bra divemode_option6 ; +5 min simulation dcfsnz WREG,F IFDEF _compass bra divemode_option7 ; store heading ELSE return ; should never happen without compass ENDIF dcfsnz WREG,F bra divemode_option8 ; switch layout return gas_switched_common: bcf request_gaschange ; clear request flag IFDEF _ccr_pscr btfss request_back_to_loop ; is a switchback from OC bailout to loop requested? bra gas_switched_common0 ; NO - continue with checking if selected gas is valid bcf request_back_to_loop ; YES - clear flag movff active_dil,menu_pos_cur ; - reload last diluent bra gas_switched_common1 ; - continue with common part ENDIF gas_switched_common0: tstfsz menu_pos_cur ; menu_pos_cur = 0 ? bra gas_switched_common1 ; NO - valid gas return ; YES - something went wrong, invalid gas, abort gas_switched_common1: movf menu_pos_cur,W ; get selected gas into WREG (1-6) IFDEF _ccr_pscr btfsc FLAG_oc_mode ; in OC mode? bra gas_switched_common_OC ; YES btfsc bailout_mode ; in bailout? bra gas_switched_common_OC ; YES gas_switched_common_loop: ; NO to both - must be loop mode then rcall setup_dil_registers ; with WREG = diluent 1-6 rcall deco_setup_cc_diluents ; with WREG = diluent 1-6 bra gas_switched_common3 ENDIF gas_switched_common_OC: rcall setup_gas_registers ; with WREG = Gas 1-6 rcall deco_setup_oc_gases ; with WREG = Gas 1-6 gas_switched_common3: banksel int_O_breathed_ppO2 bcf int_O_breathed_ppO2+1,int_low_flag ; | clear all flags that control color-coding bcf int_O_breathed_ppO2+1,int_high_flag ; | to have the new gas initially displayed in bcf int_O_breathed_ppO2+1,int_attention_flag ; | memo color instead of a warning or attention bcf int_O_breathed_ppO2+1,int_warning_flag ; | color that belonged to the previous gas banksel common 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 global event flag IFDEF _ccr_pscr btfsc bailout_mode ; in bailout mode? bsf event_bailout ; YES - set gas change event due to bailout btfss bailout_mode ; in bailout mode? ENDIF bsf event_gas_change ; NO - set gas change event (normal 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 ; load base address of the gas types clrf lo ; start with gas 0 get_first_gas_to_WREG2: movf lo,W ; set index movf PLUSW1,W ; get type of gas (0=Disabled, 1=First, 2=Travel, 3=Deco) sublw .1 ; is it of type First? bz get_first_gas_to_WREG3 ; YES - found the First gas incf lo,F ; NO - increment index movlw NUM_GAS+1 ; - get highest index+1 cpfseq lo ; - all gases checked? bra get_first_gas_to_WREG2 ; NO - not yet movlw .1 ; YES - default to gas 1 movff WREG,opt_gas_type+0 ; - force it to be of type First return ; - done get_first_gas_to_WREG3: movf lo,W ; copy index of gas found to be the First to WREG incf WREG,W ; turn index into gas number (0-4 -> 1-5) return ; done ;============================================================================= IFDEF _ccr_pscr global get_first_dil_to_WREG get_first_dil_to_WREG: ; gets first dil (1-5) into WREG lfsr FSR1,opt_dil_type ; load base address of the dil types clrf lo ; start with dil 0 get_first_dil_to_WREG2: movf lo,W ; set index movf PLUSW1,W ; get type of Dil (0=Disabled, 1=First, 2=Normal) sublw .1 ; is it of type First? bz get_first_dil_to_WREG3 ; YES - found the First dil incf lo,F ; NO - increment index movlw NUM_GAS+1 ; - get highest index+1 cpfseq lo ; - dils checked? bra get_first_dil_to_WREG2 ; NO - not yet movlw .1 ; YES - default to dil 1 movff WREG,opt_dil_type+0 ; - force it to be of type First return ; - done get_first_dil_to_WREG3: movf lo,W ; copy index of dil found to be the First to WREG incf WREG,W ; turn index into dil number (0-4 -> 1-5) return ; done ENDIF ;============================================================================= global deco_setup_oc_gases deco_setup_oc_gases: ; with currently breathed gas in WREG (1-5 or 6) movff char_O_deco_status,lo ; working copy of char_O_deco_status in bank common deco_setup_oc_gases_pre: ; entry point with lo preloaded movff WREG,char_I_current_gas_num ; set gas to start with when doing the deco calculations ; ; Memory Map: ; --------------------------------------------------------------------------------- ; opt_gas_O2_ratio res NUM_GAS | char_I_deco_O2_ratio res NUM_GAS ; opt_dil_O2_ratio res NUM_GAS | ; opt_gas_He_ratio res NUM_GAS | char_I_deco_He_ratio res NUM_GAS ; opt_dil_He_ratio res NUM_GAS | ; opt_gas_type res NUM_GAS | char_I_deco_gas_type res NUM_GAS ; opt_dil_type res NUM_GAS | ; opt_gas_change res NUM_GAS | char_I_deco_gas_change res NUM_GAS ; opt_dil_change res NUM_GAS | ; lfsr FSR2,char_I_deco_O2_ratio ; load FSR2 with base address of char_I_deco_O2_ratio ; FSR2 will step through all char_I_deco_... vars lfsr FSR1,opt_gas_O2_ratio ; load FSR1 with base address of opt_gas_O2_ratio rcall deco_setup_copy ; copy all OC O2 ratios lfsr FSR1,opt_gas_He_ratio ; load FSR1 with base address of opt_gas_He_ratio rcall deco_setup_copy ; copy all OC He ratios lfsr FSR1,opt_gas_type ; load FSR1 with base address of opt_gas_type rcall deco_setup_copy ; copy all gas types lfsr FSR1,opt_gas_change ; load FSR1 with base address of opt_gas_change rcall deco_setup_copy ; copy all gas change depths ; switch to oc mode 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 ;============================================================================= IFDEF _ccr_pscr global deco_setup_cc_diluents deco_setup_cc_diluents: ; with currently breathed diluent in WREG (1-5 or 6) movff char_O_deco_status,lo ; working copy of char_O_deco_status in bank common deco_setup_cc_diluents_pre: ; entry point with lo preloaded btfsc bailout_mode ; check if in bailout condition | --------------- FOR SAFETY ONLY -------------- bra deco_setup_oc_gases_pre ; YES - revert to setting up OC gases | This branch should never happen to be taken... movff WREG,char_I_current_gas_num ; NO - set diluent to start with when doing the deco calculations ; ; Memory Map: ; --------------------------------------------------------------------------------- ; opt_gas_O2_ratio res NUM_GAS | ; opt_dil_O2_ratio res NUM_GAS | char_I_deco_O2_ratio res NUM_GAS ; opt_gas_He_ratio res NUM_GAS | ; opt_dil_He_ratio res NUM_GAS | char_I_deco_He_ratio res NUM_GAS ; opt_gas_type res NUM_GAS | ; opt_dil_type res NUM_GAS | char_I_deco_gas_type res NUM_GAS ; opt_gas_change res NUM_GAS | ; opt_dil_change res NUM_GAS | char_I_deco_gas_change res NUM_GAS ; lfsr FSR2,char_I_deco_O2_ratio ; load FSR2 with base address of char_I_deco_O2_ratio. ; FSR2 will step through all char_I_deco_... vars. lfsr FSR1,opt_dil_O2_ratio ; load FSR1 with base address of opt_dil_O2_ratio rcall deco_setup_copy ; copy all dil O2 ratios lfsr FSR1,opt_dil_He_ratio ; load FSR1 with base address of opt_dil_He_ratio rcall deco_setup_copy ; copy all dil He ratios lfsr FSR1,opt_dil_type ; load FSR1 with base address of opt_dil_type rcall deco_setup_copy ; copy all dil types lfsr FSR1,opt_dil_change ; load FSR1 with base address of opt_dil_change rcall deco_setup_copy ; copy all dil change depths ; switch to CCR / pSCR mode 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 ENDIF ;============================================================================= deco_setup_copy: movlw NUM_GAS ; load loop counter with number of gases (5) deco_setup_copy_loop: movff POSTINC1,POSTINC2 ; copy from (FSR1) to (FSR2) decfsz WREG ; decrement loop counter and check if it became 0 bra deco_setup_copy_loop ; NO - not yet, loop return ; YES - done 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 IFDEF _helium movff gas6_He_ratio,char_I_He_ratio ; copy gas6 H2 ratio to deco engine ENDIF movlw .3 ; declare gas6 as a deco gas movff WREG,char_I_current_gas_type; copy gas type to deco engine movff depth_meter,char_I_gas6_depth;set current depth as change depth bra setup_gas_registers_com ; continue with common part setup_gas_registers_15: lfsr FSR1,opt_gas_O2_ratio ; load base address of gas data decf active_gas,W ; set index to O2 ratio of current gas (1-5 -> 0-4) movff PLUSW1,char_I_O2_ratio ; copy O2 ratio to deco engine addlw .10 ; advance index from O2 ratio to He ratio IFDEF _helium movff PLUSW1,char_I_He_ratio ; copy He ratio to deco engine ENDIF addlw .10 ; advance index from He ratio to gas type movff PLUSW1,char_I_current_gas_type ; copy gas type (0=Disabled, 1=First, 2=Travel, 3=Deco) setup_gas_registers_com: 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 gas 1-5 or 6 (important!) return ;============================================================================= IFDEF _ccr_pscr global setup_dil_registers setup_dil_registers: ; with currently breathed gas in WREG (1-5 or 6) btfsc bailout_mode ; check if in bailout condition | --------------- FOR SAFETY ONLY -------------- bra setup_gas_registers ; revert to setting up OC gases in bailout condition | This branch should never happen to be taken... movwf active_dil ; set as current diluent movlw .6 cpfseq active_dil ; 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 IFDEF _helium movff gas6_He_ratio,char_I_He_ratio ; copy gas6 H2 ratio to deco engine ENDIF movlw .2 ; declare gas6 as a normal diluent movff WREG,char_I_current_gas_type; copy gas type to deco engine movff depth_meter,char_I_gas6_depth;set current depth as change depth bra setup_dil_registers_com ; continue with common part setup_dil_registers_15: lfsr FSR1,opt_dil_O2_ratio ; load base address of diluent data decf active_dil,W ; set index to O2 ratio of current diluent (1-5 -> 0-4) movff PLUSW1,char_I_O2_ratio ; copy O2 ratio to deco engine addlw .10 ; advance index from O2 ratio to He ratio IFDEF _helium movff PLUSW1,char_I_He_ratio ; copy He ratio to deco engine ENDIF addlw .10 ; advance index from He ratio to diluent type movff PLUSW1,char_I_current_gas_type ; copy diluent type (0=Disabled, 1=First, 2=Normal) setup_dil_registers_com: 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_dil,W ; reload WREG with diluent 1-5 or 6 (important!) return ENDIF ;============================================================================= divemode_option_gaschange: ; switch to the "better gas" / "better diluent" IFDEF _ccr_pscr btfsc FLAG_oc_mode ; in OC mode? bra divemode_option_gaschange_oc; YES btfsc bailout_mode ; in bailout? bra divemode_option_gaschange_oc; YES divemode_option_gaschange_loop: ; in CCR/pSCR mode and not in bailout movff best_dil_number,menu_pos_cur; NO - select best diluent bcf better_dil_available ; - clear flag immediately bra divemode_option_gaschange3 ; - continue with common part ENDIF divemode_option_gaschange_oc: ; in OC or bailout movff best_gas_number,menu_pos_cur; select best gas bcf better_gas_available ; clear flag immediately divemode_option_gaschange3 ; common part bsf request_gaschange ; request a gas/diluent change call menuview_toggle_reset ; terminate the pre-menu return global divemode_option0_return divemode_option0: ; start/setup dive mode menu call TFT_clear_divemode_menu ; clear menu area bcf dive_options_menu ; dive options menu is not shown anymore call do_main_divemenu ; hand over to menu processor divemode_option0_return: ; return point for menu processor call TFT_show_menu_cursor_divemode ; show the cursor clrf active_premenu ; set pre-menu is not shown any more bcf safety_stop_active ; set safety stop is not shown any more bsf dive_main_menu ; set main menu is shown now movlw divemode_timeout_mainmenu ; get timeout for main menu call reset_timeout_time ; reload timeout goto diveloop_menu_exit ; go back to dive loop (menu processor resets STKPTR!) divemode_option1: ; quit simulation mode clrf simulatormode_depth ; set target depth to zero bsf quit_simulatormode ; request ISR to end simulator mode call menuview_toggle_reset ; terminate the pre-menu btfsc FLAG_apnoe_mode ; in apnoe mode? bcf divemode ; YES - force end of dive mode return ; done divemode_option2: ; plus 1 meter movlw ostc_depth_max-1 ; load depth limit into WREG cpfsgt simulatormode_depth ; simulated depth <= limit ? incf simulatormode_depth,F ; YES - increment simulated depth return ; done divemode_option3: ; minus 1 meter tstfsz simulatormode_depth ; simulated depth > 0 ? decf simulatormode_depth,F ; YES - decrement simulated depth return ; done divemode_option4: ; quit apnoe mode (available while at the surface only) btfsc sensor_override_active ; in simulator mode? bra divemode_option1 ; YES - use simulator quit procedure bcf divemode ; NO - force end of dive mode return ; - done divemode_option5: bsf request_reset_avg ; request reset of average depth goto menuview_toggle_reset ; terminate pre-menu and return divemode_option6: ; check for pending +5 request movff char_I_sim_advance_time,WREG; get mailbox content tstfsz WREG ; mailbox clear (=0) ? return ; NO - still having a pending +5' request, refuse new request ; advance tissues pressures and deco obligation by 5 minutes movlw .5 ; + 5 minutes movff WREG,char_I_sim_advance_time; copy to mailbox call restart_deco_engine ; condition deco engine to execute the +5 minutes ; stop dive time incrementing in ISR bcf count_divetime ; add 5 minutes to counted_divetime_mins ADDLI .5,counted_divetime_mins ; add 5 minutes (300 seconds) to total_divetime_secs ADDLI .300,total_divetime_secs ; continue dive time incrementing in ISR bsf count_divetime ; add 5 minutes (300 seconds) to resettable time accumulator ADDLI .300,divesecs_avg_trip ; add 5 minutes (300 seconds) to total time accumulator ADDLI .300,divesecs_avg_total ; calculate 300 x depth in mbar (300 = 5 min * 60 sec/min) MOVII pressure_rel_cur_cached,xB MOVLI .300,xA call mult16x16 ; xC = xA * xB ; add to the resettable depth accumulator movf xC+0,W addwf pressure_rel_accu_trip+0,F movf xC+1,W addwfc pressure_rel_accu_trip+1,F movf xC+2,W addwfc pressure_rel_accu_trip+2,F movf xC+3,W addwfc pressure_rel_accu_trip+3,F ; add to the total depth accumulator movf xC+0,w addwf pressure_rel_accu_total+0,F movf xC+1,w addwfc pressure_rel_accu_total+1,F movf xC+2,w addwfc pressure_rel_accu_total+2,F movf xC+3,w addwfc pressure_rel_accu_total+3,F IFDEF _cave_mode ; update backtracking data movlw .5 ; configure 5 minutes call update_backtrack ; add backtrack data for 5 minutes ENDIF ; goto menuview_toggle_reset ; terminate the pre-menu and return return ; just return, leaving option avail for repeated selection IFDEF _compass divemode_option7: ; store heading for compass view MOVII compass_heading_shown,compass_bearing bsf compass_bearing_set ; set flag to show heading goto menuview_toggle_reset ; terminate the pre-menu and return ENDIF divemode_option8: call menuview_toggle_reset ; terminate the pre-menu call TFT_ClearScreen ; clear the whole screen btg alt_layout_active ; toggle layout bcf depth_warn_att_last ; set warning or attention on the depth not shown bcf depth_inverse_last ; set depth displayed in inverse as not shown bcf sign_shown ; set warning/attention/advice sign not shown bcf velocity_active_num ; set numerical vertical velocity display not shown bcf velocity_active_vsi ; set vertical vertical velocity display not shown bcf safety_stop_active ; set safety stop not shown bsf FLAG_TFT_divemode_mask ; request redraw of dive screen mask bsf FLAG_TFT_divetime ; request redraw of dive time bsf FLAG_TFT_depth_current ; request redraw of current depth bsf FLAG_TFT_depth_maximum ; request redraw of maximum depth bsf FLAG_TFT_active_gas_divemode; request redraw of gas and setpoint bsf FLAG_TFT_customview_mask ; request redraw of custom view mask bsf FLAG_TFT_temperature ; request redraw of temperature goto request_redraw_NDL_deco_data; request redraw of NDL/deco data and return ;============================================================================= ; Find the best gas and diluent for the current depth ; and check if a gas/diluent change is to be advised. ; ; Output: best_gas_number : number of best gas, 0= none avail, 255= not computed ; best_dil_number : number of best dil, 0= none avail, 255= not computed ; better_gas_available : flag indicating if a change is advised ; better_dil_available : flag indicating if a change is advised ; ; ; in CCR and pSCR mode: - checks both, gases and diluents for respective best gas / best diluent ; - if not in bailout, sets better_dil_available on diluents ; - if in bailout, sets better_gas_available on OC gases ; ; in OC mode : - checks only gases for best gas ; - sets better_gas_available on OC gases ; global check_gas_best check_gas_best: btfsc FLAG_gauge_mode ; in gauge mode? return ; YES - done MOVII pressure_abs_10,xA ; copy absolute pressure / 10 into xA:2, will be used by ppO2 min/max checks later ; compute max. allowed deco ppO2 movff char_I_ppO2_max_deco,WREG ; max ppO2 [cbar] for deco phase mullw .100 ; compute max ppO2 * 100, result is in 0.1 mbar ADDLI ppO2_margin_on_max,PROD ; add ppO2 margin on max value to compensate for surface pressures > 1000 hPa MOVII PROD,ppO2_max_deco ; store as deco ppO2 max ; compute max. allowed default ppO2 movff char_O_deco_info,lo ; bank-safe copy of deco info vector btfss lo,deco_mode ; is the ppO2 deco limit enabled? bra check_gas_best_1 ; NO - compute default ppO2 max MOVII ppO2_max_deco,ppO2_max_default ; YES - copy default ppO2 max from deco max. bra check_gas_best_2 ; - continue with common part check_gas_best_1: movff char_I_ppO2_max_work,WREG ; max ppO2 [cbar] for working phase mullw .100 ; compute max ppO2 * 100, result is in 0.1 mbar ADDLI ppO2_margin_on_max,PROD ; add ppO2 margin on max value to compensate for surface pressures > 1000 hPa MOVII PROD,ppO2_max_default ; store as default ppO2 max check_gas_best_2: IFDEF _ccr_pscr ; check dive mode btfsc FLAG_oc_mode ; in OC mode? bra check_gas_best_gas ; YES - skip diluents, check for best gas only check_gas_best_dil: ; set minimum ppO2 required movff char_I_ppO2_min,WREG ; min ppO2 for pure diluent in CCR mode (default) btfsc FLAG_pscr_mode ; in pSCR mode? movff char_I_ppO2_min_loop,WREG ; YES - replace by min ppO2 for pure diluent in pSCR mode mullw .100 ; min ppO2 * 100, result in 0.1 mbar MOVII PROD,ppO2_min ; store in ppO2_min ; preset results to nothing found clrf best_gas_num ; initialize best diluent as 0 = nothing found yet bcf better_dil_available ; =1: a better diluent is available and a gas change is advised in dive mode ; ; current diluent = 'gas6' ? ; movlw .6 ; ; cpfseq active_dil ; using 'gas6' as current diluent? ; bra check_gas_best_dil0 ; NO - continue ; bra check_gas_best_dil3 ; YES - suppress better diluent search in this case ;check_gas_best_dil0: ; check all diluents lfsr FSR1,opt_dil_O2_ratio ; set base address for diluent arrays movff active_dil,lo ; number of currently used diluent setf best_gas_depth ; initialize change depth of best dil found so far to 255 meter ; original code clrf check_gas_num incf check_gas_num,F rcall check_gas_best_common ; check diluent 1 incf check_gas_num,F rcall check_gas_best_common ; check diluent 2 incf check_gas_num,F rcall check_gas_best_common ; check diluent 3 incf check_gas_num,F rcall check_gas_best_common ; check diluent 4 incf check_gas_num,F rcall check_gas_best_common ; check diluent 5 ; alternative code ; movlw .5 ; movwf check_gas_num ;check_gas_best_dil_loop: ; rcall check_gas_best_common ; decfsz check_gas_num ; bra check_gas_best_dil_loop ; ; store result movff best_gas_num,best_dil_number ; store new best diluent found (1-5 or 0 of no usable diluent available) ; check if change advices shall be given in general btfsc bailout_mode ; in bailout? bra check_gas_best_gas ; YES - no better diluent advice when in bailout check_gas_best_dil1: ; check if a change advice shall be given right now movf best_dil_number,W ; load number of best diluent into WREG (1-5) bz check_gas_best_dil3 ; has a best diluent been found at all? NO - nothing to signal for cpfseq active_dil ; is this the currently used diluent? bra check_gas_best_dil2 ; NO bra check_gas_best_dil3 ; YES - no need to signal a better diluent if this diluent is already in use check_gas_best_dil2: btfsc sp_fallback ; in fallback condition? bra check_gas_best_dil3 ; YES - suppress better diluent prompt in this case ; not using the best gas - show better diluent hint whenever a better diluent is available bsf better_dil_available ; signal that a better diluent is available bsf FLAG_TFT_active_gas_divemode ; redraw gas/setpoint/diluent check_gas_best_dil3: btfss better_dil_available ; shall a better diluent be signaled for? bcf better_dil_blinking ; NO - clear blinking flag ; continue with checking for best bailout gas ENDIF ; _ccr_pscr check_gas_best_gas: ; set minimum ppO2 required movff char_I_ppO2_min,WREG ; min ppO2 for OC and bailout mullw .100 ; min ppO2 * 100, result in 0.1 mbar MOVII PROD,ppO2_min ; store in ppO2_min ; preset results to nothing found clrf best_gas_num ; initialize best gas as 0 = nothing found yet bcf better_gas_available ; =1: a better gas is available and a gas change is advised in dive mode ; ; current gas = 'gas6' ? ; movlw .6 ; ; cpfseq active_gas ; using 'gas6' as current gas? ; bra check_gas_best_gas0 ; NO - continue ; bra check_gas_best_gas3 ; YES - suppress better gas search in this case ;check_gas_best_gas0: ; check all gases lfsr FSR1,opt_gas_O2_ratio ; set base address for gas arrays movff active_gas,lo ; number of currently used gas setf best_gas_depth ; initialize change depth of best gas found so far to 255 meter ; original code clrf check_gas_num incf check_gas_num,F rcall check_gas_best_common ; check gas 1 incf check_gas_num,F rcall check_gas_best_common ; check gas 2 incf check_gas_num,F rcall check_gas_best_common ; check gas 3 incf check_gas_num,F rcall check_gas_best_common ; check gas 4 incf check_gas_num,F rcall check_gas_best_common ; check gas 5 ; alternative code ; movlw .5 ; movwf check_gas_num ;check_gas_best_gas_loop: ; rcall check_gas_best_common ; decfsz check_gas_num ; bra check_gas_best_gas_loop ; ; store result movff best_gas_num,best_gas_number ; store new best gas found (1-5 or 0 of no usable gas available) ; check if change advices shall be given in general btfsc FLAG_oc_mode ; in OC mode? bra check_gas_best_gas1 ; YES btfsc bailout_mode ; in bailout? bra check_gas_best_gas1 ; YES return ; NO - no better (OC) gas advice when not in OC or bailout mode check_gas_best_gas1: ; check if we are already on the best gas ; check if a change advice shall be given right now movf best_gas_number,W ; load number of best gas into WREG (1-5) bz check_gas_best_gas3 ; has a best gas been found at all? NO - nothing to signal for cpfseq active_gas ; is this the currently used gas? bra check_gas_best_gas2 ; NO bra check_gas_best_gas3 ; YES - no need to signal a better gas if this gas is already in use check_gas_best_gas2: ; not using the best gas - show better gas hint whenever a better gas is available bsf better_gas_available ; YES - signal that a better gas is available bsf FLAG_TFT_active_gas_divemode ; YES - redraw gas/setpoint/diluent check_gas_best_gas3: btfss better_gas_available ; shall a better gas be signaled for? bcf better_gas_blinking ; NO - clear blinking flag return check_gas_best_common: ; with gas to be checked in check_gas_num (1-5) ; ; and current gas in lo (1-5) ; ; Memory Map: ; --------------------------------------------------------------------------------------- ; opt_gas_O2_ratio res 5 ; base address for gases ; opt_dil_O2_ratio res 5 ; base address for diluents ; opt_gas_He_ratio res 5 ; (not needed here) ; opt_dil_He_ratio res 5 ; (not needed here) ; opt_gas_type res 5 ; has offset of 20 bytes from base address for gases ; opt_dil_type res 5 ; has offset of 20 bytes from base address for diluents ; opt_gas_change res 5 ; has offset of 10 bytes from opt_gas_type ; opt_dil_change res 5 ; has offset of 10 bytes from opt_dil_type ; get gas data decf check_gas_num,W ; (1-5) -> (0-4) into WREG to be used as index movff PLUSW1,check_gas_O2_ratio ; copy O2 ratio (%) of current gas/dil to check_gas_O2_ratio addlw .20 ; add offset of 20 bytes to index type in opt_gas_type/opt_dil_type movff PLUSW1,check_gas_type ; copy type of current gas/dil to check_gas_type (0=disabled, 1=first, 2=travel/normal, 3=deco/-) addlw .10 ; add offset of 10 bytes to index change depth in opt_gas_change/opt_dil_change movff PLUSW1,check_gas_depth ; copy change depth of current gas/dil to check_gas_depth MOVII ppO2_max_default,sub_b ; select default ppO2 max for first / travel / normal gas ; check if the gas is the current gas movf check_gas_num,W ; get the number of the gas to be checked (1-5) cpfseq lo ; is this the currently used gas? bra check_gas_best_common0 ; NO - do the disabled & deco gas checks bra check_gas_best_common3 ; YES - a gas in use overrides disabled and deco status check_gas_best_common0: ; check if gas is available (i.e. not disabled) tstfsz check_gas_type ; type = disabled (0) ? bra check_gas_best_common1 ; NO - continue checks return ; YES - skip disabled gases check_gas_best_common1: ; skip deco gases (type=3) if there are no stops, but include them when in bailout mode movlw .3 ; coding for deco gas cpfseq check_gas_type ; type = deco (3) ? bra check_gas_best_common3 ; NO - first or travel/normal then, ok to use btfsc bailout_mode ; YES - in bailout? bra check_gas_best_common2 ; YES - ok to use (using deco gases is always allowed when in bailout) TSTOSS opt_extended_stops ; NO - extended stops enables? bra check_gas_best_common1b ; NO ;bra check_gas_best_common1a ; YES check_gas_best_common1a: movff char_O_deco_info,WREG ; get deco info vector btfss WREG,deco_mode ; are we in deco mode? return ; NO - skip deco gas while not in deco mode bra check_gas_best_common2 ; YES - deco gases allowed check_gas_best_common1b: btfss deco_region ; are we in the deco region? return ; NO - skip deco gas while not in the deco region ;bra check_gas_best_common2 ; YES - deco gases allowed check_gas_best_common2: MOVII ppO2_max_deco,sub_b ; replace by ppO2 max for a deco gas check_gas_best_common3: ; check if gas is usable, i.e. its change depth is below or equal to the current depth movf depth_meter,W ; load current depth (in m) into WREG cpfslt check_gas_depth ; change depth of checked gas < (shallower than) current depth? bra check_gas_best_common4 ; NO - gas is usable return ; YES - gas is not usable check_gas_best_common4: ; check if this gas is the first best gas candidate movf best_gas_num,W ; get best gas found so far (1-5) or 0 if none found yet tstfsz WREG ; has a best gas candidate been found yet? bra check_gas_best_common5 ; YES - check if the new one is better than the one we have so far bra check_gas_best_common6 ; NO - no need to do the above mentioned check check_gas_best_common5: ; check if the change depth of the checked gas is <= (shallower or equal) the change depth of the best gas found so far movf best_gas_depth,W ; load change depth of best gas so far into WREG cpfsgt check_gas_depth ; change depth of checked gas > (deeper than) change depth of best gas so far? bra check_gas_best_common6 ; NO - this gas is better or equal, continue return ; YES - this gas is not better than the best already found check_gas_best_common6: ; check if the gas fits into the ppO2 limits movff check_gas_O2_ratio,xB+0 ; xB = O2 ratio, xA is still loaded with (absolute pressure / 10) clrf xB+1 call mult16x16 ; xC = O2 ratio * (absolute pressure / 10), result in 0.1 mbar ; check for very high ppO2 tstfsz xC+2 ; O2_ratio * absolute pressure / 10 > 65536, i.e. ppO2 > 6.55 bar ? return ; YES - gas is not usable btfsc xC+1,7 ; ppO2 > 3.30 bar ? return ; YES - gas is not usable MOVII xC,sub_a ; NO - gas may be usable ; check for high ppO2 call cmpU16 ; sub_a - sub_b btfss neg_flag ; within limit? return ; NO - too high, gas is not usable ; check for low ppO2 MOVII ppO2_min,sub_b ; copy minimum ppO2 to sub_b call cmpU16 ; sub_a - sub_b btfsc neg_flag ; within limit? return ; NO - too low, gas is not usable ; we have a (new) best gas movff check_gas_num, best_gas_num ; set checked gas (1-5) as best gas movff check_gas_depth,best_gas_depth ; memorize its change depth return ;============================================================================= ; Check for Auto-SP ; IFDEF _ccr_pscr 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: ; Check SP2 btfsc FLAG_SP2_used ; SP 2 used so far? bra check_dive_autosp3 ; YES - continue with SP 3 movff opt_setpoint_change+1,lo ; NO - get depth in m tstfsz lo ; - SP change depth = 0 ? bra check_dive_autosp2a ; NO - continue bra check_dive_autosp3 ; YES - continue with SP 3 check_dive_autosp2a: decf lo,W ; SP change depth -1 -> WREG cpfsgt depth_meter ; current depth > change depth - 1 ? bra check_dive_autosp3 ; NO - continue with SP 3 ; auto switch to SP2 movff opt_setpoint_cbar+1,char_I_const_ppO2 ; YES - use SP rcall xmit_sp_set_flag ; - send SP to external devices bsf FLAG_SP2_used ; - set SP 2 used flag check_dive_autosp3: ; Check SP3 btfsc FLAG_SP3_used ; SP 3 used so far? bra check_dive_autosp4 ; YES - continue with SP 4 movff opt_setpoint_change+2,lo ; NO - get depth in m tstfsz lo ; - SP change depth = 0 ? bra check_dive_autosp3a ; NO - continue bra check_dive_autosp4 ; YES - continue with SP 4 check_dive_autosp3a: decf lo,W ; SP change depth -1 -> WREG cpfsgt depth_meter ; current depth > change depth - 1 ? bra check_dive_autosp4 ; NO - continue with SP 4 ; auto switch to SP3 movff opt_setpoint_cbar+2,char_I_const_ppO2 ; YES - use SP rcall xmit_sp_set_flag ; - send SP to external devices bsf FLAG_SP3_used ; - set SP 3 used flag check_dive_autosp4: ; Check SP4 btfsc FLAG_SP4_used ; SP 4 used so far? bra check_dive_autosp5 ; YES - continue with SP 5 movff opt_setpoint_change+3,lo ; NO - get depth in m tstfsz lo ; - SP change depth = 0 ? bra check_dive_autosp4a ; NO - continue bra check_dive_autosp5 ; YES - continue with SP 5 check_dive_autosp4a: decf lo,W ; SP change depth -1 -> WREG cpfsgt depth_meter ; current depth > change depth - 1 ? bra check_dive_autosp5 ; NO - continue with SP 5 ; auto switch to SP4 movff opt_setpoint_cbar+3,char_I_const_ppO2 ; YES - use SP rcall xmit_sp_set_flag ; - send SP to external devices bsf FLAG_SP4_used ; - set SP 4 used flag check_dive_autosp5: ; Check SP5 btfsc FLAG_SP5_used ; SP 5 used so far? bra check_dive_autosp6 ; YES - done movff opt_setpoint_change+4,lo ; NO - get depth in m tstfsz lo ; - SP change depth = 0 ? bra check_dive_autosp5a ; NO - continue bra check_dive_autosp6 ; YES - done check_dive_autosp5a: decf lo,W ; SP change depth -1 -> WREG cpfsgt depth_meter ; current depth > change depth - 1 ? bra check_dive_autosp6 ; NO - done ; auto switch to SP5 movff opt_setpoint_cbar+4,char_I_const_ppO2 ; YES - use SP rcall xmit_sp_set_flag ; - send SP to external devices bsf FLAG_SP5_used ; - set SP 5 used flag check_dive_autosp6: return xmit_sp_set_flag: IFDEF _external_sensor call transmit_setpoint ; transmit current setpoint from WREG (in cbar) to external electronics ENDIF bsf event_occured ; set global event flag bsf event_SP_change ; set setpoint event flag return ENDIF ; _ccr_pscr ;============================================================================= set_logbook_marker: bcf request_set_marker ; clear request flag movlw d'6' ; set type of alarm: manual marker movwf alarm_type ; copy to alarm register bsf event_occured ; set event flag return ;============================================================================= ; Setup everything to enter dive mode ; global dive_boot_oc_bail dive_boot_oc_bail: ; 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 return global dive_boot_oc dive_boot_oc: ; set-up registers rcall get_first_gas_to_WREG ; get 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 ;============================================================================= IFDEF _ccr_pscr global dive_boot_cc dive_boot_cc: ; copy opt_dil_types into backup (for "lost diluent" 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 ; set-up registers rcall get_first_dil_to_WREG ; get first diluent (1-5) into WREG rcall setup_dil_registers ; set-up of diluent parameters for currently breathed diluent (with WREG = current diluent 1-5) rcall deco_setup_cc_diluents ; set-up of diluent list for deco calculations (with WREG = current diluent 1-5) ; done return dive_boot_cc_part2: ; 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 IFDEF _external_sensor ; check for external HUD/ppO2 Monitor btfss optical_input ; do we have an optical input? bra dive_boot_cc_part2_1 ; NO btfsc sensor1_active ; YES - copy valid flags from HUD/ppO2 Monitor bsf use_O2_sensor1 ; - ... btfsc sensor2_active ; - ... bsf use_O2_sensor2 ; - ... btfsc sensor3_active ; - ... bsf use_O2_sensor3 ; - ... ENDIF dive_boot_cc_part2_1: ; 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_part2_2 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_part2_2 movlw .0 movff WREG,opt_ccr_mode dive_boot_cc_part2_2: bsf event_SP_change ; set setpoint event flag ; 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 ; pre-load WREG with setpoint value 0 for pSCR calculated btfsc FLAG_ccr_mode ; in CCR mode? movff opt_setpoint_cbar+0,WREG ; YES - get value of setpoint 1 into WREG movff WREG,char_I_const_ppO2 ; write setpoint to deco engine IFDEF _external_sensor call transmit_setpoint ; transmit current setpoint from WREG (in cbar) to external electronics goto calc_deko_divemode_sensor ; read & process sensor data (and return) ELSE return ; done ENDIF ENDIF ; _ccr_pscr ;============================================================================= diveloop_boot: ; do the basic initialization call restart_set_modes_and_flags ; stop accelerometer and compass call I2C_sleep_compass ; do an early initialization of all deco engine output variables to ; avoid glitches in the display outputs during deco engine start-up call deco_init_output_vars; ; (C-code) banksel common ; back to bank common ; reset max relative pressure (max depth) bsf reset_max_pressure ; request ISR to reset the max pressure IFDEF _min_depth_option ; reset the resettable min/max relative pressure (trip-wise min/max depth) bsf reset_trip_pressure ; request ISR to reset the resettable min/max pressure ENDIF IFDEF _cave_mode ; initialize the cave mode bsf cave_mode ; enable cave mode by default movff opt_calc_asc_gasvolume,WREG ; get gas needs calculation mode (0= off, 1= on, 2= cave mode) xorlw .2 ; coding for cave mode tstfsz WREG ; cave mode enabled? bcf cave_mode ; NO - disable cave mode again ENDIF ; configure the deco engine clrf hi ; start with everything disabled TSTOSC opt_ZfactorUse ; shall use Z factors? bsf hi,DECO_Z_FACTOR_FLAG ; YES - enable Z factors TSTOSC opt_extended_stops ; shall make extended stops? bsf hi,DECO_EXTENDED_STOPS ; YES - enable extended stops IFDEF _rx_functions btfsc tr_functions_activated ; TR functions activated? bsf hi,DECO_TR_FUNCTIONS ; YES - enable TR functions ENDIF movff hi,char_O_main_status ; bank-safe copy to deco engine movff char_O_deco_status,lo ; bank-safe read bsf lo,DECO_START_NORM ; set flag for doing a normal plan, bcf lo,DECO_START_ALT ; clear flag for doing an alternative plan, bsf lo,DECO_INITIALIZE ; set flag for initializing the deco engine bcf lo,DECO_ASCENT_FLAG ; disable delayed ascent calculation bcf lo,DECO_CALCULATOR_MODE ; deco engine not run from the deco calculator movff lo,char_O_deco_status ; bank-safe copy back to deco engine ; disable "fast forward" function movlw .0 movff WREG,char_I_sim_advance_time ; write last stop depth to deco engine movff opt_last_stop,char_I_depth_last_deco ; initialize max depth for apnoe mode CLRI apnoe_max_pressure ; reset minimum temperature, ISR-safe 2 byte copy SMOVII temperature_cur,temperature_min ; ISR-safe copy of start-of-dive date and time for logbook (6 bytes in total) SMOVSS rtc_year,start_year MOVII int_O_CNS_current,CNS_start ; save current CNS at beginning of dive, but bcf CNS_start+1,int_warning_flag ; without warning flag bcf CNS_start+1,int_attention_flag ; without attention flag ; save supersaturation at beginning of dive (only lower byte is used for value) movff int_O_lead_supersat+0,supersat_start clrf menu_pos_cur clrf active_premenu ; reset to zero (0= no pre-menu task) bsf o2_sensors_agree ; initialize sensors disagree warning system clrf safety_stop_countdown ; clear safety stop count-down CLRI last_pressure_velocity ; initialize last pressure for velocity calculation CLRI dive_timeout_timer ; initialize timeout counter movlw .1 ; initialize the sampling timer such that the 1st sampling ... movwf sampling_timer ; ... trigger will be given as soon as possible clrf message_page ; initialize message page counter clrf alarm_type ; clear all alarms ; clear the total dive average depth CLRI pressure_rel_avg_total ; average depth CLRI divesecs_avg_total ; time accumulator clrf pressure_rel_accu_total+0 ; depth accumulator clrf pressure_rel_accu_total+1 clrf pressure_rel_accu_total+2 clrf pressure_rel_accu_total+3 IFDEF _rx_functions btfss tr_functions_activated ; TR functions activated? bra diveloop_boot_0 ; NO - skip TR function initialization ; YES - initialize TR function variables banksel int_IO_pressure_value clrf WREG ; clear WREG bsf WREG,int_not_avail_flag ; set WREG to coding for integer numbers -> data not available clrf int_IO_pressure_value+0 ; clear low byte of 1st pressure reading value movwf int_IO_pressure_value+1 ; copy to high byte of 1st pressure reading value clrf int_IO_pressure_value+2 ; clear low byte of 2nd pressure reading value movwf int_IO_pressure_value+3 ; copy to high byte of 2nd pressure reading value clrf int_I_pressure_drop+0 ; clear low byte of 1st pressure drop value movwf int_I_pressure_drop+1 ; copy to high byte of 1st pressure drop value clrf int_I_pressure_drop+2 ; clear low byte of 2nd pressure drop value movwf int_I_pressure_drop+3 ; copy to high byte of 1st pressure drop value clrf char_I_pressure_gas+0 ; clear gas selection of 1st pressure reading clrf char_I_pressure_gas+1 ; clear gas selection of 2nd pressure reading clrf char_I_pressure_age+0 ; clear age of 1st pressure reading clrf char_I_pressure_age+1 ; clear age of 2nd pressure reading clrf char_I_pressure_stat+0 ; clear status of 1st pressure reading clrf char_I_pressure_stat+1 ; clear status of 2nd pressure reading banksel gas__last_1st ; select bank with vars for pressure drop calculation setf gas__last_1st ; invalidate last gas of 1st reading setf gas__last_2nd ; invalidate last gas of 2nd reading banksel common ; back to bank common ENDIF ; _rx_functions diveloop_boot_0: setf best_gas_number ; initialize best gas as not computed yet (255) IFDEF _ccr_pscr setf best_dil_number ; initialize best diluent as not computed yet (255) ENDIF rcall dive_boot_oc_bail ; basic settings required for all modes btfsc FLAG_oc_mode ; in OC mode? rcall dive_boot_oc ; YES - add OC mode settings IFDEF _ccr_pscr btfsc FLAG_ccr_mode ; in CCR mode? rcall dive_boot_cc ; YES - add CC mode settings btfsc FLAG_ccr_mode ; in CCR mode? rcall dive_boot_cc_part2 ; YES - add CC sensor and SP settings btfsc FLAG_pscr_mode ; in pSCR mode? rcall dive_boot_cc ; YES - add CC mode settings btfsc FLAG_pscr_mode ; in pSCR mode? rcall dive_boot_cc_part2 ; YES - add CC sensor and SP settings ENDIF call ghostwriter_short_header ; write short header with dive number into profile memory call init_recording_params ; set up all the divisors for dive data recording ; setup gas selector flag (required to have better gas working) bsf is_diluent_menu ; default to using diluents btfsc FLAG_ccr_mode ; in CCR mode? bra diveloop_boot_3 ; YES - default was right btfsc FLAG_pscr_mode ; in pSCR mode? bra diveloop_boot_3 ; YES - default was right bcf is_diluent_menu ; NO to both - revert to using OC gases diveloop_boot_3: bcf LEDg ; switch off green LED / release reset to RX circuitry bcf LEDr ; switch off red LED btfss sensor_override_active ; in simulator mode? call disable_rs232 ; NO - disable RS232 IFDEF _screendump btfsc screen_dump_avail ; screen dump function enabled? call enable_rs232 ; enable interface (also sets CPU speed to normal) ENDIF clrf apnoe_surface_mins ; clear apnoe surface time, minutes (8 bit) clrf apnoe_surface_secs ; clear apnoe surface time, seconds (8 bit) clrf apnoe_dive_mins ; clear apnoe dive time, minutes (8 bit) clrf apnoe_dive_secs ; clear apnoe dive time, seconds (8 bit) return ; done with dive mode boot ;============================================================================= divemode_check_warnings: movlw .1 ; one message at a time in alternative layout btfss alt_layout_active ; in alternative layout? movlw .2 ; NO - two messages at a time in normal layout cpfsgt message_counter ; more than one (alt layout) / 2 (normal layout) messages currently active? bra divemode_check_warnings1 ; NO - update messages every second ; ; YES - update every 4 seconds: ; btfss timebase_1sec - on second 1 or 3 ? ; return ; NO - no update in this cycle ; btfss timebase_2sec ; YES - on second 3 ? ; return ; NO - no update in this cycle ; ;bra divemode_check_warnings1 ; YES - update messages ; NO - update every 2 seconds btfsc timebase_1sec ; - on even second? return ; NO - done ;bra divemode_check_warnings1 ; YES - update messages divemode_check_warnings1: ; start a new message collection cycle bcf message_advice ; clear flag for messages of level advice bcf message_attention ; clear flag for messages of level attention bcf message_warning ; clear flag for messages of level warning clrf message_counter ; clear message counter ; messages sorted by severity: highest severity warnings first, then attentions, advices and last info ; warnings for all modes call check_warn_battery ; check if the battery level should be displayed/warned rcall check_depth_limit ; check current depth against set depth limit call check_divetimeout ; check and show the dive mode timeout (not actually a warning) btfsc FLAG_apnoe_mode ; in apnoe mode? bra divemode_check_warnings2 ; YES btfsc FLAG_gauge_mode ; in gauge mode? bra divemode_check_warnings2 ; YES ; warnings applicable only in deco modes rcall check_ppO2 ; check ppO2 and displays warning, if required IFDEF _external_sensor btfss o2_sensors_agree ; are the sensor values within the threshold range? rcall check_warn_sensors_disagree ; NO - do further evaluation btfsc o2_sensors_agree ; are the sensor values within the threshold range? bcf o2_sensors_warning ; YES - clear flag for a new warning ENDIF rcall check_outside ; check of ZHL16 model violation IFDEF _helium rcall check_IBCD ; check for IBCD attention or warning ENDIF btfsc FLAG_ccr_mode ; in CCR mode? rcall check_OC_gas_avail ; YES - check if a breathable OC (bailout) gas is available btfsc FLAG_pscr_mode ; in pSCR mode? rcall check_OC_gas_avail ; YES - check if a breathable OC (bailout) gas is available btfsc decostop_active ; in deco mode? rcall check_and_store_sat_violation; YES - sets warnings, if required rcall check_mbubbles ; check for micro bubbles rcall check_cns_violation ; check CNS value and display it, if required rcall check_gas_needs_ascent ; show gas needs warning if any gas need for ascent is > threshold rcall check_eod_cns_violation ; check CNS values for end-of-dive and display warning, if required rcall check_display_ftts ; show @+x time IFDEF _cave_mode btfsc cave_mode ; cave mode switched on? rcall check_cavemode ; YES - check cave mode status ENDIF btfsc use_aGF ; using alternative GF factors? rcall warn_agf ; YES - show memo btfsc sp_fallback ; in fallback condition due to O2 sensor failure? rcall warn_fallback ; YES - show a warning btfsc better_dil_available ; is a better diluent available? rcall advice_gas_change ; YES - display an advice btfsc better_gas_available ; is a better gas available? rcall advice_gas_change ; YES - display an advice divemode_check_warnings2: IFDEF _rx_functions btfss tr_functions_activated ; TR functions activated? bra divemode_check_warnings3 ; NO - skip call check_tr_functions ; YES - check transmitter functions call check_tr_messages ; - check SAC attention and switch advice ENDIF divemode_check_warnings3: ; Display / clear the advice, attention or warning icon btfsc message_advice ; any message of level advice? bsf FLAG_TFT_sign_show ; YES btfsc message_attention ; any message of level attention? bsf FLAG_TFT_sign_show ; YES btfsc message_warning ; any message of level warning? bsf FLAG_TFT_sign_show ; YES btfss FLAG_TFT_sign_show ; any message of above levels? bsf FLAG_TFT_sign_clear ; NO - clear sign ; Increment message page number incf message_page,F ; increment page number bcf STATUS,C ; clear carry bit movf message_page,W ; get page number into WREG btfss alt_layout_active ; in alternative layout? rlcf WREG,W ; NO - each page can take two messages cpfsgt message_counter ; number of actual messages > message capacity ? clrf message_page ; NO - all messages could be shown, restart from first page next time ; Clear both rows of messages if there is nothing to show at all tstfsz message_counter ; any message to show? bra divemode_check_warnings4 ; YES - look if second row needs to be cleared bsf FLAG_TFT_message_clear_both ; NO - request clearing of left-over messages return ; - done divemode_check_warnings4: ; Clear 2nd row of messages if there is nothing to show (on this page) btfss message_2nd_row_used ; does the 2nd row contain a message? bsf FLAG_TFT_message_clear_2nd ; NO - set flag to clear the 2nd row return ; done ;----------------------------------------------------------------------------- global check_warn_battery check_warn_battery: movlw battery_show_level+1 ; get threshold for showing battery level, incremented by 1 cpfslt batt_percent ; battery percentage ok? return ; YES - no display, no warning ; Display Battery, but warn? movlw battery_warn_level_36+1 ; get threshold for 3.6 Volt battery warning, incremented by 1 btfss battery_is_36v ; actually a 3.6 Volt battery detected? movlw battery_warn_level_15+1 ; NO - replace with 1.5 Volt battery warning, incremented by 1 cpfsgt batt_percent ; battery percent below warning threshold? bsf message_warning ; YES - set warning flag movlw index_clock_batt_surfpress ; index of custom view clock, battery and surface pressure cpfseq active_customview ; battery shown in custom view? bra check_warn_battery2 ; NO - show warning return ; YES - do not show twice (in custom view and in message area) check_warn_battery2: incf message_counter,F ; increase counter goto TFT_msg_batt_percent_divemode ; show percent (and return) check_divetimeout: btfsc count_divetime ; is dive time counted? return ; YES - do nothing incf message_counter,F ; increase counter goto TFT_divetimeout ; show timeout counter (and return) check_ppO2: IFDEF _ccr_pscr btfsc FLAG_oc_mode ; are we in OC mode? bra check_ppO2_1 ; YES - continue with breathed gas btfsc bailout_mode ; NO - in bailout? bra check_ppO2_1 ; YES - continue with breathed gas ; CCR / pSCR mode - checks on pure diluent MOVII int_O_pure_ppO2,mpr ; get value and attention/warning flags for the pure diluent btfsc hi,int_warning_flag ; is there a ppO2 low or high warning on the pure diluent? rcall check_ppO2_dw ; YES - show warning and return on next line btfsc hi,int_attention_flag ; ppO2 of the pure diluent in attention state? rcall check_ppO2_da ; YES - show attention and return on next line ENDIF ; all modes - checks on breathed gas (OC or from loop) check_ppO2_1: MOVII int_O_breathed_ppO2,mpr ; get value and attention/warning flags for the breathed gas btfsc hi,int_attention_flag ; breathed ppO2 in attention state (when in loop mode, no attention will be generated)? bra check_ppo2_display_a ; YES - set attention flag and show ppO2 btfsc hi,int_low_flag ; breathed ppO2 too low? bra check_ppO2_low ; YES - record the warning and show ppO2 btfsc hi,int_high_flag ; breathed ppO2 too 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 - done bra check_ppO2_common_2 ; YES - but only when in OC or bailout... 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 alarm_type ; copy alarm type to alarm register bsf event_occured ; set event flag bsf message_warning ; show warning sign check_ppO2_common_2: btfsc FLAG_oc_mode ; are we in OC mode? bra check_ppo2_display ; YES - show btfsc bailout_mode ; are we in bailout mode? bra check_ppo2_display ; YES - show return ; NO - in loop mode, ppO2 is already shown via setpoint display check_ppo2_display_a: bsf message_attention ; show attention sign check_ppo2_display: movlw index_ppo2_ead_end_cns ; index of custom view ppO2, EAD/END and CNS (without He) or gas density (with He) cpfseq active_customview ; ppO2 shown? bra check_ppO2_b ; NO return ; YES - do not show twice (in custom view and in warning area) check_ppO2_b: movlw index_pscr_info ; index of custom view with pSCR data cpfseq active_customview ; ppO2 shown? bra check_ppO2_d ; NO - show ppO2 return ; YES - do not show twice (in custom view and in warning area) check_ppO2_dw: bsf message_warning ; show warning sign check_ppO2_da: bsf message_attention ; show attention sign (no problem if a warning sign is set as well, as it will take priority) check_ppO2_d: incf message_counter,F ; increase counter goto TFT_show_ppo2_warning ; show breathed gas or diluent ppO2 warning (and return) check_display_ftts: btfss count_divetime ; is dive time counted? return ; NO - omit movff char_I_extra_time,lo ; YES - get extra time tstfsz lo ; - extra time > 0 ? bra check_display_ftts_1 ; YES - continue checking bailout condition return ; NO - done check_display_ftts_1: btfsc bailout_mode ; in bailout mode? return ; YES - in bailout no fTTS will be computed, so nothing to display incf message_counter,F ; NO - increase counter goto TFT_show_ftts ; - show @+x time global check_cns_violation check_cns_violation: ; Check if CNS should be displayed movff int_O_CNS_current+1,WREG ; get current CNS, high byte btfsc WREG,int_warning_flag ; warning flag set? bra check_cns_violation_1 ; YES - issue warning btfsc WREG,int_attention_flag ; NO - attention flag set? bra check_cns_violation_2 ; YES - issue attention return ; NO - done check_cns_violation_1: bsf message_warning ; show warning sign check_cns_violation_2: bsf message_attention ; show attention sign IFNDEF _helium movlw index_ppo2_ead_end_cns ; index of custom view ppO2, EAD/END and CNS (without He) or gas density (with He) cpfseq active_customview ; CNS shown? bra check_cns_violation_3 ; NO return ; YES - do not show twice (in custom view and in warning area) ENDIF check_cns_violation_3: movlw index_CNS ; index of custom view with CNS values cpfseq active_customview ; CNS shown? bra check_cns_violation_4 ; NO return ; YES - do not show twice (in custom view and in warning area) check_cns_violation_4: incf message_counter,F ; increase counter goto TFT_show_cns ; show CNS (and return) global check_eod_cns_violation ; check end-of-dive CNS values check_eod_cns_violation: movff int_O_CNS_current+1,WREG ; get current CNS, high byte btfsc WREG,int_warning_flag ; current CNS value in warning state? return ; YES - inhibit end-of-dive warning if current CNS is already in warning movff int_O_CNS_norm+1,WREG ; get CNS at end of dive in normal plan, high byte 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_CNS_alt+1,WREG ; get CNS at end of dive in alternative plan, high byte 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: ; issue warning (actually only on attention level) bsf message_attention ; show attention sign movlw index_CNS ; index of custom view with CNS values cpfseq active_customview ; CNS values shown? 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 message_counter,F ; increase counter goto TFT_warning_eod_cns ; issue CNS at end-of-dive warning (and return) global check_and_store_sat_violation check_and_store_sat_violation: movff int_O_lead_supersat+1,WREG ; get upper byte of leading tissue's supersaturation btfss WREG,int_warning_flag ; check if the warning flag is set bra check_and_store_sat_violation2 ; NO - continue with checking for attention flag movlw d'2' ; YES - set type of alarm movwf alarm_type ; - copy to alarm register bsf event_occured ; - set event flag bsf message_warning ; - set warning flag bra check_and_store_sat_violation3 ; - show GF warning check_and_store_sat_violation2: btfsc WREG,int_attention_flag ; check if the attention flag is set bra check_and_store_sat_violation3 ; YES - show gf TSTOSS opt_enable_IBCD ; NO - IBCD warning activated? bra check_and_store_sat_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_sat_violation4 ; NO - continue checking for deco info check_and_store_sat_violation3: ; YES - show GF bsf message_attention ; show attention sign incf message_counter,F ; increase counter goto TFT_warning_sat ; show saturation (and return) check_and_store_sat_violation4: ; check for deco info btfss divemode ; in dive mode? return ; NO - done, return btfsc bailout_mode ; YES - in bailout mode? return ; YES - done, return (deco zone flag is not updated when in bailout mode) movff char_O_deco_info,WREG ; NO - get the deco info vector btfss WREG,deco_zone ; check if the deco zone flag is set return ; NO - done, return btfsc use_aGF ; YES - using alternative GF factors? return ; YES - suppress deco zone info btfsc alt_layout_active ; NO - in alternative layout? return ; YES - suppress deco zone info incf message_counter,F ; NO - increase counter goto TFT_info_deco ; - show deco info check_depth_limit: bcf depth_limit_exceeded ; clear warning flag by default movff opt_max_depth,WREG ; get depth limit cpfsgt depth_meter ; current depth > depth limit? return ; NO bsf depth_limit_exceeded ; YES - set warning flag incf message_counter,F ; - increase counter bsf message_warning ; - set warning flag goto TFT_warning_depth ; - show warning check_outside: movff char_O_deco_warnings,WREG ; bank-safe copy of deco warnings btfss WREG,outside_warning_lock ; are we outside of the ZH-L16 model? return ; NO - done incf message_counter,F ; YES - increase counter bsf message_attention ; - show attention sign btfsc WREG,outside_warning ; - are we outside the ZH-L16 model right now (-> warning)? bsf message_warning ; - set warning flag goto TFT_warning_outside ; - show outside-ZHL-model warning/attention (and return) global check_mbubbles check_mbubbles: movff char_O_deco_warnings,WREG ; bank-safe copy for deco warnings btfsc WREG,mbubble_warning ; are we in micro bubbling zone right now? bra check_mbubbles_warn ; YES btfss WREG,mbubble_warning_lock ; were we in micro bubbling zone? return ; NO - done check_mbubble_att ; YES - attention level incf message_counter,F ; increase counter bsf message_attention ; show attention sign goto TFT_warning_mbubbles ; show micro bubble attention (and return) - TFT_warning_mbubbles switches by itself between attention and warning check_mbubbles_warn: ; locked micro bubbles - warning level if at issue, attention level if locked incf message_counter,F ; increase counter bsf message_warning ; set warning flag goto TFT_warning_mbubbles ; show micro bubbles warning (and return) IFDEF _cave_mode check_cavemode: incf message_counter,F ; increase counter btfsc dive_turned ; dive turned? goto TFT_info_dive_turned ; YES - show info that dive is turned btfsc FLAG_backtrack_full ; NO - is the backtracking storage full? goto TFT_warn_cave_shutdown ; YES - show that cave mode has shut down goto TFT_info_cave_mode ; NO - show that cave mode is active ENDIF warn_agf: incf message_counter,F ; increase counter goto TFT_warning_agf ; show aGF reminder (and return) warn_fallback: incf message_counter,F ; increase counter bsf message_warning ; set warning flag goto TFT_warning_fallback ; show fallback warning (and return) ;============================================================================= IFDEF _rx_functions check_tr_messages: btfss count_divetime ; is the dive time counted, i.e. deeper than dive threshold? return ; NO - suppress messages movff int_O_SAC_measured+1,WREG ; YES - bank-safe copy of measured SAC rate btfss WREG,int_attention_flag ; - attention flag set? bra check_tr_messages2 ; NO - skip btfsc WREG,int_not_avail_flag ; SAC rate available? bra check_tr_messages2 ; NO - continue with swap advice bsf message_attention ; YES - show attention sign movlw index_pressures_SAC ; - index of custom view with SAC rate cpfseq active_customview ; - SAC rate shown right now? bra check_tr_messages1 ; NO - show attention message bra check_tr_messages2 ; YES - do not show twice, continue with swap advice check_tr_messages1: incf message_counter,F ; increase counter call TFT_attention_sac ; show SAC attention check_tr_messages2: movff char_O_deco_info,WREG ; bank-safe copy of deco info vector btfss WREG,ind_double_switch ; swap tank flag set? return ; NO incf message_counter,F ; YES - increase counter bsf message_advice ; - show advice sign goto TFT_advice_switch ; - show swap advice check_tr_functions: clrf xmitter_flags_mesg ; set all messages as not shown yet movlw index_pressures_SAC ; index of custom view pressure readings cpfseq active_customview ; pressure readings shown? bra check_tr_functions_tr1 ; NO - continue with checking transmitter 1 bsf pres_customview_shown ; YES - suppress redraw by faking it has already been redrawn check_tr_functions_tr1: movff char_I_pressure_stat+0,WREG ; get status of 1st pressure reading rcall check_tr_functions_helper1 ; check for transmitter 1 lost rcall check_tr_functions_helper2 ; check for transmitter 1 low battery movff int_IO_pressure_value+1,WREG ; get high byte of 1st pressure reading rcall check_tr_functions_helper3 ; check for transmitter 1 pressure warning rcall check_tr_functions_helper4 ; check for transmitter 1 pressure attention check_tr_functions_tr2: movff char_I_pressure_stat+1,WREG ; get status of 2nd pressure reading rcall check_tr_functions_helper5 ; check for transmitter 2 lost rcall check_tr_functions_helper6 ; check for transmitter 2 low battery movff int_IO_pressure_value+3,WREG ; get high byte of 2nd pressure reading rcall check_tr_functions_helper7 ; check for transmitter 2 pressure warning rcall check_tr_functions_helper8 ; check for transmitter 2 pressure attention check_tr_functions_show_xmtr: btfss show_transmitter_attention ; shall show transmitter attention message? bra check_tr_functions_show_warn ; NO - continue with pressure warning bsf message_attention ; YES - set flag for attention incf message_counter,F ; - increase counter call TFT_attention_transmitter ; - show transmitter attention message check_tr_functions_show_warn: btfss show_pres_warning ; shall show pressure warning? bra check_tr_functions_show_att ; NO - continue with pressure attention bsf message_warning ; YES - set flag for warning incf message_counter,F ; - increase counter goto TFT_warning_pres_reading ; - pressure reading warning message and done then check_tr_functions_show_att: btfss show_pres_attention ; shall show pressure attention? return ; NO - done bsf message_attention ; YES - set flag for attention incf message_counter,F ; - increase counter goto TFT_attention_pres_reading ; - pressure reading warning message and done then check_tr_functions_helper1: btfsc WREG,char_transmitter_lost ; transmitter 1 lost? bra check_tr_functions_helper1a ; YES - show transmitter attention message bcf transmitter1_lost ; NO - clear flag for old lost attention return ; - done check_tr_functions_helper1a: ; bsf show_transmitter_attention ; show transmitter attention btfsc transmitter1_lost ; is it a new message? return ; NO - do not show the pressure readings custom view again bsf transmitter1_lost ; YES - memorize it's an old message now bra check_tr_functions_show_cv ; - show custom view check_tr_functions_helper2: btfsc WREG,char_transmitter_low_bat ; transmitter 1 low battery? bra check_tr_functions_helper2a ; YES - show transmitter attention message bcf transmitter1_battery ; NO - clear flag for old battery attention return ; - done check_tr_functions_helper2a: bsf show_transmitter_attention ; show transmitter attention btfsc transmitter1_battery ; is it a new message? return ; NO - do not show the pressure readings custom view again bsf transmitter1_battery ; YES - memorize it's an old message now bra check_tr_functions_show_cv ; - show custom view check_tr_functions_helper3: btfsc WREG,int_warning_flag ; transmitter 1 pressure warning? bra check_tr_functions_helper3a ; YES - show pressure reading message as warning bcf transmitter1_pres_warn ; NO - clear flag for old warning return ; - done check_tr_functions_helper3a: bsf show_pres_warning ; show pressure warning btfsc transmitter1_pres_warn ; is it a new message? return ; NO - do not show the pressure readings custom view again bsf transmitter1_pres_warn ; YES - memorize it's an old message now bra check_tr_functions_show_cv ; - show custom view check_tr_functions_helper4: btfsc WREG,int_attention_flag ; transmitter 1 pressure attention? bra check_tr_functions_helper4a ; YES - show pressure reading message as attention bcf transmitter1_pres_att ; NO - clear flag for old attention return ; - done check_tr_functions_helper4a bsf show_pres_attention ; show pressure attention btfsc transmitter1_pres_att ; is it a new message? return ; NO - do not show the pressure readings custom view again bsf transmitter1_pres_att ; YES - memorize it's an old message now bra check_tr_functions_show_cv ; - show custom view check_tr_functions_helper5: btfsc WREG,char_transmitter_lost ; transmitter 2 lost? bra check_tr_functions_helper5a ; YES - show transmitter attention message bcf transmitter2_lost ; NO - clear flag for old lost attention return ; - done check_tr_functions_helper5a: ; bsf show_transmitter_attention ; show transmitter attention btfsc transmitter2_lost ; is it a new message? return ; NO - do not show the pressure readings custom view again bsf transmitter2_lost ; YES - memorize it's an old message now bra check_tr_functions_show_cv ; - show custom view check_tr_functions_helper6: btfsc WREG,char_transmitter_low_bat ; transmitter 2 low battery? bra check_tr_functions_helper6a ; YES - show transmitter attention message bcf transmitter2_battery ; NO - clear flag for old battery attention return ; - done check_tr_functions_helper6a: bsf show_transmitter_attention ; show transmitter attention btfsc transmitter2_battery ; is it a new message? return ; NO - do not show the pressure readings custom view again bsf transmitter2_battery ; YES - memorize it's an old message now bra check_tr_functions_show_cv ; - show custom view check_tr_functions_helper7: btfsc WREG,int_warning_flag ; transmitter 2 pressure warning? bra check_tr_functions_helper7a ; YES - show pressure reading message as warning bcf transmitter2_pres_warn ; NO - clear flag for old warning return ; - done check_tr_functions_helper7a: bsf show_pres_warning ; show pressure warning btfsc transmitter2_pres_warn ; is it a new message? return ; NO - do not show the pressure readings custom view again bsf transmitter2_pres_warn ; YES - memorize it's an old message now bra check_tr_functions_show_cv ; - show custom view check_tr_functions_helper8: btfsc WREG,int_attention_flag ; transmitter 2 pressure attention? bra check_tr_functions_helper8a ; YES - show pressure reading message as attention bcf transmitter2_pres_att ; NO - clear flag for old attention return ; - done check_tr_functions_helper8a bsf show_pres_attention ; show pressure attention btfsc transmitter2_pres_att ; is it a new message? return ; NO - do not show the pressure readings custom view again bsf transmitter2_pres_att ; YES - memorize it's an old message now ;bra check_tr_functions_show_cv ; - show custom view check_tr_functions_show_cv: btfsc pres_customview_shown ; is the pressure readings custom view not shown yet? return ; NO - already shown, done bsf pres_customview_shown ; YES - mark as shown movlw index_pressures_SAC-1 ; - custom view number one below pressure readings movwf active_customview ; - set custom view number bsf request_next_custview ; - initiate toggle to desired custom view -> pressure readings view will be shown return ; - done ENDIF ;============================================================================= check_gas_needs_ascent: banksel int_O_gas_need_pres movf int_O_gas_need_pres+1,W ; get high byte from pres need of 1st tank iorwf int_O_gas_need_pres+3,W ; inclusive or with high byte from pres need of 2nd tank iorwf int_O_gas_need_pres+5,W ; inclusive or with high byte from pres need of 3rd tank iorwf int_O_gas_need_pres+7,W ; inclusive or with high byte from pres need of 4th tank iorwf int_O_gas_need_pres+9,W ; inclusive or with high byte from 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 bra check_gas_needs_ascent_warn ; YES - generate a warning btfsc WREG,int_attention_flag ; NO - check if any gas has a pres_need >= pres_fill * threshold bra check_gas_needs_ascent_att ; YES - generate an attention bcf gas_needs_attention ; NO - clear flag for a new attention bcf gas_needs_warning ; - clear flag for a new warning return ; - done check_gas_needs_ascent_warn: bsf message_warning ; set warning flag incf message_counter,F ; increase counter btfsc gas_needs_warning ; is it a new warning? goto TFT_warning_gas_needs_warn ; NO - do not show the gas needs custom view again bsf gas_needs_warning ; YES - memorize it's an old now movlw index_gas_needs_ascent-1 ; - custom view number one below gas needs view movwf active_customview ; - set custom view number bsf request_next_custview ; - initiate toggle to desired custom view -> gas needs view will be shown goto TFT_warning_gas_needs_warn ; - show warning message check_gas_needs_ascent_att: bsf message_attention ; set attention flag incf message_counter,F ; increase counter btfsc gas_needs_attention ; is it a new attention? goto TFT_warning_gas_needs_att ; NO - do not show the gas needs custom view again bsf gas_needs_attention ; YES - memorize it's an old now movlw index_gas_needs_ascent-1 ; - custom view number one below gas needs view movwf active_customview ; - set custom view number bsf request_next_custview ; - initiate toggle to desired custom view -> gas needs view will be shown goto TFT_warning_gas_needs_att ; - show attention message ;============================================================================= IFDEF _external_sensor check_warn_sensors_disagree: incf message_counter,F ; increase counter bsf message_warning ; set warning flag btfsc o2_sensors_warning ; is it a new warning? goto TFT_warning_sensor_disagree ; NO - don't show sensor custom view again, just show sensor disagree warning and return bsf o2_sensors_warning ; YES - memorize it's an old warning now call show_sensors_custview ; - show sensors custom view goto TFT_warning_sensor_disagree ; - show sensor disagree warning and return ENDIF ;============================================================================= IFDEF _helium 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 message_counter,F ; YES - increase counter goto TFT_warning_IBCD ; write warning to display ENDIF ;============================================================================= check_OC_gas_avail: tstfsz best_gas_number ; is a breathable OC (bailout) gas available? return ; YES (>0) - a breathable gas is available btfsc bailout_mode ; NO (=0) - in bailout? return ; YES - suppress warning incf message_counter,F ; NO - increase counter bsf message_warning ; - set attention flag goto TFT_warning_no_BO_gas ; - show waring (and return) advice_gas_change: bsf message_advice ; show advice sign incf message_counter,F ; increase counter goto TFT_advice_gas_change global restart_deco_engine global restart_deco_engine_wo_ceiling restart_deco_engine: banksel int_O_ceiling ; switch to bank where the shared "_O_" variables are stored bsf int_O_ceiling+1,char_invalid_flag ; invalidate ceiling (int_O_ceiling has its invalid flag on a char's position!) restart_deco_engine_wo_ceiling: banksel char_O_deco_gas ; switch to bank where the shared "_O_" variables are stored bsf char_O_deco_gas+0,char_invalid_flag ; invalidate deco data (stop table data) bsf int_O_TTS_norm+1,int_invalid_flag ; invalidate ascent time (normal plan) bsf int_O_CNS_norm+1,int_invalid_flag ; invalidate CNS at end of dive in normal plan ; restart deco engine: bcf char_O_deco_status,DECO_COMPLETED_NORM ; eventually clear flag stating completion of normal plan bsf char_O_deco_status,DECO_COMPLETED_ALT ; fake we came from alternative plan to force normal plan to be done next inval_alternative_plan_data: banksel int_O_TTS_alt ; switch to bank where the shared "_O_" variables are stored bsf int_O_TTS_alt+1,int_invalid_flag ; invalidate ascent time (alternative plan) bsf int_O_CNS_alt+1,int_invalid_flag ; invalidate CNS at end of dive in alternative plan bsf int_O_gas_need_pres+1,int_invalid_flag ; invalidate ascent gas needs IFDEF _rx_functions bsf int_O_pressure_need+1,int_not_avail_flag ; invalidate pressure needs to reading 1 (TR functions) bsf int_O_pressure_need+3,int_not_avail_flag ; invalidate pressure needs to reading 2 (TR functions) ENDIF banksel common ; bank to bank common bsf new_deco_data_avail ; set flag for new NDL and deco data available to have the display updated return ;============================================================================= ; Simulator Mode ; global do_demo_divemode do_demo_divemode: ; +++ COMMENT OUT FOR TESTING PURPOSE ONLY !!! +++ bsf simulatormode ; will restore tissue pressures and CNS value after simulator use ; +++ DO NOT COMMENT OUT IN OPERATIONAL USE !!! +++ call TFT_ClearScreen ; blank screen call option_save_all ; save all settings into EEPROM before starting simulation call deco_push_tissues_to_vault ; back-up the tissue pressures (C-code) banksel common ; back to bank common ; set simulated target depth movff char_I_bottom_depth,simulatormode_depth ; set initial simulated depth (needed to overcome end-of-dive detection) banksel pressure_rel_sim MOVLI simulator_startdepth,pressure_rel_sim banksel common ; switch ISR pressure calculations to simulator mode bcf quit_simulatormode ; clear flag for fast abort request bcf sensor_override_active ; make sure ISR mode switch confirmation is not older than from now on bsf sensor_override_request ; request ISR to switch to simulator mode btfss sensor_override_active ; has the ISR confirmed switch to simulator mode? bra $-2 ; NO - not yet, loop waiting for the ISR to kick in ; branch into dive mode bsf divemode ; activate dive mode (to be done after simulator mode is activated) goto diveloop ; branch to dive mode code END