Mercurial > public > hwos_code
annotate src/divemenu_tree.asm @ 580:1ab93aca7fa9
2.97 work...
author | heinrichsweikamp |
---|---|
date | Wed, 21 Feb 2018 19:30:28 +0100 |
parents | e6d5a1f02daf |
children | b455b31ce022 |
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 |
560 | 264 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
|
265 movff PLUSW1,lo |
578 | 266 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
|
267 movff lo,PLUSW1 |
578 | 268 bra do_toggle_active3 |
560 | 269 do_toggle_active2: |
578 | 270 clrf PLUSW1 ; 0=Disabled, 1=First, 2=Travel, 3=Deco |
560 | 271 lfsr FSR1,opt_OC_bail_gas_change+0 |
578 | 272 clrf PLUSW1 ; also delete change depth here to have the menu updated immediately |
560 | 273 do_toggle_active3: |
511
7db10ebae205
BUGFIX: Lost Diluent now possible in CCR and PSCR mode
heinrichsweikamp
parents:
502
diff
changeset
|
274 movlw .5 |
560 | 275 btfsc ccr_diluent_setup ; use OC gases? |
578 | 276 subwf menupos,F ; Back to 1-5 |
560 | 277 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
|
278 |
0 | 279 |
280 do_dive_pO2: | |
560 | 281 banksel gas6_O2_ratio |
282 incf gas6_O2_ratio,F ; O2++ | |
283 movf gas6_He_ratio,W | |
284 addwf gas6_O2_ratio,W | |
285 movwf gas6_temp | |
286 movlw .101 | |
287 cpfslt gas6_temp ; O2+He<101? | |
288 decf gas6_O2_ratio,F ; O2-- (Unchanged) | |
289 banksel common | |
290 bra do_divemode_gaslist_more_loop | |
291 | |
0 | 292 do_dive_mO2: |
560 | 293 banksel gas6_O2_ratio |
294 decf gas6_O2_ratio,F ; O2-- | |
295 movlw gaslist_min_o2 | |
296 cpfslt gas6_O2_ratio | |
297 bra do_dive_mO2_done | |
298 movlw gaslist_min_o2 | |
299 movwf gas6_O2_ratio | |
300 do_dive_mO2_done: | |
301 banksel common | |
302 bra do_divemode_gaslist_more_loop | |
0 | 303 |
304 do_dive_pHe: | |
560 | 305 banksel gas6_O2_ratio |
306 incf gas6_He_ratio,F ; He++ | |
307 movf gas6_He_ratio,W | |
308 addwf gas6_O2_ratio,W | |
309 movwf lo | |
310 movlw .101 | |
311 cpfslt lo ; O2+He<101? | |
312 decf gas6_He_ratio,F ; Yes, He-- (Unchanged) | |
313 banksel common | |
314 bra do_divemode_gaslist_more_loop | |
0 | 315 |
316 do_dive_mHe: | |
560 | 317 banksel gas6_O2_ratio |
318 decf gas6_He_ratio,F ; He-- | |
319 bnn do_dive_mHe_done | |
320 clrf gas6_He_ratio | |
321 do_dive_mHe_done: | |
322 banksel common | |
323 bra do_divemode_gaslist_more_loop | |
0 | 324 |
325 do_divemode_splist: | |
560 | 326 bsf short_gas_decriptions |
327 movlw .1 | |
328 movwf menupos ; Set to first option in divemode menu | |
329 | |
330 movf hardware_flag,W | |
331 sublw 0x11 ; 2 with BLE | |
332 btfsc STATUS,Z | |
333 bra do_divemode_splist_no_sensor ; no sensor | |
334 movf hardware_flag,W | |
335 sublw 0x13 ; + | |
336 btfsc STATUS,Z | |
337 bra do_divemode_splist_no_sensor ; no sensor | |
338 | |
339 do_divemode_splist_with_sensor: | |
0 | 340 MENU_BEGIN tGaslist, .6 |
341 MENU_DYNAMIC gaslist_strcat_setpoint, do_switch_sp | |
342 MENU_DYNAMIC gaslist_strcat_setpoint, do_switch_sp | |
343 MENU_DYNAMIC gaslist_strcat_setpoint, do_switch_sp | |
344 MENU_DYNAMIC gaslist_strcat_setpoint, do_switch_sp | |
345 MENU_DYNAMIC gaslist_strcat_setpoint, do_switch_sp | |
560 | 346 MENU_CALL tCCRSensor, do_divemode_sensor |
0 | 347 MENU_END |
348 | |
560 | 349 do_divemode_splist_no_sensor: |
249 | 350 MENU_BEGIN tGaslist, .5 |
351 MENU_DYNAMIC gaslist_strcat_setpoint, do_switch_sp | |
352 MENU_DYNAMIC gaslist_strcat_setpoint, do_switch_sp | |
353 MENU_DYNAMIC gaslist_strcat_setpoint, do_switch_sp | |
354 MENU_DYNAMIC gaslist_strcat_setpoint, do_switch_sp | |
355 MENU_DYNAMIC gaslist_strcat_setpoint, do_switch_sp | |
356 MENU_END | |
357 | |
358 | |
0 | 359 do_divemode_sensor: |
560 | 360 clrf menupos3 ; show customview 1 (HUD Data) |
361 bsf toggle_customview | |
0 | 362 movlw .1 |
560 | 363 movwf menupos ; Set to 1st option: use sensors |
364 do_divemode_sensor_loop: | |
365 MENU_BEGIN tGaslist, .6 | |
366 MENU_CALL tDivemenu_UseSensor, do_switch_sensor | |
367 MENU_CALL tBack, do_divemode_splist | |
564 | 368 MENU_CALL tExit, do_exit_divemode_menu |
560 | 369 MENU_CALL tDiveHudMask1, do_toggle_sensor |
370 MENU_CALL tDiveHudMask2, do_toggle_sensor | |
371 MENU_CALL tDiveHudMask3, do_toggle_sensor | |
0 | 372 MENU_END |
373 | |
560 | 374 do_divemode_setpoint_pscr: |
0 | 375 movlw .1 |
560 | 376 movwf menupos ; Set to 1st option: use calculated ppO2 |
377 MENU_BEGIN tGaslist, .6 | |
378 MENU_CALL tCalculated, do_switch_sp_calc | |
379 MENU_CALL tDivemenu_UseSensor, do_switch_sensor | |
0 | 380 MENU_CALL tExit, do_continue_main_divemenu |
560 | 381 MENU_CALL tDiveHudMask1, do_toggle_sensor |
382 MENU_CALL tDiveHudMask2, do_toggle_sensor | |
383 MENU_CALL tDiveHudMask3, do_toggle_sensor | |
0 | 384 MENU_END |
385 | |
560 | 386 do_toggle_sensor: |
564 | 387 movff menupos,lo ; backup position |
560 | 388 decf menupos,f ; 4, 5, 6 -> 3, 4, 5 |
389 decf menupos,f ; 3, 4, 5 -> 2, 3, 4 | |
390 decf menupos,f ; 2, 3, 4 -> 1, 2, 3 | |
564 | 391 dcfsnz menupos ; 1, 2, 3 -> 0, 1, 2 |
560 | 392 btg use_O2_sensor1 ; = |
393 dcfsnz menupos ; 0, 1, 2 -> -1, 0, 1 | |
394 btg use_O2_sensor2 ; = | |
395 dcfsnz menupos ; -1,0, 1 -> -2,-1, 0 | |
396 btg use_O2_sensor3 ; = | |
564 | 397 movff lo,menupos ; reload position |
560 | 398 bra do_divemode_sensor_loop |
399 | |
400 | |
0 | 401 END |