Mercurial > public > hwos_code
annotate src/divemenu_tree.asm @ 578:2b8ef780cfa8
work in progress...
| author | heinrichsweikamp |
|---|---|
| date | Sun, 18 Feb 2018 21:04:54 +0100 |
| parents | 54346c651b6a |
| children | e6d5a1f02daf |
| rev | line source |
|---|---|
| 0 | 1 ;============================================================================= |
| 2 ; | |
| 560 | 3 ; File divemenu_tree.asm REFACTORED VERSION V2.96a |
| 0 | 4 ; |
| 275 | 5 ; OSTC dive mode menu |
| 0 | 6 ; |
| 7 ; Copyright (c) 2011, JD Gascuel, HeinrichsWeikamp, all right reserved. | |
| 8 ;============================================================================= | |
| 9 ; HISTORY | |
| 10 ; 2013-02-02 : [mH] Made out of menu_tree.asm | |
| 11 | |
| 275 | 12 #include "hwos.inc" ; Mandatory header |
| 0 | 13 #include "menu_processor.inc" |
| 14 #include "shared_definitions.h" ; Mailbox from/to p2_deco.c | |
| 15 #include "tft_outputs.inc" | |
| 16 #include "customview.inc" | |
| 17 #include "strings.inc" | |
| 195 | 18 #include "calibrate.inc" |
| 0 | 19 |
| 560 | 20 |
| 0 | 21 divegui CODE |
| 22 ;============================================================================= | |
| 23 ; Main Menu | |
| 560 | 24 global do_main_divemenu |
| 0 | 25 do_main_divemenu: |
| 560 | 26 call menu_processor_reset ; restart from first icon. |
| 0 | 27 |
| 28 do_continue_main_divemenu: | |
| 560 | 29 call menu_processor_pop ; drop exit line. |
| 30 call menu_processor_pop ; drop exit line. | |
| 0 | 31 |
| 560 | 32 btfsc FLAG_ccr_mode |
| 33 bra main_divemenu_loop ; goto CCR / pSCR Menu menu | |
| 34 btfsc FLAG_pscr_mode | |
| 35 bra main_divemenu_loop ; goto CCR / pSCR Menu menu | |
| 36 | |
| 37 main_divemenu_OC: | |
| 38 bcf ccr_diluent_setup | |
| 39 bcf is_bailout_menu | |
| 40 movlw .1 | |
| 41 movwf menupos ; Set to first option in divemode menu | |
| 485 | 42 |
| 560 | 43 MENU_BEGIN tMainMenu, .5 |
| 44 MENU_CALL tDivemenu_Gaslist, do_divemode_gaslist | |
| 45 MENU_CALL tDivemenu_ResetAvg, do_reset_average | |
| 46 MENU_CALL tDivemenu_ToggleGF, do_toggle_gf | |
| 47 MENU_CALL tDivemenu_Marker, do_set_marker | |
| 48 MENU_CALL tExit, do_exit_divemode_menu | |
| 49 MENU_END | |
| 0 | 50 |
| 560 | 51 main_divemenu_loop: |
| 52 bsf ccr_diluent_setup ; default to operations on diluents | |
| 53 bcf is_bailout_menu ; default to none-bailout menu | |
| 0 | 54 movlw .1 |
| 560 | 55 movwf menupos ; Set to first option in divemode menu |
| 485 | 56 |
| 57 btfsc FLAG_pscr_mode | |
| 560 | 58 bra main_divemenu_pscr ; PSCR Menu |
| 485 | 59 |
| 0 | 60 MENU_BEGIN tMainMenu, .6 |
| 61 MENU_CALL tDiveBailout, do_divemode_gaslist_bail | |
| 62 MENU_CALL tDivemenu_Setpoint, do_divemode_splist | |
| 63 MENU_CALL tDivemenu_Gaslist, do_divemode_gaslist | |
| 560 | 64 MENU_CALL tDivemenu_ResetAvg, do_reset_average |
| 65 MENU_CALL tDivemenu_ToggleGF, do_toggle_gf | |
| 0 | 66 MENU_CALL tExit, do_exit_divemode_menu |
| 67 MENU_END | |
| 485 | 68 |
| 69 main_divemenu_pscr: | |
| 560 | 70 movf hardware_flag,W |
| 71 sublw 0x11 ; 2 with BLE | |
| 72 btfsc STATUS,Z | |
| 73 bra main_divemenu_pscr_no_sensors | |
| 74 movf hardware_flag,W | |
| 75 sublw 0x13 ; + | |
| 76 btfsc STATUS,Z | |
| 77 bra main_divemenu_pscr_no_sensors | |
| 78 | |
| 485 | 79 MENU_BEGIN tMainMenu, .6 |
| 80 MENU_CALL tDiveBailout, do_divemode_gaslist_bail | |
| 560 | 81 MENU_CALL tCCRSensor, do_divemode_setpoint_pscr |
| 82 MENU_CALL tDivemenu_Gaslist, do_divemode_gaslist | |
| 83 MENU_CALL tDivemenu_ResetAvg, do_reset_average | |
| 84 MENU_CALL tDivemenu_ToggleGF, do_toggle_gf | |
| 85 MENU_CALL tExit, do_exit_divemode_menu | |
| 86 MENU_END | |
| 87 | |
| 88 main_divemenu_pscr_no_sensors: | |
| 89 MENU_BEGIN tMainMenu, .6 | |
| 90 MENU_CALL tDiveBailout, do_divemode_gaslist_bail | |
| 91 MENU_CALL tDivemenu_Gaslist, do_divemode_gaslist | |
| 92 MENU_CALL tDivemenu_ResetAvg, do_reset_average | |
| 93 MENU_CALL tDivemenu_ToggleGF, do_toggle_gf | |
| 94 MENU_CALL tDivemenu_Marker, do_set_marker | |
| 485 | 95 MENU_CALL tExit, do_exit_divemode_menu |
| 96 MENU_END | |
| 560 | 97 |
| 0 | 98 |
| 560 | 99 do_toggle_gf: |
| 100 movff char_I_deco_model,WREG ; 0 = ZH-L16, 1 = ZH-L16-GF | |
| 101 decfsz WREG,W ; Toggle GF only in GF modes - in GF mode? | |
| 102 bra do_continue_main_divemenu ; No, do nothing and return | |
| 103 TSTOSS opt_enable_aGF ; =1: aGF can be selected underwater | |
| 104 bra do_continue_main_divemenu ; No, do nothing and return | |
| 105 movlw .4 ; Set customview to 5 (GF informations) | |
| 106 movwf menupos3 ; Customview to come-1 | |
| 107 bsf toggle_customview ; Set flag, the customview will be toggled very soon now... | |
| 108 movlw .1 | |
| 109 movwf menupos ; Set to first option in divemode menu | |
| 110 | |
| 111 MENU_BEGIN tDivemenu_ToggleGF, .2 | |
| 112 MENU_CALL tDivemenu_ToggleGF, do_togglegf | |
| 113 MENU_CALL tExit, do_continue_main_divemenu | |
| 114 MENU_END | |
| 0 | 115 |
| 560 | 116 do_togglegf: |
| 117 ;TSTOSS opt_enable_aGF ; =1: aGF can be selected underwater ## check is now done before entering menu | |
| 118 ;bra do_exit_divemode_menu ; continue with exiting menu code | |
| 119 bsf toggle_gf ; Set flag... | |
| 120 bra do_exit_divemode_menu ; continue with exiting menu code | |
| 121 | |
| 122 | |
| 123 do_set_marker: | |
| 124 movlw d'6' ; Type of Alarm (Manual Marker) | |
| 125 movwf AlarmType ; Copy to Alarm Register | |
| 126 bsf event_occured ; Set Event Flag | |
| 127 bra do_exit_divemode_menu ; And exit | |
|
53
2825f1d2262f
NEW: Dynamic Gaslist in OC mode (Divemode, Customview 7)
heinrichsweikamp
parents:
0
diff
changeset
|
128 |
| 560 | 129 |
| 130 do_reset_average: | |
| 131 bsf reset_average_depth ; Set Flag | |
| 132 bra do_exit_divemode_menu ; continue with exiting menu code | |
| 0 | 133 |
| 560 | 134 |
| 135 do_switch_sensor: ; entry point when coming from switch to sensor | |
| 136 movlw .1 ; Switch to Sensor | |
| 137 movff WREG,opt_ccr_mode ; =0: Fixed SP (CCR) / calculated (pSCR), =1: Sensor, =2: Auto SP | |
| 564 | 138 ; enable all sensors |
| 139 bsf use_O2_sensor1 | |
| 140 bsf use_O2_sensor2 | |
| 141 bsf use_O2_sensor3 | |
| 560 | 142 bra do_switch_sp_com ; continue with common part |
| 143 | |
| 144 do_switch_sp: ; entry point when coming from manual setpoint selection (CCR) | |
| 145 decf menupos,W ; 1-5 -> 0-4 | |
| 0 | 146 lfsr FSR1,char_I_setpoint_cbar |
| 560 | 147 movff PLUSW1,char_I_const_ppO2 ; setup fixed setpoint |
|
352
5c6da9fa5cb0
add setpoint change to first sample in CCR mode
heinrichsweikamp
parents:
275
diff
changeset
|
148 movff char_I_const_ppO2,WREG |
| 560 | 149 call transmit_setpoint ; tansmit current setpoint from WREG (in cbar) to external electronics |
| 150 bcf setpoint_fallback ; clear fallback condition (stops fallback warning) | |
| 151 clrf WREG ; Switch to fixed SP | |
| 152 movff WREG,opt_ccr_mode ; =0: Fixed SP (CCR) / calculated (pSCR), =1: Sensor, =2: Auto SP | |
| 153 bra do_switch_sp_com | |
| 0 | 154 |
| 560 | 155 do_switch_sp_calc: ; entry point when coming from switch to calculated ppO2 (pSCR) |
| 156 bcf setpoint_fallback ; clear fallback condition (stops fallback warning) | |
| 157 clrf WREG ; Switch to fixed SP | |
| 158 movff WREG,opt_ccr_mode ; =0: Fixed SP (CCR) / calculated (pSCR), =1: Sensor, =2: Auto SP | |
| 159 movff WREG,char_I_const_ppO2 ; set setpoint to 0, this forces deco engine to take the computed ppO2 | |
|
97
53a99a2dc6a1
CHANGE: Always compute bailout plan based on all active gases
heinrichsweikamp
parents:
53
diff
changeset
|
160 |
| 560 | 161 do_switch_sp_com: ; merge point to common part |
| 162 bsf event_occured ; set global event byte | |
| 163 bsf setpoint_changed ; set flag (for profile) | |
| 0 | 164 |
| 165 ; Clear some flags in case we were in bailout before... | |
| 560 | 166 bcf is_bailout ; end bailout mode |
| 167 ;bcf is_bailout_menu ; not needed | |
| 168 bcf better_gas_available ; =1: A better gas is available and a gas change is advised in divemode | |
| 169 bcf blinking_better_gas ; clear blinking flag | |
| 170 call customview_mask ; update customview mask to (eventually) rewrite ppO2(Dil): to ppO2: | |
| 171 | |
| 172 movff active_diluent,menupos ; reconfigure last diluent (menupos is transfer register for selected gas/diluent towards gas_switched_common:) | |
| 173 bsf divemode_gaschange ; initiate reconfiguration to loop mode on last diluent | |
| 174 | |
| 175 bra do_exit_divemode_menu ; continue with exiting menu code | |
| 0 | 176 |
| 560 | 177 |
| 178 do_divemode_gaslist_bail: ; entry point from CCR/pSCR to bailout to OC gases | |
| 179 bcf ccr_diluent_setup ; switch to OC gases | |
| 180 bsf is_bailout_menu ; flag it is a bailout action | |
| 181 do_divemode_gaslist: ; entry point for switching: OC -> gases, loop -> diluents | |
| 182 btfsc is_bailout ; in bailout mode? | |
| 183 bcf ccr_diluent_setup ; yes - for safety reasons, redirect to OC (bailout) gases | |
| 184 bsf short_gas_decriptions | |
| 185 movlw .1 | |
| 186 movwf menupos ; Set to first option in divemode menu | |
| 0 | 187 MENU_BEGIN tGaslist, .6 |
| 188 MENU_DYNAMIC gaslist_strcat_gas_mod, do_switch_gas | |
| 189 MENU_DYNAMIC gaslist_strcat_gas_mod, do_switch_gas | |
| 190 MENU_DYNAMIC gaslist_strcat_gas_mod, do_switch_gas | |
| 191 MENU_DYNAMIC gaslist_strcat_gas_mod, do_switch_gas | |
| 192 MENU_DYNAMIC gaslist_strcat_gas_mod, do_switch_gas | |
| 560 | 193 MENU_CALL tMore, do_divemode_gaslist_more |
| 0 | 194 MENU_END |
| 195 | |
| 196 do_divemode_gaslist_more: | |
| 560 | 197 movlw .1 |
| 198 movwf menupos ; Set to first option in divemode menu | |
| 199 | |
| 200 movff char_I_O2_ratio,gas6_O2_ratio ; initialize gas6 with currently breathed gas - O2 ratio | |
| 201 movff char_I_He_ratio,gas6_He_ratio ; initialize gas6 with currently breathed gas - He ratio | |
| 202 | |
| 203 do_divemode_gaslist_more_loop: | |
| 0 | 204 MENU_BEGIN tGaslist, .6 |
| 205 MENU_CALL tO2Plus, do_dive_pO2 | |
| 206 MENU_CALL tO2Minus, do_dive_mO2 | |
| 207 MENU_CALL tHePlus, do_dive_pHe | |
| 208 MENU_CALL tHeMinus, do_dive_mHe | |
| 560 | 209 MENU_DYNAMIC gaslist_strcat_gas6, do_switch_gas6 |
|
403
6e60012bb3fc
NEW: "Lost Gas" feature allows disabling gases during the dive
heinrichsweikamp
parents:
401
diff
changeset
|
210 MENU_CALL tDivemenu_LostGas, do_lost_gas |
|
6e60012bb3fc
NEW: "Lost Gas" feature allows disabling gases during the dive
heinrichsweikamp
parents:
401
diff
changeset
|
211 MENU_END |
|
6e60012bb3fc
NEW: "Lost Gas" feature allows disabling gases during the dive
heinrichsweikamp
parents:
401
diff
changeset
|
212 |
|
6e60012bb3fc
NEW: "Lost Gas" feature allows disabling gases during the dive
heinrichsweikamp
parents:
401
diff
changeset
|
213 do_lost_gas: |
| 560 | 214 movlw .1 |
| 215 movwf menupos ; Set to first option in divemode menu | |
| 216 do_lost_gas_loop: | |
| 217 bsf short_gas_decriptions | |
|
403
6e60012bb3fc
NEW: "Lost Gas" feature allows disabling gases during the dive
heinrichsweikamp
parents:
401
diff
changeset
|
218 MENU_BEGIN tDivemenu_LostGas, .6 |
|
6e60012bb3fc
NEW: "Lost Gas" feature allows disabling gases during the dive
heinrichsweikamp
parents:
401
diff
changeset
|
219 MENU_DYNAMIC gaslist_strcat_gas_mod, do_toggle_active ; Toggle the gas (in)active |
|
6e60012bb3fc
NEW: "Lost Gas" feature allows disabling gases during the dive
heinrichsweikamp
parents:
401
diff
changeset
|
220 MENU_DYNAMIC gaslist_strcat_gas_mod, do_toggle_active ; Toggle the gas (in)active |
|
6e60012bb3fc
NEW: "Lost Gas" feature allows disabling gases during the dive
heinrichsweikamp
parents:
401
diff
changeset
|
221 MENU_DYNAMIC gaslist_strcat_gas_mod, do_toggle_active ; Toggle the gas (in)active |
|
6e60012bb3fc
NEW: "Lost Gas" feature allows disabling gases during the dive
heinrichsweikamp
parents:
401
diff
changeset
|
222 MENU_DYNAMIC gaslist_strcat_gas_mod, do_toggle_active ; Toggle the gas (in)active |
|
6e60012bb3fc
NEW: "Lost Gas" feature allows disabling gases during the dive
heinrichsweikamp
parents:
401
diff
changeset
|
223 MENU_DYNAMIC gaslist_strcat_gas_mod, do_toggle_active ; Toggle the gas (in)active |
| 560 | 224 MENU_CALL tExit, do_exit_divemode_menu |
| 0 | 225 MENU_END |
| 226 | |
| 560 | 227 |
| 228 do_switch_gas6: | |
| 229 movlw .6 ; gas 6 | |
| 230 movwf menupos ; transfer register for selected gas towards gas_switched_common: | |
| 231 bsf gas6_changed ; set flag for profile recording | |
| 232 ;bra do_switch_gas ; continue with common gas-switched code | |
| 233 | |
| 234 do_switch_gas: | |
| 235 bsf divemode_gaschange ; Set flag, will also trigger restart of deco_engine | |
| 236 btfsc is_bailout_menu ; Bailout confirmed? | |
| 237 bsf is_bailout ; begin bailout mode | |
| 238 call customview_mask ; update custom view mask to (eventually) rewrite ppO2(Dil): to ppO2: | |
| 239 ;bra do_exit_divemode_menu ; continue with exiting menu code | |
| 240 | |
| 241 do_exit_divemode_menu: | |
| 242 extern timeout_divemode_menu2 | |
| 243 call timeout_divemode_menu2 | |
| 244 clrf STKPTR | |
| 245 extern diveloop_loop4 | |
| 246 goto diveloop_loop4 | |
| 247 | |
| 248 | |
|
403
6e60012bb3fc
NEW: "Lost Gas" feature allows disabling gases during the dive
heinrichsweikamp
parents:
401
diff
changeset
|
249 do_toggle_active: |
| 560 | 250 extern restart_deco_engine_wo_ceiling |
| 251 call restart_deco_engine_wo_ceiling | |
|
511
7db10ebae205
BUGFIX: Lost Diluent now possible in CCR and PSCR mode
heinrichsweikamp
parents:
502
diff
changeset
|
252 movlw .5 |
| 560 | 253 btfsc ccr_diluent_setup ; diluents? |
| 578 | 254 addwf menupos,F ; yes 1-5 -> 6-10 |
| 255 decf menupos,W ; -> 0-4 for gases / 5-9 for diluents | |
|
403
6e60012bb3fc
NEW: "Lost Gas" feature allows disabling gases during the dive
heinrichsweikamp
parents:
401
diff
changeset
|
256 lfsr FSR1,opt_gas_type+0 |
|
6e60012bb3fc
NEW: "Lost Gas" feature allows disabling gases during the dive
heinrichsweikamp
parents:
401
diff
changeset
|
257 movff PLUSW1,lo |
| 578 | 258 tstfsz lo ; Already disabled? |
| 560 | 259 bra do_toggle_active2 ; No, disable now! |
| 578 | 260 lfsr FSR1,opt_gas_type_backup+0 ; copy opt_gas_type_backup+W back to opt_gas_type+W |
|
403
6e60012bb3fc
NEW: "Lost Gas" feature allows disabling gases during the dive
heinrichsweikamp
parents:
401
diff
changeset
|
261 movff PLUSW1,lo |
|
6e60012bb3fc
NEW: "Lost Gas" feature allows disabling gases during the dive
heinrichsweikamp
parents:
401
diff
changeset
|
262 lfsr FSR1,opt_gas_type+0 |
|
6e60012bb3fc
NEW: "Lost Gas" feature allows disabling gases during the dive
heinrichsweikamp
parents:
401
diff
changeset
|
263 movff lo,PLUSW1 |
| 578 | 264 ; btfsc ccr_diluent_setup ; diluents? |
| 265 ; bra do_toggle_active3 ; Yes, ignore restoring change depth (Work-around for potential issue) mH | |
| 560 | 266 lfsr FSR1,opt_OC_bail_gas_change_backup+0 ; copy opt_OC_bail_gas_change_backup+W back to opt_OC_bail_gas_change+W |
|
403
6e60012bb3fc
NEW: "Lost Gas" feature allows disabling gases during the dive
heinrichsweikamp
parents:
401
diff
changeset
|
267 movff PLUSW1,lo |
| 578 | 268 lfsr FSR1,opt_OC_bail_gas_change+0 |
|
403
6e60012bb3fc
NEW: "Lost Gas" feature allows disabling gases during the dive
heinrichsweikamp
parents:
401
diff
changeset
|
269 movff lo,PLUSW1 |
| 578 | 270 bra do_toggle_active3 |
| 560 | 271 do_toggle_active2: |
| 578 | 272 ; btfsc ccr_diluent_setup ; diluents? |
| 273 ; bra do_toggle_active3 ; Yes, ignore restoring change depth (Work-around for potential issue) mH | |
| 274 clrf PLUSW1 ; 0=Disabled, 1=First, 2=Travel, 3=Deco | |
| 560 | 275 lfsr FSR1,opt_OC_bail_gas_change+0 |
| 578 | 276 clrf PLUSW1 ; also delete change depth here to have the menu updated immediately |
| 560 | 277 do_toggle_active3: |
|
511
7db10ebae205
BUGFIX: Lost Diluent now possible in CCR and PSCR mode
heinrichsweikamp
parents:
502
diff
changeset
|
278 movlw .5 |
| 560 | 279 btfsc ccr_diluent_setup ; use OC gases? |
| 578 | 280 subwf menupos,F ; Back to 1-5 |
| 560 | 281 bra do_lost_gas_loop ; Return to list and show updated result |
|
511
7db10ebae205
BUGFIX: Lost Diluent now possible in CCR and PSCR mode
heinrichsweikamp
parents:
502
diff
changeset
|
282 |
| 0 | 283 |
| 284 do_dive_pO2: | |
| 560 | 285 banksel gas6_O2_ratio |
| 286 incf gas6_O2_ratio,F ; O2++ | |
| 287 movf gas6_He_ratio,W | |
| 288 addwf gas6_O2_ratio,W | |
| 289 movwf gas6_temp | |
| 290 movlw .101 | |
| 291 cpfslt gas6_temp ; O2+He<101? | |
| 292 decf gas6_O2_ratio,F ; O2-- (Unchanged) | |
| 293 banksel common | |
| 294 bra do_divemode_gaslist_more_loop | |
| 295 | |
| 0 | 296 do_dive_mO2: |
| 560 | 297 banksel gas6_O2_ratio |
| 298 decf gas6_O2_ratio,F ; O2-- | |
| 299 movlw gaslist_min_o2 | |
| 300 cpfslt gas6_O2_ratio | |
| 301 bra do_dive_mO2_done | |
| 302 movlw gaslist_min_o2 | |
| 303 movwf gas6_O2_ratio | |
| 304 do_dive_mO2_done: | |
| 305 banksel common | |
| 306 bra do_divemode_gaslist_more_loop | |
| 0 | 307 |
| 308 do_dive_pHe: | |
| 560 | 309 banksel gas6_O2_ratio |
| 310 incf gas6_He_ratio,F ; He++ | |
| 311 movf gas6_He_ratio,W | |
| 312 addwf gas6_O2_ratio,W | |
| 313 movwf lo | |
| 314 movlw .101 | |
| 315 cpfslt lo ; O2+He<101? | |
| 316 decf gas6_He_ratio,F ; Yes, He-- (Unchanged) | |
| 317 banksel common | |
| 318 bra do_divemode_gaslist_more_loop | |
| 0 | 319 |
| 320 do_dive_mHe: | |
| 560 | 321 banksel gas6_O2_ratio |
| 322 decf gas6_He_ratio,F ; He-- | |
| 323 bnn do_dive_mHe_done | |
| 324 clrf gas6_He_ratio | |
| 325 do_dive_mHe_done: | |
| 326 banksel common | |
| 327 bra do_divemode_gaslist_more_loop | |
| 0 | 328 |
| 329 do_divemode_splist: | |
| 560 | 330 bsf short_gas_decriptions |
| 331 movlw .1 | |
| 332 movwf menupos ; Set to first option in divemode menu | |
| 333 | |
| 334 movf hardware_flag,W | |
| 335 sublw 0x11 ; 2 with BLE | |
| 336 btfsc STATUS,Z | |
| 337 bra do_divemode_splist_no_sensor ; no sensor | |
| 338 movf hardware_flag,W | |
| 339 sublw 0x13 ; + | |
| 340 btfsc STATUS,Z | |
| 341 bra do_divemode_splist_no_sensor ; no sensor | |
| 342 | |
| 343 do_divemode_splist_with_sensor: | |
| 0 | 344 MENU_BEGIN tGaslist, .6 |
| 345 MENU_DYNAMIC gaslist_strcat_setpoint, do_switch_sp | |
| 346 MENU_DYNAMIC gaslist_strcat_setpoint, do_switch_sp | |
| 347 MENU_DYNAMIC gaslist_strcat_setpoint, do_switch_sp | |
| 348 MENU_DYNAMIC gaslist_strcat_setpoint, do_switch_sp | |
| 349 MENU_DYNAMIC gaslist_strcat_setpoint, do_switch_sp | |
| 560 | 350 MENU_CALL tCCRSensor, do_divemode_sensor |
| 0 | 351 MENU_END |
| 352 | |
| 560 | 353 do_divemode_splist_no_sensor: |
| 249 | 354 MENU_BEGIN tGaslist, .5 |
| 355 MENU_DYNAMIC gaslist_strcat_setpoint, do_switch_sp | |
| 356 MENU_DYNAMIC gaslist_strcat_setpoint, do_switch_sp | |
| 357 MENU_DYNAMIC gaslist_strcat_setpoint, do_switch_sp | |
| 358 MENU_DYNAMIC gaslist_strcat_setpoint, do_switch_sp | |
| 359 MENU_DYNAMIC gaslist_strcat_setpoint, do_switch_sp | |
| 360 MENU_END | |
| 361 | |
| 362 | |
| 0 | 363 do_divemode_sensor: |
| 560 | 364 clrf menupos3 ; show customview 1 (HUD Data) |
| 365 bsf toggle_customview | |
| 0 | 366 movlw .1 |
| 560 | 367 movwf menupos ; Set to 1st option: use sensors |
| 368 do_divemode_sensor_loop: | |
| 369 MENU_BEGIN tGaslist, .6 | |
| 370 MENU_CALL tDivemenu_UseSensor, do_switch_sensor | |
| 371 MENU_CALL tBack, do_divemode_splist | |
| 564 | 372 MENU_CALL tExit, do_exit_divemode_menu |
| 560 | 373 MENU_CALL tDiveHudMask1, do_toggle_sensor |
| 374 MENU_CALL tDiveHudMask2, do_toggle_sensor | |
| 375 MENU_CALL tDiveHudMask3, do_toggle_sensor | |
| 0 | 376 MENU_END |
| 377 | |
| 560 | 378 do_divemode_setpoint_pscr: |
| 0 | 379 movlw .1 |
| 560 | 380 movwf menupos ; Set to 1st option: use calculated ppO2 |
| 381 MENU_BEGIN tGaslist, .6 | |
| 382 MENU_CALL tCalculated, do_switch_sp_calc | |
| 383 MENU_CALL tDivemenu_UseSensor, do_switch_sensor | |
| 0 | 384 MENU_CALL tExit, do_continue_main_divemenu |
| 560 | 385 MENU_CALL tDiveHudMask1, do_toggle_sensor |
| 386 MENU_CALL tDiveHudMask2, do_toggle_sensor | |
| 387 MENU_CALL tDiveHudMask3, do_toggle_sensor | |
| 0 | 388 MENU_END |
| 389 | |
| 560 | 390 do_toggle_sensor: |
| 564 | 391 movff menupos,lo ; backup position |
| 560 | 392 decf menupos,f ; 4, 5, 6 -> 3, 4, 5 |
| 393 decf menupos,f ; 3, 4, 5 -> 2, 3, 4 | |
| 394 decf menupos,f ; 2, 3, 4 -> 1, 2, 3 | |
| 564 | 395 dcfsnz menupos ; 1, 2, 3 -> 0, 1, 2 |
| 560 | 396 btg use_O2_sensor1 ; = |
| 397 dcfsnz menupos ; 0, 1, 2 -> -1, 0, 1 | |
| 398 btg use_O2_sensor2 ; = | |
| 399 dcfsnz menupos ; -1,0, 1 -> -2,-1, 0 | |
| 400 btg use_O2_sensor3 ; = | |
| 564 | 401 movff lo,menupos ; reload position |
| 560 | 402 bra do_divemode_sensor_loop |
| 403 | |
| 404 | |
| 0 | 405 END |