annotate src/divemode.asm @ 120:e2f04bb2539c

battery check in sleep
author heinrichsweikamp
date Fri, 27 Jun 2014 15:52:43 +0200 (2014-06-27)
parents f3062a611eef
children 35b9da423de6
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
0
heinrichsweikamp
parents:
diff changeset
1 ;=============================================================================
heinrichsweikamp
parents:
diff changeset
2 ;
heinrichsweikamp
parents:
diff changeset
3 ; File divemode.asm
heinrichsweikamp
parents:
diff changeset
4 ;
heinrichsweikamp
parents:
diff changeset
5 ; Divemode
heinrichsweikamp
parents:
diff changeset
6 ;
heinrichsweikamp
parents:
diff changeset
7 ; Copyright (c) 2011, JD Gascuel, HeinrichsWeikamp, all right reserved.
heinrichsweikamp
parents:
diff changeset
8 ;=============================================================================
heinrichsweikamp
parents:
diff changeset
9 ; HISTORY
heinrichsweikamp
parents:
diff changeset
10 ; 2011-08-15 : [mH] moving from OSTC code
heinrichsweikamp
parents:
diff changeset
11
heinrichsweikamp
parents:
diff changeset
12 #include "ostc3.inc" ; Mandatory header
heinrichsweikamp
parents:
diff changeset
13 #include "shared_definitions.h" ; Mailbox from/to p2_deco.c
heinrichsweikamp
parents:
diff changeset
14 #include "tft_outputs.inc"
heinrichsweikamp
parents:
diff changeset
15 #include "strings.inc"
heinrichsweikamp
parents:
diff changeset
16 #include "tft.inc"
heinrichsweikamp
parents:
diff changeset
17 #include "eeprom_rs232.inc"
heinrichsweikamp
parents:
diff changeset
18 #include "isr.inc"
heinrichsweikamp
parents:
diff changeset
19 #include "math.inc"
heinrichsweikamp
parents:
diff changeset
20 #include "wait.inc"
heinrichsweikamp
parents:
diff changeset
21 #include "customview.inc"
heinrichsweikamp
parents:
diff changeset
22 #include "start.inc"
heinrichsweikamp
parents:
diff changeset
23 #include "adc_lightsensor.inc"
heinrichsweikamp
parents:
diff changeset
24 #include "ghostwriter.inc"
heinrichsweikamp
parents:
diff changeset
25 #include "i2c.inc"
113
heinrichsweikamp
parents: 111
diff changeset
26 #include "calibrate.inc"
0
heinrichsweikamp
parents:
diff changeset
27
heinrichsweikamp
parents:
diff changeset
28 gui CODE
heinrichsweikamp
parents:
diff changeset
29
heinrichsweikamp
parents:
diff changeset
30 global diveloop
heinrichsweikamp
parents:
diff changeset
31 diveloop:
heinrichsweikamp
parents:
diff changeset
32 banksel common
heinrichsweikamp
parents:
diff changeset
33 call speed_normal
heinrichsweikamp
parents:
diff changeset
34 call diveloop_boot ; Boot tasks for all modes
heinrichsweikamp
parents:
diff changeset
35
heinrichsweikamp
parents:
diff changeset
36 ; Startup Tasks for all modes
heinrichsweikamp
parents:
diff changeset
37 call TFT_ClearScreen ; clean up TFT
heinrichsweikamp
parents:
diff changeset
38 call TFT_divemode_mask ; Display mask
heinrichsweikamp
parents:
diff changeset
39 call TFT_temp_divemode ; Displays temperature
39
e4e91fe8b09d remember last customview in dive and surface mode
mh@mh-THINK.fritz.box
parents: 38
diff changeset
40 movff customview_divemode,menupos3 ; Reload last customview
e4e91fe8b09d remember last customview in dive and surface mode
mh@mh-THINK.fritz.box
parents: 38
diff changeset
41 call customview_mask ; Redraw last custom view
0
heinrichsweikamp
parents:
diff changeset
42
heinrichsweikamp
parents:
diff changeset
43 btfsc FLAG_apnoe_mode
heinrichsweikamp
parents:
diff changeset
44 bsf realdive ; Set Realdive flag in Apnoe mode
heinrichsweikamp
parents:
diff changeset
45
heinrichsweikamp
parents:
diff changeset
46 btfsc FLAG_apnoe_mode ; Done for Apnoe or Gauge mode
heinrichsweikamp
parents:
diff changeset
47 bra diveloop_loop
heinrichsweikamp
parents:
diff changeset
48 btfsc FLAG_gauge_mode ; Done for Apnoe or Gauge mode
heinrichsweikamp
parents:
diff changeset
49 bra diveloop_loop
heinrichsweikamp
parents:
diff changeset
50
heinrichsweikamp
parents:
diff changeset
51 call TFT_active_gas_divemode ; Display gas/Setpoint
heinrichsweikamp
parents:
diff changeset
52 call TFT_display_ndl_mask ; display "NDL"
heinrichsweikamp
parents:
diff changeset
53
heinrichsweikamp
parents:
diff changeset
54 ; +@5 init
heinrichsweikamp
parents:
diff changeset
55 setf WREG ; WAIT marker: display "---"
heinrichsweikamp
parents:
diff changeset
56 movff WREG,int_O_extra_ascenttime+0
heinrichsweikamp
parents:
diff changeset
57 movff WREG,int_O_extra_ascenttime+1
heinrichsweikamp
parents:
diff changeset
58 movlw 1
heinrichsweikamp
parents:
diff changeset
59 movwf apnoe_mins ; Start compute after next cycle.
heinrichsweikamp
parents:
diff changeset
60
heinrichsweikamp
parents:
diff changeset
61 ;--------------------------------------------------------------------------------------------------------
heinrichsweikamp
parents:
diff changeset
62 diveloop_loop: ; The diveloop starts here
heinrichsweikamp
parents:
diff changeset
63 btfss onesecupdate
heinrichsweikamp
parents:
diff changeset
64 bra diveloop_loop3
heinrichsweikamp
parents:
diff changeset
65
heinrichsweikamp
parents:
diff changeset
66 ; tasks any new second...
heinrichsweikamp
parents:
diff changeset
67 btfsc FLAG_apnoe_mode ; Only in apnoe mode
heinrichsweikamp
parents:
diff changeset
68 bra diveloop_loop1b ; One Second Tasks in Apnoe mode
heinrichsweikamp
parents:
diff changeset
69
heinrichsweikamp
parents:
diff changeset
70 call TFT_divemins ; Display (new) divetime!
heinrichsweikamp
parents:
diff changeset
71 call customview_second ; Do every-second tasks for the custom view area
heinrichsweikamp
parents:
diff changeset
72
heinrichsweikamp
parents:
diff changeset
73 ; Tasks only for deco modes
104
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
74 btfsc show_safety_stop ; Show the safety stop?
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
75 call TFT_show_safety_stop ; Yes, show/delete if done.
0
heinrichsweikamp
parents:
diff changeset
76 call calc_deko_divemode ; calculate decompression and display result (any two seconds)
heinrichsweikamp
parents:
diff changeset
77 bra diveloop_loop1x ; Common Tasks
heinrichsweikamp
parents:
diff changeset
78
heinrichsweikamp
parents:
diff changeset
79 diveloop_loop1b:
heinrichsweikamp
parents:
diff changeset
80 ; Tasks only for Apnoe mode
heinrichsweikamp
parents:
diff changeset
81 call divemode_apnoe_tasks ; 1 sec. Apnoe tasks
heinrichsweikamp
parents:
diff changeset
82 bra diveloop_loop1x ; Common Tasks
heinrichsweikamp
parents:
diff changeset
83
heinrichsweikamp
parents:
diff changeset
84 diveloop_loop1x:
heinrichsweikamp
parents:
diff changeset
85 ; Common 1sec. tasks for all modes
heinrichsweikamp
parents:
diff changeset
86 call timeout_divemode ; dive finished? This routine sets the required flags
heinrichsweikamp
parents:
diff changeset
87 call set_dive_modes ; tests if depth>threshold
heinrichsweikamp
parents:
diff changeset
88 call set_min_temp ; store min. temp if required
heinrichsweikamp
parents:
diff changeset
89
heinrichsweikamp
parents:
diff changeset
90 btfsc store_sample ; store new sample?
heinrichsweikamp
parents:
diff changeset
91 call store_dive_data ; Store profile data
heinrichsweikamp
parents:
diff changeset
92
heinrichsweikamp
parents:
diff changeset
93 btfss divemode ; Dive finished?
heinrichsweikamp
parents:
diff changeset
94 goto ghostwriter_end_dive ; Dive finished!
heinrichsweikamp
parents:
diff changeset
95
heinrichsweikamp
parents:
diff changeset
96 btfsc divemode_gaschange ; Gas switch flag set?
heinrichsweikamp
parents:
diff changeset
97 rcall gas_switched_common ; Yes
heinrichsweikamp
parents:
diff changeset
98
heinrichsweikamp
parents:
diff changeset
99 btfsc toggle_gf ; =1: Toggle GF/aGF
heinrichsweikamp
parents:
diff changeset
100 rcall divemodemode_togglegf ; Toggle aGF/GF
heinrichsweikamp
parents:
diff changeset
101
heinrichsweikamp
parents:
diff changeset
102 ; btfsc FLAG_ccr_mode ; In CCR mode
heinrichsweikamp
parents:
diff changeset
103 ; call TFT_active_gas_divemode ; Update Setpoint every second
heinrichsweikamp
parents:
diff changeset
104
113
heinrichsweikamp
parents: 111
diff changeset
105 call compute_ppo2 ; compute mv_sensorX and ppo2_sensorX arrays
heinrichsweikamp
parents: 111
diff changeset
106
0
heinrichsweikamp
parents:
diff changeset
107 bcf onesecupdate ; one seconds update done
heinrichsweikamp
parents:
diff changeset
108
heinrichsweikamp
parents:
diff changeset
109 diveloop_loop3:
heinrichsweikamp
parents:
diff changeset
110 rcall test_switches_divemode ; Check switches in divemode
heinrichsweikamp
parents:
diff changeset
111
heinrichsweikamp
parents:
diff changeset
112 global diveloop_loop4
heinrichsweikamp
parents:
diff changeset
113 diveloop_loop4: ; Menu-Exit returns here...
heinrichsweikamp
parents:
diff changeset
114 btfsc toggle_customview ; Next view?
heinrichsweikamp
parents:
diff changeset
115 call customview_toggle ; Yes, show next customview (and delete this flag)
heinrichsweikamp
parents:
diff changeset
116
heinrichsweikamp
parents:
diff changeset
117 btfsc pressure_refresh ; new pressure available?
heinrichsweikamp
parents:
diff changeset
118 rcall update_temp_and_or_depth ; Yes, display new depth and clear "pressure_refresh" flag
heinrichsweikamp
parents:
diff changeset
119
heinrichsweikamp
parents:
diff changeset
120 btfsc oneminupdate ; one minute tasks
heinrichsweikamp
parents:
diff changeset
121 rcall update_divemode60 ; Update clock, etc.
heinrichsweikamp
parents:
diff changeset
122
heinrichsweikamp
parents:
diff changeset
123 btfss quarter_second_update
heinrichsweikamp
parents:
diff changeset
124 bra diveloop_loop4a
83
eb72c8865f47 Test with graphic compass
heinrichsweikamp
parents: 69
diff changeset
125
0
heinrichsweikamp
parents:
diff changeset
126 bcf quarter_second_update
heinrichsweikamp
parents:
diff changeset
127 movlw .6
heinrichsweikamp
parents:
diff changeset
128 cpfseq menupos3 ; in compass view?
heinrichsweikamp
parents:
diff changeset
129 bra diveloop_loop4a ; No
heinrichsweikamp
parents:
diff changeset
130 call TFT_dive_compass_heading ; Yes, update compass heading value
heinrichsweikamp
parents:
diff changeset
131 diveloop_loop4a:
heinrichsweikamp
parents:
diff changeset
132 btfsc enable_screen_dumps ; =1: Ignore vin_usb, wait for "l" command (Screen dump)
heinrichsweikamp
parents:
diff changeset
133 bra diveloop_loop5
heinrichsweikamp
parents:
diff changeset
134 bra diveloop_loop6
heinrichsweikamp
parents:
diff changeset
135 diveloop_loop5:
heinrichsweikamp
parents:
diff changeset
136 btfss vusb_in ; USB (still) plugged in?
heinrichsweikamp
parents:
diff changeset
137 bcf enable_screen_dumps ; No, clear flag
heinrichsweikamp
parents:
diff changeset
138 call rs232_get_byte
heinrichsweikamp
parents:
diff changeset
139 btfsc rs232_recieve_overflow
heinrichsweikamp
parents:
diff changeset
140 bra diveloop_loop6
heinrichsweikamp
parents:
diff changeset
141 movlw "l"
heinrichsweikamp
parents:
diff changeset
142 cpfseq RCREG1
heinrichsweikamp
parents:
diff changeset
143 bra diveloop_loop6
heinrichsweikamp
parents:
diff changeset
144 call TFT_dump_screen ; Dump the screen contents
heinrichsweikamp
parents:
diff changeset
145 diveloop_loop6:
heinrichsweikamp
parents:
diff changeset
146
heinrichsweikamp
parents:
diff changeset
147 bra diveloop_loop ; Loop the divemode
heinrichsweikamp
parents:
diff changeset
148 ;--------------------------------------------------------------------------------------------------------
heinrichsweikamp
parents:
diff changeset
149
heinrichsweikamp
parents:
diff changeset
150
heinrichsweikamp
parents:
diff changeset
151 divemode_apnoe_tasks: ; 1 sec. Apnoe tasks
heinrichsweikamp
parents:
diff changeset
152 call TFT_display_apnoe_descent ; Show descent timer
heinrichsweikamp
parents:
diff changeset
153 call TFT_max_pressure ; use normal max. depth
heinrichsweikamp
parents:
diff changeset
154
heinrichsweikamp
parents:
diff changeset
155 btfsc divemode2 ; Time running?
heinrichsweikamp
parents:
diff changeset
156 bra divemode_apnoe_tasks2 ; New descent, reset data if flag is set
heinrichsweikamp
parents:
diff changeset
157
heinrichsweikamp
parents:
diff changeset
158 rcall apnoe_calc_maxdepth
heinrichsweikamp
parents:
diff changeset
159 call TFT_display_apnoe_surface
heinrichsweikamp
parents:
diff changeset
160 call TFT_display_apnoe_last_max ; Show last max. depth
heinrichsweikamp
parents:
diff changeset
161 incf apnoe_surface_secs,F
heinrichsweikamp
parents:
diff changeset
162 movlw d'60'
heinrichsweikamp
parents:
diff changeset
163 cpfseq apnoe_surface_secs
heinrichsweikamp
parents:
diff changeset
164 bra divemode_apnoe_tasks1
heinrichsweikamp
parents:
diff changeset
165 clrf apnoe_surface_secs
heinrichsweikamp
parents:
diff changeset
166 incf apnoe_surface_mins,F
heinrichsweikamp
parents:
diff changeset
167
heinrichsweikamp
parents:
diff changeset
168 divemode_apnoe_tasks1:
heinrichsweikamp
parents:
diff changeset
169 bcf FLAG_active_descent ; Clear flag
heinrichsweikamp
parents:
diff changeset
170 btfsc divemode2 ; Time running?
heinrichsweikamp
parents:
diff changeset
171 return ; Yes, return
heinrichsweikamp
parents:
diff changeset
172 bsf FLAG_active_descent ; Set Flag
heinrichsweikamp
parents:
diff changeset
173 return
heinrichsweikamp
parents:
diff changeset
174
heinrichsweikamp
parents:
diff changeset
175 divemode_apnoe_tasks2:
heinrichsweikamp
parents:
diff changeset
176 btfss FLAG_active_descent ; Are we descending?
heinrichsweikamp
parents:
diff changeset
177 return ; No, We are at the surface
heinrichsweikamp
parents:
diff changeset
178 rcall apnoe_calc_maxdepth ; Yes!
heinrichsweikamp
parents:
diff changeset
179 call TFT_apnoe_clear_surface ; Clear Surface timer
heinrichsweikamp
parents:
diff changeset
180 clrf apnoe_timeout_counter ; Delete timeout
heinrichsweikamp
parents:
diff changeset
181 clrf apnoe_surface_secs
heinrichsweikamp
parents:
diff changeset
182 clrf apnoe_surface_mins
heinrichsweikamp
parents:
diff changeset
183 clrf apnoe_secs
heinrichsweikamp
parents:
diff changeset
184 clrf apnoe_mins ; Reset Descent time
heinrichsweikamp
parents:
diff changeset
185 movlw .0
heinrichsweikamp
parents:
diff changeset
186 movff WREG,max_pressure+0
heinrichsweikamp
parents:
diff changeset
187 movff WREG,max_pressure+1 ; Reset Max. Depth
heinrichsweikamp
parents:
diff changeset
188 bcf FLAG_active_descent ; Clear flag
heinrichsweikamp
parents:
diff changeset
189 return
heinrichsweikamp
parents:
diff changeset
190
heinrichsweikamp
parents:
diff changeset
191 global apnoe_calc_maxdepth
heinrichsweikamp
parents:
diff changeset
192 apnoe_calc_maxdepth:
heinrichsweikamp
parents:
diff changeset
193 movff apnoe_max_pressure+0,sub_a+0
heinrichsweikamp
parents:
diff changeset
194 movff apnoe_max_pressure+1,sub_a+1
heinrichsweikamp
parents:
diff changeset
195 movff max_pressure+0,sub_b+0
heinrichsweikamp
parents:
diff changeset
196 movff max_pressure+1,sub_b+1
heinrichsweikamp
parents:
diff changeset
197 call subU16 ; sub_c = sub_a - sub_b
heinrichsweikamp
parents:
diff changeset
198 ; apnoe_max_pressure<max_pressure -> neg_flag=1
heinrichsweikamp
parents:
diff changeset
199 ; max_pressure<=apnoe_max_pressure -> neg_flag=0
heinrichsweikamp
parents:
diff changeset
200 btfss neg_flag
heinrichsweikamp
parents:
diff changeset
201 return
heinrichsweikamp
parents:
diff changeset
202 ;apnoe_max_pressure<max_pressure
heinrichsweikamp
parents:
diff changeset
203 movff max_pressure+0,apnoe_max_pressure+0
heinrichsweikamp
parents:
diff changeset
204 movff max_pressure+1,apnoe_max_pressure+1
heinrichsweikamp
parents:
diff changeset
205 return
heinrichsweikamp
parents:
diff changeset
206
heinrichsweikamp
parents:
diff changeset
207
heinrichsweikamp
parents:
diff changeset
208 calc_deko_divemode:
heinrichsweikamp
parents:
diff changeset
209 btfsc twosecupdate ; two seconds after the last call
heinrichsweikamp
parents:
diff changeset
210 bra calc_deko_divemode2 ; Yes, calculate and display deco data ("first second")
heinrichsweikamp
parents:
diff changeset
211
heinrichsweikamp
parents:
diff changeset
212 bsf twosecupdate ; No, but next second!
heinrichsweikamp
parents:
diff changeset
213 ; Routines used in the "other second"
heinrichsweikamp
parents:
diff changeset
214 call calc_average_depth ; calculate average depth
heinrichsweikamp
parents:
diff changeset
215 call calc_velocity ; calculate vertical velocity and display if > threshold (every two seconds)
104
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
216 call divemode_check_for_warnings ; Check for any warnings
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
217 call set_reset_safety_stop ; Set flags for safety stop and/or reset safety stop
0
heinrichsweikamp
parents:
diff changeset
218 call TFT_debug_output
heinrichsweikamp
parents:
diff changeset
219
heinrichsweikamp
parents:
diff changeset
220 btfsc FLAG_apnoe_mode ; Done for Apnoe or Gauge mode
heinrichsweikamp
parents:
diff changeset
221 return
heinrichsweikamp
parents:
diff changeset
222 btfsc FLAG_gauge_mode ; Done for Apnoe or Gauge mode
heinrichsweikamp
parents:
diff changeset
223 return
heinrichsweikamp
parents:
diff changeset
224
heinrichsweikamp
parents:
diff changeset
225 ; Calculate CNS
heinrichsweikamp
parents:
diff changeset
226 rcall set_actual_ppo2 ; Set char_I_actual_ppO2
heinrichsweikamp
parents:
diff changeset
227 clrf WREG
heinrichsweikamp
parents:
diff changeset
228 movff WREG,char_I_step_is_1min ; Make sure to be in 2sec mode.
heinrichsweikamp
parents:
diff changeset
229 call deco_calc_CNS_fraction ; calculate CNS
heinrichsweikamp
parents:
diff changeset
230 movlb b'00000001' ; rambank 1 selected
heinrichsweikamp
parents:
diff changeset
231
heinrichsweikamp
parents:
diff changeset
232 ; Check for a gas change
heinrichsweikamp
parents:
diff changeset
233 rcall check_gas_change ; Checks if a better gas should be selected (by user)
heinrichsweikamp
parents:
diff changeset
234
heinrichsweikamp
parents:
diff changeset
235 return
heinrichsweikamp
parents:
diff changeset
236
heinrichsweikamp
parents:
diff changeset
237 global set_actual_ppo2
heinrichsweikamp
parents:
diff changeset
238 set_actual_ppo2: ; calculate ppO2 in 0.01bar (e.g. 150 = 1.50 bar ppO2)
111
c61b7a4e317c Bugfix: CNS in planner
heinrichsweikamp
parents: 104
diff changeset
239 btfsc divemode ; in divemode
c61b7a4e317c Bugfix: CNS in planner
heinrichsweikamp
parents: 104
diff changeset
240 bra set_actual_ppo2_dive ; Yes
c61b7a4e317c Bugfix: CNS in planner
heinrichsweikamp
parents: 104
diff changeset
241 ; No, use simulated ambient pressure for char_I_actual_ppO2
c61b7a4e317c Bugfix: CNS in planner
heinrichsweikamp
parents: 104
diff changeset
242 movff char_I_bottom_depth,WREG
c61b7a4e317c Bugfix: CNS in planner
heinrichsweikamp
parents: 104
diff changeset
243 mullw .100
c61b7a4e317c Bugfix: CNS in planner
heinrichsweikamp
parents: 104
diff changeset
244 movlw LOW(.1000)
c61b7a4e317c Bugfix: CNS in planner
heinrichsweikamp
parents: 104
diff changeset
245 addwf PRODL,W
c61b7a4e317c Bugfix: CNS in planner
heinrichsweikamp
parents: 104
diff changeset
246 movwf xA+0
c61b7a4e317c Bugfix: CNS in planner
heinrichsweikamp
parents: 104
diff changeset
247 movlw HIGH(.1000)
c61b7a4e317c Bugfix: CNS in planner
heinrichsweikamp
parents: 104
diff changeset
248 addwfc PRODH,W
c61b7a4e317c Bugfix: CNS in planner
heinrichsweikamp
parents: 104
diff changeset
249 movwf xA+1 ; P_amb in millibar (1000 = 1.00 bar).
c61b7a4e317c Bugfix: CNS in planner
heinrichsweikamp
parents: 104
diff changeset
250 bra set_actual_ppo2_common
c61b7a4e317c Bugfix: CNS in planner
heinrichsweikamp
parents: 104
diff changeset
251 set_actual_ppo2_dive:
0
heinrichsweikamp
parents:
diff changeset
252 SAFE_2BYTE_COPY amb_pressure, xA ; P_amb in millibar (1000 = 1.00 bar).
111
c61b7a4e317c Bugfix: CNS in planner
heinrichsweikamp
parents: 104
diff changeset
253 set_actual_ppo2_common:
113
heinrichsweikamp
parents: 111
diff changeset
254 movlw d'10'
0
heinrichsweikamp
parents:
diff changeset
255 movwf xB+0
heinrichsweikamp
parents:
diff changeset
256 clrf xB+1
heinrichsweikamp
parents:
diff changeset
257 call div16x16 ; xC=p_amb/10 (100 = 1.00 bar).
heinrichsweikamp
parents:
diff changeset
258 movff xC+0,xA+0
heinrichsweikamp
parents:
diff changeset
259 movff xC+1,xA+1
heinrichsweikamp
parents:
diff changeset
260 movff char_I_O2_ratio,xB+0
heinrichsweikamp
parents:
diff changeset
261 clrf xB+1
heinrichsweikamp
parents:
diff changeset
262 call mult16x16 ; char_I_O2_ratio * (p_amb/10)
heinrichsweikamp
parents:
diff changeset
263 movff xC+0,xA+0
heinrichsweikamp
parents:
diff changeset
264 movff xC+1,xA+1
heinrichsweikamp
parents:
diff changeset
265 movlw d'100'
heinrichsweikamp
parents:
diff changeset
266 movwf xB+0
heinrichsweikamp
parents:
diff changeset
267 clrf xB+1
heinrichsweikamp
parents:
diff changeset
268 call div16x16 ; xC=(char_I_O2_ratio * p_amb/10)/100
heinrichsweikamp
parents:
diff changeset
269
heinrichsweikamp
parents:
diff changeset
270 ; Copy ppO2 for CNS calculation
heinrichsweikamp
parents:
diff changeset
271 tstfsz xC+1 ; Is ppO2 > 2.55bar ?
heinrichsweikamp
parents:
diff changeset
272 setf xC+0 ; yes: bound to 2.55... better than wrap around.
heinrichsweikamp
parents:
diff changeset
273
heinrichsweikamp
parents:
diff changeset
274 movff xC+0, char_I_actual_ppO2 ; copy last ppO2 to buffer register
heinrichsweikamp
parents:
diff changeset
275 btfsc is_bailout ; In Bailout?
heinrichsweikamp
parents:
diff changeset
276 return ; Yes, done.
heinrichsweikamp
parents:
diff changeset
277 ; No Bailout, check for ccr mode
heinrichsweikamp
parents:
diff changeset
278 btfsc FLAG_ccr_mode ; If FLAG_ccr_mode=1...
heinrichsweikamp
parents:
diff changeset
279 movff char_I_const_ppO2, char_I_actual_ppO2 ; ...copy last ppO2 to buffer register
heinrichsweikamp
parents:
diff changeset
280 return
heinrichsweikamp
parents:
diff changeset
281
heinrichsweikamp
parents:
diff changeset
282
heinrichsweikamp
parents:
diff changeset
283 calc_deko_divemode2:
heinrichsweikamp
parents:
diff changeset
284 bcf twosecupdate
heinrichsweikamp
parents:
diff changeset
285
heinrichsweikamp
parents:
diff changeset
286 btfsc FLAG_apnoe_mode ; Done for Apnoe or Gauge mode
heinrichsweikamp
parents:
diff changeset
287 return
heinrichsweikamp
parents:
diff changeset
288 btfsc FLAG_gauge_mode ; Done for Apnoe or Gauge mode
heinrichsweikamp
parents:
diff changeset
289 return
heinrichsweikamp
parents:
diff changeset
290
heinrichsweikamp
parents:
diff changeset
291 extern deco_setup_dive
heinrichsweikamp
parents:
diff changeset
292 call deco_setup_dive ; Pass all parameters to the C code
heinrichsweikamp
parents:
diff changeset
293
heinrichsweikamp
parents:
diff changeset
294 TSTOSS opt_ccr_mode ; =0: Fixed SP, =1: Sensor
heinrichsweikamp
parents:
diff changeset
295 bra calc_deko_divemode2a
heinrichsweikamp
parents:
diff changeset
296 rcall divemode_setup_sensor_values ; Setup sensor values
heinrichsweikamp
parents:
diff changeset
297
heinrichsweikamp
parents:
diff changeset
298 calc_deko_divemode2a:
heinrichsweikamp
parents:
diff changeset
299 SAFE_2BYTE_COPY amb_pressure,int_I_pres_respiration ; C-code needs the ambient pressure
heinrichsweikamp
parents:
diff changeset
300 clrf WREG
heinrichsweikamp
parents:
diff changeset
301 movff WREG,char_I_step_is_1min ; Force 2 second deco mode
heinrichsweikamp
parents:
diff changeset
302
heinrichsweikamp
parents:
diff changeset
303 clrf TMR5L
heinrichsweikamp
parents:
diff changeset
304 clrf TMR5H ; 30,51757813µs/bit in TMR5L:TMR5H
heinrichsweikamp
parents:
diff changeset
305 call deco_calc_hauptroutine ; calc_tissue
heinrichsweikamp
parents:
diff changeset
306 movlb .1
heinrichsweikamp
parents:
diff changeset
307
heinrichsweikamp
parents:
diff changeset
308 movff char_O_deco_status,WREG ; Is a compute cycle finished ?
heinrichsweikamp
parents:
diff changeset
309 iorwf WREG,F
heinrichsweikamp
parents:
diff changeset
310 btfss STATUS,Z
heinrichsweikamp
parents:
diff changeset
311 return ; Return is status <> 0
heinrichsweikamp
parents:
diff changeset
312
heinrichsweikamp
parents:
diff changeset
313 ; Check if deco stops are necessary ?
heinrichsweikamp
parents:
diff changeset
314 movff char_O_first_deco_depth,wait_temp ; copy ceiling to temp register
heinrichsweikamp
parents:
diff changeset
315 tstfsz wait_temp ; Ceiling<0m?
heinrichsweikamp
parents:
diff changeset
316 bra calc_deko_divemode3 ; Yes!
heinrichsweikamp
parents:
diff changeset
317
heinrichsweikamp
parents:
diff changeset
318 btfsc decostop_active ; Already in nodeco mode ?
heinrichsweikamp
parents:
diff changeset
319 call TFT_display_ndl_mask ; No, Clear deco data, display nostop time
heinrichsweikamp
parents:
diff changeset
320 bcf decostop_active ; clear flag (again)
heinrichsweikamp
parents:
diff changeset
321
heinrichsweikamp
parents:
diff changeset
322 ; Copy for profile recording
heinrichsweikamp
parents:
diff changeset
323 clrf decodata+0
heinrichsweikamp
parents:
diff changeset
324 movff char_O_nullzeit,decodata+1 ; NDL
heinrichsweikamp
parents:
diff changeset
325
heinrichsweikamp
parents:
diff changeset
326 call TFT_display_ndl ; display no deco limit
heinrichsweikamp
parents:
diff changeset
327 return
heinrichsweikamp
parents:
diff changeset
328
heinrichsweikamp
parents:
diff changeset
329 calc_deko_divemode3:
heinrichsweikamp
parents:
diff changeset
330 btfss decostop_active ; Already in deco mode ?
heinrichsweikamp
parents:
diff changeset
331 call TFT_display_deko_mask ; No, clear nostop time, display decodata
heinrichsweikamp
parents:
diff changeset
332 bsf decostop_active ; Set flag (again)
heinrichsweikamp
parents:
diff changeset
333
heinrichsweikamp
parents:
diff changeset
334 ; Copy for profile recording
heinrichsweikamp
parents:
diff changeset
335 movff char_O_first_deco_depth,decodata+0 ; ceiling
heinrichsweikamp
parents:
diff changeset
336 movff char_O_first_deco_time,decodata+1 ; length of first stop in minues
heinrichsweikamp
parents:
diff changeset
337 call TFT_display_deko ; display decodata
heinrichsweikamp
parents:
diff changeset
338 call TFT_show_TTS_divemode ; display TTS
heinrichsweikamp
parents:
diff changeset
339
heinrichsweikamp
parents:
diff changeset
340 movff char_I_extra_time,WREG
heinrichsweikamp
parents:
diff changeset
341 tstfsz WREG ; extra time = 0?
heinrichsweikamp
parents:
diff changeset
342 bra calc_deko_divemode4 ; No, compute it
heinrichsweikamp
parents:
diff changeset
343 return
heinrichsweikamp
parents:
diff changeset
344
heinrichsweikamp
parents:
diff changeset
345 calc_deko_divemode4:
heinrichsweikamp
parents:
diff changeset
346 ; Check if extra cycles are needed to compute @5 variant:
heinrichsweikamp
parents:
diff changeset
347 decfsz apnoe_mins,F ; Reached count-down ?
heinrichsweikamp
parents:
diff changeset
348 return ; No: don't compute yet.
heinrichsweikamp
parents:
diff changeset
349
heinrichsweikamp
parents:
diff changeset
350 movlw .6
heinrichsweikamp
parents:
diff changeset
351 movff WREG,char_O_deco_status ; Stole next cycles for @5 variant.
heinrichsweikamp
parents:
diff changeset
352
heinrichsweikamp
parents:
diff changeset
353 movlw .2 ; Restart countdown.
heinrichsweikamp
parents:
diff changeset
354 movwf apnoe_mins
heinrichsweikamp
parents:
diff changeset
355 return ; done.
heinrichsweikamp
parents:
diff changeset
356
heinrichsweikamp
parents:
diff changeset
357 ;-----------------------------------------------------------------------------
heinrichsweikamp
parents:
diff changeset
358
heinrichsweikamp
parents:
diff changeset
359 divemodemode_togglegf: ; Toggle aGF/GF
heinrichsweikamp
parents:
diff changeset
360 bcf toggle_gf ; clear flag
heinrichsweikamp
parents:
diff changeset
361 btg use_agf ; Toggle GF
heinrichsweikamp
parents:
diff changeset
362 call TFT_gf_mask ; Setup Mask
heinrichsweikamp
parents:
diff changeset
363 clrf WREG
heinrichsweikamp
parents:
diff changeset
364 movff WREG,char_O_deco_status ; Restart decoplan computation
heinrichsweikamp
parents:
diff changeset
365 return
heinrichsweikamp
parents:
diff changeset
366
heinrichsweikamp
parents:
diff changeset
367 divemode_setup_sensor_values:
heinrichsweikamp
parents:
diff changeset
368 ; sum up sensor values (in xA:2) and active sensors in (xB:2)
heinrichsweikamp
parents:
diff changeset
369 clrf xB+0
heinrichsweikamp
parents:
diff changeset
370 clrf xB+1
heinrichsweikamp
parents:
diff changeset
371 clrf xA+0
heinrichsweikamp
parents:
diff changeset
372 clrf xA+1
113
heinrichsweikamp
parents: 111
diff changeset
373 btfss sensor1_active ; Sensor1 active?
0
heinrichsweikamp
parents:
diff changeset
374 bra divemode_setup_sensor_values2 ; No
heinrichsweikamp
parents:
diff changeset
375 movf o2_ppo2_sensor1,W
heinrichsweikamp
parents:
diff changeset
376 addwf xA+0
heinrichsweikamp
parents:
diff changeset
377 movlw .0
heinrichsweikamp
parents:
diff changeset
378 addwfc xA+1 ; Add into xA:2
heinrichsweikamp
parents:
diff changeset
379 incf xB+0,F ; Add a sensor
heinrichsweikamp
parents:
diff changeset
380 divemode_setup_sensor_values2:
113
heinrichsweikamp
parents: 111
diff changeset
381 btfss sensor2_active ; Sensor2 active?
0
heinrichsweikamp
parents:
diff changeset
382 bra divemode_setup_sensor_values3 ; No
heinrichsweikamp
parents:
diff changeset
383 movf o2_ppo2_sensor2,W
heinrichsweikamp
parents:
diff changeset
384 addwf xA+0
heinrichsweikamp
parents:
diff changeset
385 movlw .0
heinrichsweikamp
parents:
diff changeset
386 addwfc xA+1 ; Add into xA:2
heinrichsweikamp
parents:
diff changeset
387 incf xB+0,F ; Add a sensor
heinrichsweikamp
parents:
diff changeset
388 divemode_setup_sensor_values3:
113
heinrichsweikamp
parents: 111
diff changeset
389 btfss sensor3_active ; Sensor3 active?
0
heinrichsweikamp
parents:
diff changeset
390 bra divemode_setup_sensor_values4 ; No
heinrichsweikamp
parents:
diff changeset
391 movf o2_ppo2_sensor3,W
heinrichsweikamp
parents:
diff changeset
392 addwf xA+0
heinrichsweikamp
parents:
diff changeset
393 movlw .0
heinrichsweikamp
parents:
diff changeset
394 addwfc xA+1 ; Add into xA:2
heinrichsweikamp
parents:
diff changeset
395 incf xB+0,F ; Add a sensor
heinrichsweikamp
parents:
diff changeset
396 divemode_setup_sensor_values4:
heinrichsweikamp
parents:
diff changeset
397 call div16x16 ; xA/xB=xC with xA+0 as remainder
heinrichsweikamp
parents:
diff changeset
398 movff xC+0,sensor_setpoint ; Copy result
heinrichsweikamp
parents:
diff changeset
399 movff sensor_setpoint,char_I_const_ppO2 ; use sensor ppO2
heinrichsweikamp
parents:
diff changeset
400 return
heinrichsweikamp
parents:
diff changeset
401
heinrichsweikamp
parents:
diff changeset
402 calc_velocity: ; called every two seconds
heinrichsweikamp
parents:
diff changeset
403 btfss divemode
heinrichsweikamp
parents:
diff changeset
404 bra do_not_display_velocity ; display velocity only in divemode (Not at the surface after dive)
heinrichsweikamp
parents:
diff changeset
405
heinrichsweikamp
parents:
diff changeset
406 calc_velocity2:
heinrichsweikamp
parents:
diff changeset
407 SAFE_2BYTE_COPY amb_pressure, sub_a
heinrichsweikamp
parents:
diff changeset
408 movff last_pressure_velocity+0,sub_b+0
heinrichsweikamp
parents:
diff changeset
409 movff last_pressure_velocity+1,sub_b+1
heinrichsweikamp
parents:
diff changeset
410 movff sub_a+0,last_pressure_velocity+0 ; store old value for velocity
heinrichsweikamp
parents:
diff changeset
411 movff sub_a+1,last_pressure_velocity+1
heinrichsweikamp
parents:
diff changeset
412
heinrichsweikamp
parents:
diff changeset
413 call subU16 ; sub_c = amb_pressure - last_pressure
heinrichsweikamp
parents:
diff changeset
414
heinrichsweikamp
parents:
diff changeset
415 movff sub_c+0,xA+0
heinrichsweikamp
parents:
diff changeset
416 movff sub_c+1,xA+1
heinrichsweikamp
parents:
diff changeset
417 movlw d'39' ; 77 when called every second....
heinrichsweikamp
parents:
diff changeset
418 movwf xB+0
heinrichsweikamp
parents:
diff changeset
419 clrf xB+1
heinrichsweikamp
parents:
diff changeset
420 call mult16x16 ; differential pressure in mbar*77...
heinrichsweikamp
parents:
diff changeset
421 movff xC+0,divA+0
heinrichsweikamp
parents:
diff changeset
422 movff xC+1,divA+1
heinrichsweikamp
parents:
diff changeset
423 movlw d'7'
heinrichsweikamp
parents:
diff changeset
424 movwf divB+0
heinrichsweikamp
parents:
diff changeset
425 call div16 ; devided by 2^7 equals velocity in m/min
heinrichsweikamp
parents:
diff changeset
426
heinrichsweikamp
parents:
diff changeset
427 movlw d'99'
heinrichsweikamp
parents:
diff changeset
428 cpfsgt divA+0 ; limit to 99m/min
heinrichsweikamp
parents:
diff changeset
429 bra calc_velocity3
heinrichsweikamp
parents:
diff changeset
430 movwf divA+0 ; divA=99
heinrichsweikamp
parents:
diff changeset
431
heinrichsweikamp
parents:
diff changeset
432 calc_velocity3:
heinrichsweikamp
parents:
diff changeset
433 movlw velocity_warning_level_1 ; lowest threshold for display vertical velocity
heinrichsweikamp
parents:
diff changeset
434 subwf divA+0,W ;
heinrichsweikamp
parents:
diff changeset
435 btfss STATUS,C
heinrichsweikamp
parents:
diff changeset
436 bra do_not_display_velocity
heinrichsweikamp
parents:
diff changeset
437
heinrichsweikamp
parents:
diff changeset
438 bsf display_velocity
heinrichsweikamp
parents:
diff changeset
439 call TFT_display_velocity ; With divA+0 = m/min...
heinrichsweikamp
parents:
diff changeset
440 return
heinrichsweikamp
parents:
diff changeset
441
heinrichsweikamp
parents:
diff changeset
442 do_not_display_velocity:
heinrichsweikamp
parents:
diff changeset
443 btfss display_velocity ; Velocity was not displayed, do not delete
heinrichsweikamp
parents:
diff changeset
444 return
heinrichsweikamp
parents:
diff changeset
445 bcf display_velocity ; Velocity was displayed, delete velocity now
heinrichsweikamp
parents:
diff changeset
446 call TFT_display_velocity_clear
heinrichsweikamp
parents:
diff changeset
447 return
heinrichsweikamp
parents:
diff changeset
448
heinrichsweikamp
parents:
diff changeset
449 ;=============================================================================
heinrichsweikamp
parents:
diff changeset
450
104
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
451 set_reset_safety_stop: ; Set flags for safety stop and/or reset safety stop
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
452 TSTOSS opt_enable_safetystop ; =1: A safety stop is shown
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
453 bra delete_safety_stop ; No, don't show safety stop
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
454
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
455 btfsc decostop_active ; Is a deco stop displayed?
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
456 bra delete_safety_stop ; Yes, don't show safety stop
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
457 ; Below "safety_stop_reset"? Set flag and reset count-down timer
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
458 SAFE_2BYTE_COPY rel_pressure, lo
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
459 call adjust_depth_with_salinity ; computes salinity setting into lo:hi [mbar]
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
460 movff lo,sub_a+0
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
461 movff hi,sub_a+1
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
462 movlw LOW safety_stop_reset
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
463 movwf sub_b+0
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
464 movlw HIGH safety_stop_reset
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
465 movwf sub_b+1
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
466 call subU16 ; sub_c = sub_a - sub_b
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
467 btfss neg_flag
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
468 bra reset_safety_stop ; Below 10m, reset safety stop
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
469
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
470 ; Above "safety_stop_end"? Clear flag.
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
471 SAFE_2BYTE_COPY rel_pressure, lo
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
472 call adjust_depth_with_salinity ; computes salinity setting into lo:hi [mbar]
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
473 movff lo,sub_a+0
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
474 movff hi,sub_a+1
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
475 movlw LOW safety_stop_end
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
476 movwf sub_b+0
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
477 movlw HIGH safety_stop_end
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
478 movwf sub_b+1
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
479 call subU16 ; sub_c = sub_a - sub_b
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
480 btfsc neg_flag
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
481 bra delete_safety_stop ; Above 3m, remove safety stop
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
482
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
483 ; Above "safety_stop_start"? Activate safety stop
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
484 SAFE_2BYTE_COPY rel_pressure, lo
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
485 call adjust_depth_with_salinity ; computes salinity setting into lo:hi [mbar]
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
486 movff lo,sub_a+0
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
487 movff hi,sub_a+1
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
488 movlw LOW safety_stop_start
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
489 movwf sub_b+0
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
490 movlw HIGH safety_stop_start
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
491 movwf sub_b+1
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
492 call subU16 ; sub_c = sub_a - sub_b
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
493 btfsc neg_flag
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
494 bra acivate_safety_stop ; Above 5m, activate safety stop
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
495 bra reset_safety_stop2 ; Pause safety stop
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
496
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
497 acivate_safety_stop:
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
498 tstfsz safety_stop_countdown ; Countdown at zero?
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
499 bsf show_safety_stop ; No, Set flag!
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
500 return
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
501
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
502 delete_safety_stop:
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
503 clrf safety_stop_countdown ; reset timer
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
504 bra reset_safety_stop2 ; Remove safety stop from display
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
505
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
506 reset_safety_stop:
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
507 movlw safety_stop_length ;[s]
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
508 movwf safety_stop_countdown ; reset timer
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
509 reset_safety_stop2:
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
510 bcf show_safety_stop ; Clear flag
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
511 btfss safety_stop_active ; Safety stop shown
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
512 return ; No, don't delete it
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
513 bcf safety_stop_active ; Clear flag
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
514 call TFT_display_ndl_mask ; Show NDL again
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
515 call TFT_display_ndl
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
516 return
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
517
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
518 ;=============================================================================
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
519
0
heinrichsweikamp
parents:
diff changeset
520 timeout_menuview:
heinrichsweikamp
parents:
diff changeset
521 decfsz timeout_counter3,F ; timeout for menuview
heinrichsweikamp
parents:
diff changeset
522 return ; No timeout, return
heinrichsweikamp
parents:
diff changeset
523 ; Timeout, clear e.g. "Menu?"
heinrichsweikamp
parents:
diff changeset
524 goto menuview_toggle_reset ; "returns"
heinrichsweikamp
parents:
diff changeset
525
heinrichsweikamp
parents:
diff changeset
526 timeout_divemode_menu:
heinrichsweikamp
parents:
diff changeset
527 decfsz timeout_counter3,F ; timeout for divemode menu
heinrichsweikamp
parents:
diff changeset
528 return
heinrichsweikamp
parents:
diff changeset
529
heinrichsweikamp
parents:
diff changeset
530 global timeout_divemode_menu2
heinrichsweikamp
parents:
diff changeset
531 timeout_divemode_menu2: ; Called from divemenu_tree.asm
heinrichsweikamp
parents:
diff changeset
532 bcf divemode_menu ; Timeout! Clear flag
heinrichsweikamp
parents:
diff changeset
533 call TFT_clear_divemode_menu ; Clear menu
heinrichsweikamp
parents:
diff changeset
534 call TFT_active_gas_divemode ; Redraw gas/setpoint/diluent
heinrichsweikamp
parents:
diff changeset
535 bcf blinking_better_gas ; Clear flag to have temperature updated once
heinrichsweikamp
parents:
diff changeset
536 call TFT_temp_divemode ; Displays temperature
heinrichsweikamp
parents:
diff changeset
537
heinrichsweikamp
parents:
diff changeset
538 btfss decostop_active ; In deco mode ?
heinrichsweikamp
parents:
diff changeset
539 bra timeout_divemode_menu_ndl ; No, show NDL again
heinrichsweikamp
parents:
diff changeset
540 ; Show deco
heinrichsweikamp
parents:
diff changeset
541 call TFT_display_deko_mask ; clear nostop time, display decodata
heinrichsweikamp
parents:
diff changeset
542 call TFT_display_deko
heinrichsweikamp
parents:
diff changeset
543 call TFT_show_TTS_divemode
heinrichsweikamp
parents:
diff changeset
544 return
heinrichsweikamp
parents:
diff changeset
545 timeout_divemode_menu_ndl: ; Show NDL
heinrichsweikamp
parents:
diff changeset
546 call TFT_display_ndl_mask ; Clear deco data, display nostop time
heinrichsweikamp
parents:
diff changeset
547 call TFT_display_ndl
heinrichsweikamp
parents:
diff changeset
548 return
heinrichsweikamp
parents:
diff changeset
549
heinrichsweikamp
parents:
diff changeset
550 timeout_divemode:
heinrichsweikamp
parents:
diff changeset
551 btfsc divemode_menu ; Divemode menu active?
heinrichsweikamp
parents:
diff changeset
552 rcall timeout_divemode_menu ; Yes, check the timeout for it...
heinrichsweikamp
parents:
diff changeset
553
heinrichsweikamp
parents:
diff changeset
554 btfsc menuview ; is a menuview shown?
heinrichsweikamp
parents:
diff changeset
555 rcall timeout_menuview ; Yes, check the timeout for it...
heinrichsweikamp
parents:
diff changeset
556
heinrichsweikamp
parents:
diff changeset
557 btfss realdive ; Dive longer then one minute
heinrichsweikamp
parents:
diff changeset
558 return
heinrichsweikamp
parents:
diff changeset
559
heinrichsweikamp
parents:
diff changeset
560 btfsc FLAG_apnoe_mode ; In Apnoe mode?
35
eca4a201d8cf change apnea timeout, do no longer store apnea dives in logbook
heinrichsweikamp
parents: 23
diff changeset
561 bra timeout_divemode2 ; Yes, use apnoe_timeout [min] for timeout
0
heinrichsweikamp
parents:
diff changeset
562
heinrichsweikamp
parents:
diff changeset
563 ifndef __DEBUG
heinrichsweikamp
parents:
diff changeset
564 btfsc simulatormode_active ; In Simulator mode?
heinrichsweikamp
parents:
diff changeset
565 bra timeout_divemode3 ; Yes, use simulator timeout
heinrichsweikamp
parents:
diff changeset
566 endif
heinrichsweikamp
parents:
diff changeset
567
heinrichsweikamp
parents:
diff changeset
568 bcf divemode
heinrichsweikamp
parents:
diff changeset
569 incf timeout_counter,F
heinrichsweikamp
parents:
diff changeset
570 movlw d'0'
heinrichsweikamp
parents:
diff changeset
571 addwfc timeout_counter2,F ; timeout is 15bits
heinrichsweikamp
parents:
diff changeset
572
heinrichsweikamp
parents:
diff changeset
573 movlw LOW divemode_timeout
heinrichsweikamp
parents:
diff changeset
574 movwf sub_a+0
heinrichsweikamp
parents:
diff changeset
575 movlw HIGH divemode_timeout
heinrichsweikamp
parents:
diff changeset
576 movwf sub_a+1
heinrichsweikamp
parents:
diff changeset
577
heinrichsweikamp
parents:
diff changeset
578 movff timeout_counter, sub_b+0
heinrichsweikamp
parents:
diff changeset
579 movff timeout_counter2, sub_b+1
heinrichsweikamp
parents:
diff changeset
580 call subU16 ; sub_c = sub_a - sub_b
heinrichsweikamp
parents:
diff changeset
581 btfss neg_flag ; Result negative?
heinrichsweikamp
parents:
diff changeset
582 bsf divemode ; No, set flag
heinrichsweikamp
parents:
diff changeset
583 return
heinrichsweikamp
parents:
diff changeset
584
heinrichsweikamp
parents:
diff changeset
585 timeout_divemode2:
heinrichsweikamp
parents:
diff changeset
586 incf timeout_counter,F ; seconds...
heinrichsweikamp
parents:
diff changeset
587 movlw d'60'
heinrichsweikamp
parents:
diff changeset
588 cpfseq timeout_counter ; timeout_counter=60?
heinrichsweikamp
parents:
diff changeset
589 return ; No.
heinrichsweikamp
parents:
diff changeset
590 ; One minute timeout done.
heinrichsweikamp
parents:
diff changeset
591 clrf timeout_counter
heinrichsweikamp
parents:
diff changeset
592 bcf divemode
heinrichsweikamp
parents:
diff changeset
593 incf apnoe_timeout_counter,F
heinrichsweikamp
parents:
diff changeset
594 movlw apnoe_timeout ; apnoe timeout [min]
heinrichsweikamp
parents:
diff changeset
595 cpfseq apnoe_timeout_counter
heinrichsweikamp
parents:
diff changeset
596 bsf divemode
heinrichsweikamp
parents:
diff changeset
597 return
heinrichsweikamp
parents:
diff changeset
598
heinrichsweikamp
parents:
diff changeset
599 timeout_divemode3:
heinrichsweikamp
parents:
diff changeset
600 bcf divemode
heinrichsweikamp
parents:
diff changeset
601 incf timeout_counter,F
heinrichsweikamp
parents:
diff changeset
602 movlw simulator_timeout ; simulator timeout
heinrichsweikamp
parents:
diff changeset
603 cpfsgt timeout_counter
heinrichsweikamp
parents:
diff changeset
604 bsf divemode
heinrichsweikamp
parents:
diff changeset
605 return
heinrichsweikamp
parents:
diff changeset
606
heinrichsweikamp
parents:
diff changeset
607 update_temp_and_or_depth: ; New sensor data arrived...
heinrichsweikamp
parents:
diff changeset
608 btfsc temp_changed
heinrichsweikamp
parents:
diff changeset
609 call TFT_temp_divemode ; Displays temperature
heinrichsweikamp
parents:
diff changeset
610
heinrichsweikamp
parents:
diff changeset
611 btfsc pressure_refresh
heinrichsweikamp
parents:
diff changeset
612 call TFT_depth ; Displays new depth
heinrichsweikamp
parents:
diff changeset
613
heinrichsweikamp
parents:
diff changeset
614 rcall set_max_depth ; update max. depth if required
heinrichsweikamp
parents:
diff changeset
615 bcf pressure_refresh ; until new pressure is available
heinrichsweikamp
parents:
diff changeset
616 return
heinrichsweikamp
parents:
diff changeset
617
heinrichsweikamp
parents:
diff changeset
618 update_divemode60: ; update any minute
heinrichsweikamp
parents:
diff changeset
619 call get_battery_voltage ; gets battery voltage
heinrichsweikamp
parents:
diff changeset
620 call set_powersafe ; Battery low?
heinrichsweikamp
parents:
diff changeset
621 call TFT_max_pressure ; Update max. depth
heinrichsweikamp
parents:
diff changeset
622 call customview_minute ; Do every-minute tasks for the custom view area
heinrichsweikamp
parents:
diff changeset
623 bcf oneminupdate
heinrichsweikamp
parents:
diff changeset
624
heinrichsweikamp
parents:
diff changeset
625 btfss simulatormode_active ; in simulator mode?
heinrichsweikamp
parents:
diff changeset
626 return ; No
heinrichsweikamp
parents:
diff changeset
627 ; Yes, quite dive mode simulation after 21*256s=89min:36s
heinrichsweikamp
parents:
diff changeset
628 movlw .20
heinrichsweikamp
parents:
diff changeset
629 cpfsgt total_divetime_seconds+1 ; Timeout?
heinrichsweikamp
parents:
diff changeset
630 return ; No
heinrichsweikamp
parents:
diff changeset
631 ifdef __DEBUG
heinrichsweikamp
parents:
diff changeset
632 return ; No simulator timeout in debug mode
heinrichsweikamp
parents:
diff changeset
633 endif
heinrichsweikamp
parents:
diff changeset
634 bra divemode_option1 ; Yes, set to 0m and "return"
heinrichsweikamp
parents:
diff changeset
635
heinrichsweikamp
parents:
diff changeset
636 set_max_depth:
heinrichsweikamp
parents:
diff changeset
637 movff max_pressure+0,sub_a+0
heinrichsweikamp
parents:
diff changeset
638 movff max_pressure+1,sub_a+1
heinrichsweikamp
parents:
diff changeset
639 SAFE_2BYTE_COPY rel_pressure, sub_b
heinrichsweikamp
parents:
diff changeset
640 call subU16 ; sub_c = sub_a - sub_b
heinrichsweikamp
parents:
diff changeset
641 ; max_pressure<rel_pressure -> neg_flag=1
heinrichsweikamp
parents:
diff changeset
642 ; rel_pressure<=max_pressure -> neg_flag=0
heinrichsweikamp
parents:
diff changeset
643 btfss neg_flag
heinrichsweikamp
parents:
diff changeset
644 return
heinrichsweikamp
parents:
diff changeset
645 ; max_pressure<rel_pressure
heinrichsweikamp
parents:
diff changeset
646 movff sub_b+0,max_pressure+0
heinrichsweikamp
parents:
diff changeset
647 movff sub_b+1,max_pressure+1
heinrichsweikamp
parents:
diff changeset
648 call TFT_max_pressure ; No, use normal max. depth
heinrichsweikamp
parents:
diff changeset
649 return
heinrichsweikamp
parents:
diff changeset
650
heinrichsweikamp
parents:
diff changeset
651 set_min_temp:
heinrichsweikamp
parents:
diff changeset
652 movff minimum_temperature+0,sub_a+0
heinrichsweikamp
parents:
diff changeset
653 movff minimum_temperature+1,sub_a+1
heinrichsweikamp
parents:
diff changeset
654 SAFE_2BYTE_COPY temperature,sub_b
heinrichsweikamp
parents:
diff changeset
655 call sub16 ; sub_c = sub_a - sub_b
heinrichsweikamp
parents:
diff changeset
656 ; minimum_temperature<T -> neg_flag=1
heinrichsweikamp
parents:
diff changeset
657 ; T<=minimum_temperature -> neg_flag=0
heinrichsweikamp
parents:
diff changeset
658 btfsc neg_flag
heinrichsweikamp
parents:
diff changeset
659 return
heinrichsweikamp
parents:
diff changeset
660 ; minimum_temperature>=T
heinrichsweikamp
parents:
diff changeset
661 movff sub_b+0,minimum_temperature+0
heinrichsweikamp
parents:
diff changeset
662 movff sub_b+1,minimum_temperature+1
heinrichsweikamp
parents:
diff changeset
663 return
heinrichsweikamp
parents:
diff changeset
664
heinrichsweikamp
parents:
diff changeset
665 global set_dive_modes
heinrichsweikamp
parents:
diff changeset
666 set_dive_modes:
heinrichsweikamp
parents:
diff changeset
667 btfsc high_altitude_mode ; In high altitude (Fly) mode?
heinrichsweikamp
parents:
diff changeset
668 bra set_dive_modes3 ; Yes!
heinrichsweikamp
parents:
diff changeset
669
heinrichsweikamp
parents:
diff changeset
670 set_dive_modes0:
heinrichsweikamp
parents:
diff changeset
671 movlw LOW start_dive_threshold
heinrichsweikamp
parents:
diff changeset
672 movwf sub_a+0 ; dive_treshold is in cm
heinrichsweikamp
parents:
diff changeset
673 movlw HIGH start_dive_threshold
heinrichsweikamp
parents:
diff changeset
674 movwf sub_a+1 ; dive_treshold is in cm
heinrichsweikamp
parents:
diff changeset
675
heinrichsweikamp
parents:
diff changeset
676 set_dive_modes1:
heinrichsweikamp
parents:
diff changeset
677 SAFE_2BYTE_COPY rel_pressure, sub_b
heinrichsweikamp
parents:
diff changeset
678 call subU16 ; sub_c = sub_a - sub_b
heinrichsweikamp
parents:
diff changeset
679
heinrichsweikamp
parents:
diff changeset
680 btfss neg_flag
heinrichsweikamp
parents:
diff changeset
681 bra set_dive_modes2 ; too shallow (rel_pressure<dive_threshold)
heinrichsweikamp
parents:
diff changeset
682
heinrichsweikamp
parents:
diff changeset
683 btfsc realdive ; Dive longer than one minute?
heinrichsweikamp
parents:
diff changeset
684 clrf timeout_counter ; Yes, reset timout counter
heinrichsweikamp
parents:
diff changeset
685
heinrichsweikamp
parents:
diff changeset
686 set_dive_modes_common:
heinrichsweikamp
parents:
diff changeset
687 bsf divemode ; (Re-)Set divemode flag
heinrichsweikamp
parents:
diff changeset
688 bsf divemode2 ; displayed divetime is running
heinrichsweikamp
parents:
diff changeset
689 return
heinrichsweikamp
parents:
diff changeset
690
heinrichsweikamp
parents:
diff changeset
691 set_dive_modes2:
heinrichsweikamp
parents:
diff changeset
692 bcf divemode2 ; Stop time
heinrichsweikamp
parents:
diff changeset
693 btfss realdive ; dive longer then one minute?
heinrichsweikamp
parents:
diff changeset
694 bcf divemode ; no -> this was no real dive
heinrichsweikamp
parents:
diff changeset
695 return ; No, return
heinrichsweikamp
parents:
diff changeset
696
heinrichsweikamp
parents:
diff changeset
697
heinrichsweikamp
parents:
diff changeset
698 set_dive_modes3: ; High-altitude mode
heinrichsweikamp
parents:
diff changeset
699 btfsc realdive ; dive longer then one minute?
heinrichsweikamp
parents:
diff changeset
700 bra set_dive_modes0 ; Yes -> this is a real dive -> Use start_dive_threshold or ascend
heinrichsweikamp
parents:
diff changeset
701
heinrichsweikamp
parents:
diff changeset
702 movlw HIGH high_altitude_dive_threshold
heinrichsweikamp
parents:
diff changeset
703 movwf sub_a+1
heinrichsweikamp
parents:
diff changeset
704 movlw LOW high_altitude_dive_threshold
heinrichsweikamp
parents:
diff changeset
705 movwf sub_a+0
heinrichsweikamp
parents:
diff changeset
706 bra set_dive_modes1
heinrichsweikamp
parents:
diff changeset
707
heinrichsweikamp
parents:
diff changeset
708 set_powersafe:
heinrichsweikamp
parents:
diff changeset
709 movlw color_code_battery_low+1; [%]
heinrichsweikamp
parents:
diff changeset
710 cpfslt batt_percent
heinrichsweikamp
parents:
diff changeset
711 return
heinrichsweikamp
parents:
diff changeset
712
heinrichsweikamp
parents:
diff changeset
713 movlw d'7' ; Type of Alarm (Battery Low)
heinrichsweikamp
parents:
diff changeset
714 movwf AlarmType ; Copy to Alarm Register
heinrichsweikamp
parents:
diff changeset
715 bsf event_occured ; Set Event Flag
heinrichsweikamp
parents:
diff changeset
716 movlw .0
heinrichsweikamp
parents:
diff changeset
717 movff WREG,opt_brightness ; Set Brightness to ECO
heinrichsweikamp
parents:
diff changeset
718 return ; return
heinrichsweikamp
parents:
diff changeset
719
heinrichsweikamp
parents:
diff changeset
720 calc_average_depth:
heinrichsweikamp
parents:
diff changeset
721 btfsc reset_average_depth ; Reset the Avewrage depth?
heinrichsweikamp
parents:
diff changeset
722 rcall reset_average1 ; Reset the resettable average depth
heinrichsweikamp
parents:
diff changeset
723
heinrichsweikamp
parents:
diff changeset
724 ; 1. Add new 2xdepth to the Sum of depths registers
heinrichsweikamp
parents:
diff changeset
725 SAFE_2BYTE_COPY rel_pressure, xB ; Buffer...
heinrichsweikamp
parents:
diff changeset
726 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
727 rlcf xB+0,F
heinrichsweikamp
parents:
diff changeset
728 rlcf xB+1,F ; x2
heinrichsweikamp
parents:
diff changeset
729
heinrichsweikamp
parents:
diff changeset
730 movf xB+0,w
heinrichsweikamp
parents:
diff changeset
731 addwf average_depth_hold+0,F
heinrichsweikamp
parents:
diff changeset
732 movf xB+1,w
heinrichsweikamp
parents:
diff changeset
733 addwfc average_depth_hold+1,F
heinrichsweikamp
parents:
diff changeset
734 movlw d'0'
heinrichsweikamp
parents:
diff changeset
735 addwfc average_depth_hold+2,F
heinrichsweikamp
parents:
diff changeset
736 addwfc average_depth_hold+3,F ; Will work up to 9999mbar*60*60*24=863913600mbar
heinrichsweikamp
parents:
diff changeset
737
heinrichsweikamp
parents:
diff changeset
738 ; Do the same for the _total registers (Non-Resettable)
heinrichsweikamp
parents:
diff changeset
739 movf xB+0,w
heinrichsweikamp
parents:
diff changeset
740 addwf average_depth_hold_total+0,F
heinrichsweikamp
parents:
diff changeset
741 movf xB+1,w
heinrichsweikamp
parents:
diff changeset
742 addwfc average_depth_hold_total+1,F
heinrichsweikamp
parents:
diff changeset
743 movlw d'0'
heinrichsweikamp
parents:
diff changeset
744 addwfc average_depth_hold_total+2,F
heinrichsweikamp
parents:
diff changeset
745 addwfc average_depth_hold_total+3,F ; Will work up to 9999mbar*60*60*24=863913600mbar
heinrichsweikamp
parents:
diff changeset
746
heinrichsweikamp
parents:
diff changeset
747 ; 2. Compute Average Depth on base of average_divesecs:2
heinrichsweikamp
parents:
diff changeset
748 movff average_divesecs+0,xB+0
heinrichsweikamp
parents:
diff changeset
749 movff average_divesecs+1,xB+1 ; Copy
heinrichsweikamp
parents:
diff changeset
750 movff average_depth_hold+0,xC+0
heinrichsweikamp
parents:
diff changeset
751 movff average_depth_hold+1,xC+1
heinrichsweikamp
parents:
diff changeset
752 movff average_depth_hold+2,xC+2
heinrichsweikamp
parents:
diff changeset
753 movff average_depth_hold+3,xC+3
heinrichsweikamp
parents:
diff changeset
754
heinrichsweikamp
parents:
diff changeset
755 call div32x16 ; xC:4 / xB:2 = xC+3:xC+2 with xC+1:xC+0 as remainder
heinrichsweikamp
parents:
diff changeset
756 movff xC+0,avr_rel_pressure+0
heinrichsweikamp
parents:
diff changeset
757 movff xC+1,avr_rel_pressure+1
heinrichsweikamp
parents:
diff changeset
758
89
c34516c99ca8 BUGFIX: No average depth for end-of-dive portion (<1m)
heinrichsweikamp
parents: 86
diff changeset
759 btfss divemode2 ; displayed divetime is running?
c34516c99ca8 BUGFIX: No average depth for end-of-dive portion (<1m)
heinrichsweikamp
parents: 86
diff changeset
760 return ; No (e.g. too shallow)
c34516c99ca8 BUGFIX: No average depth for end-of-dive portion (<1m)
heinrichsweikamp
parents: 86
diff changeset
761
0
heinrichsweikamp
parents:
diff changeset
762 ; 3. Compute Total Average Depth on base of total_divetime_seconds:2
heinrichsweikamp
parents:
diff changeset
763 movff total_divetime_seconds+0,xB+0
heinrichsweikamp
parents:
diff changeset
764 movff total_divetime_seconds+1,xB+1 ; Copy
heinrichsweikamp
parents:
diff changeset
765 movff average_depth_hold_total+0,xC+0
heinrichsweikamp
parents:
diff changeset
766 movff average_depth_hold_total+1,xC+1
heinrichsweikamp
parents:
diff changeset
767 movff average_depth_hold_total+2,xC+2
heinrichsweikamp
parents:
diff changeset
768 movff average_depth_hold_total+3,xC+3
heinrichsweikamp
parents:
diff changeset
769 call div32x16 ; xC:4 / xB:2 = xC+3:xC+2 with xC+1:xC+0 as remainder
heinrichsweikamp
parents:
diff changeset
770 movff xC+0,avr_rel_pressure_total+0
heinrichsweikamp
parents:
diff changeset
771 movff xC+1,avr_rel_pressure_total+1
heinrichsweikamp
parents:
diff changeset
772
heinrichsweikamp
parents:
diff changeset
773 return
heinrichsweikamp
parents:
diff changeset
774
heinrichsweikamp
parents:
diff changeset
775 reset_average1:
heinrichsweikamp
parents:
diff changeset
776 clrf average_depth_hold+0
heinrichsweikamp
parents:
diff changeset
777 clrf average_depth_hold+1
heinrichsweikamp
parents:
diff changeset
778 clrf average_depth_hold+2
heinrichsweikamp
parents:
diff changeset
779 clrf average_depth_hold+3 ; Clear average depth register
heinrichsweikamp
parents:
diff changeset
780 movlw d'2'
heinrichsweikamp
parents:
diff changeset
781 movwf average_divesecs+0
heinrichsweikamp
parents:
diff changeset
782 clrf average_divesecs+1
heinrichsweikamp
parents:
diff changeset
783 bcf reset_average_depth ; Clear flag
heinrichsweikamp
parents:
diff changeset
784 return
heinrichsweikamp
parents:
diff changeset
785
heinrichsweikamp
parents:
diff changeset
786 test_switches_divemode: ; checks switches in divemode
heinrichsweikamp
parents:
diff changeset
787 btfsc divemode_menu ; Divemode menu shown?
heinrichsweikamp
parents:
diff changeset
788 bra test_switches_divemode_menu ; Yes, use menu processor
heinrichsweikamp
parents:
diff changeset
789 btfsc switch_left
heinrichsweikamp
parents:
diff changeset
790 bra test_switches_divemode2 ; Enter button pressed, check if we need to do something
heinrichsweikamp
parents:
diff changeset
791 btfss switch_right
heinrichsweikamp
parents:
diff changeset
792 return ; No button press
heinrichsweikamp
parents:
diff changeset
793 tstfsz menupos2 ; any option shown?
heinrichsweikamp
parents:
diff changeset
794 bra test_switches_divemode1 ; Yes, do option tasks
heinrichsweikamp
parents:
diff changeset
795 bsf toggle_customview ; No, toggle custom view
heinrichsweikamp
parents:
diff changeset
796 return
heinrichsweikamp
parents:
diff changeset
797
heinrichsweikamp
parents:
diff changeset
798 test_switches_divemode_menu:
heinrichsweikamp
parents:
diff changeset
799 btfsc switch_left
heinrichsweikamp
parents:
diff changeset
800 bra test_switches_divemode_menu2 ; Move cursor
heinrichsweikamp
parents:
diff changeset
801 btfsc switch_right
heinrichsweikamp
parents:
diff changeset
802 bra test_switches_divemode_menu3 ; Enter submenu or do something
heinrichsweikamp
parents:
diff changeset
803 return ; No button press
heinrichsweikamp
parents:
diff changeset
804
heinrichsweikamp
parents:
diff changeset
805 test_switches_divemode_menu1:
heinrichsweikamp
parents:
diff changeset
806 clrf menupos
heinrichsweikamp
parents:
diff changeset
807 test_switches_divemode_menu2:
heinrichsweikamp
parents:
diff changeset
808 incf menupos,F
heinrichsweikamp
parents:
diff changeset
809 incf menupos4,W ; menupos4+1 -> WREG
heinrichsweikamp
parents:
diff changeset
810 cpfslt menupos ; >menupos4 (Set in menu_processor.asm)?
heinrichsweikamp
parents:
diff changeset
811 bra test_switches_divemode_menu1; > Yes, set to 1
heinrichsweikamp
parents:
diff changeset
812 call TFT_divemode_menu_cursor ; Update the cursor
heinrichsweikamp
parents:
diff changeset
813 bcf switch_left
heinrichsweikamp
parents:
diff changeset
814 movlw divemode_menu_timeout ; Reload timeout
heinrichsweikamp
parents:
diff changeset
815 movwf timeout_counter3 ; timeout for divemode menu
heinrichsweikamp
parents:
diff changeset
816 return
heinrichsweikamp
parents:
diff changeset
817
heinrichsweikamp
parents:
diff changeset
818 test_switches_divemode_menu3: ; Enter submenu or do something
heinrichsweikamp
parents:
diff changeset
819 bcf switch_right
heinrichsweikamp
parents:
diff changeset
820 ; decf menupos,F ; menu_processor needs 0-5...
heinrichsweikamp
parents:
diff changeset
821 extern do_line_menu
heinrichsweikamp
parents:
diff changeset
822 goto do_line_menu ; Warning! Trashes STKPTR and returns to diveloop_loop4:
heinrichsweikamp
parents:
diff changeset
823
heinrichsweikamp
parents:
diff changeset
824 test_switches_divemode1:
heinrichsweikamp
parents:
diff changeset
825 bcf switch_right
heinrichsweikamp
parents:
diff changeset
826 movlw divemode_menuview_timeout
heinrichsweikamp
parents:
diff changeset
827 movwf timeout_counter3 ; Reload timeout
heinrichsweikamp
parents:
diff changeset
828 movff menupos2,WREG ; Menupos3 holds number of customview/divemode menu function
heinrichsweikamp
parents:
diff changeset
829 dcfsnz WREG,F
heinrichsweikamp
parents:
diff changeset
830 bra divemode_option0 ; Start/Setup Divemode menu
heinrichsweikamp
parents:
diff changeset
831 dcfsnz WREG,F
heinrichsweikamp
parents:
diff changeset
832 bra divemode_option1 ; Quit Simulation?
heinrichsweikamp
parents:
diff changeset
833 dcfsnz WREG,F
heinrichsweikamp
parents:
diff changeset
834 bra divemode_option2 ; Descent 1m
heinrichsweikamp
parents:
diff changeset
835 dcfsnz WREG,F
heinrichsweikamp
parents:
diff changeset
836 bra divemode_option3 ; Ascend 1m
heinrichsweikamp
parents:
diff changeset
837 dcfsnz WREG,F
heinrichsweikamp
parents:
diff changeset
838 bra divemode_option4 ; Quit Apnoe mode
heinrichsweikamp
parents:
diff changeset
839 dcfsnz WREG,F
heinrichsweikamp
parents:
diff changeset
840 bra divemode_option5 ; Reset Stopwatch (In Gauge mode)
heinrichsweikamp
parents:
diff changeset
841 return
heinrichsweikamp
parents:
diff changeset
842
heinrichsweikamp
parents:
diff changeset
843 test_switches_divemode2:
heinrichsweikamp
parents:
diff changeset
844 bcf switch_left
heinrichsweikamp
parents:
diff changeset
845 call menuview_toggle ; Menu or Simulator tasks
heinrichsweikamp
parents:
diff changeset
846 return
heinrichsweikamp
parents:
diff changeset
847
heinrichsweikamp
parents:
diff changeset
848 gas_switched_common:
99
87cc1adfe4da show event "bailout" in the internal logbook
heinrichsweikamp
parents: 98
diff changeset
849 bcf divemode_gaschange ; Clear flag
87cc1adfe4da show event "bailout" in the internal logbook
heinrichsweikamp
parents: 98
diff changeset
850
0
heinrichsweikamp
parents:
diff changeset
851 decf menupos,W ; 1-5 -> 0-4
heinrichsweikamp
parents:
diff changeset
852 btfss FLAG_ccr_mode ; Choose OC Gases
heinrichsweikamp
parents:
diff changeset
853 rcall setup_gas_registers ; With WREG=Gas 0-4
heinrichsweikamp
parents:
diff changeset
854 btfsc FLAG_ccr_mode ; Choose CC Diluents
heinrichsweikamp
parents:
diff changeset
855 rcall setup_dil_registers ; With WREG=Gas 0-4
heinrichsweikamp
parents:
diff changeset
856
heinrichsweikamp
parents:
diff changeset
857 decf menupos,W ; 1-5 -> 0-4
heinrichsweikamp
parents:
diff changeset
858 btfsc is_bailout ; Choose OC Bailouts (OC Gases)
heinrichsweikamp
parents:
diff changeset
859 rcall setup_gas_registers ; With WREG=Gas 0-4
heinrichsweikamp
parents:
diff changeset
860
heinrichsweikamp
parents:
diff changeset
861 call TFT_active_gas_divemode ; Display gas/Setpoint
heinrichsweikamp
parents:
diff changeset
862 clrf WREG
heinrichsweikamp
parents:
diff changeset
863 movff WREG,char_O_deco_status ; Restart decoplan computation
98
24b3fd59e61f add event "bailout" in profile
heinrichsweikamp
parents: 97
diff changeset
864
24b3fd59e61f add event "bailout" in profile
heinrichsweikamp
parents: 97
diff changeset
865 ; Set flags for profile recording
24b3fd59e61f add event "bailout" in profile
heinrichsweikamp
parents: 97
diff changeset
866 bsf event_occured ; Set global event byte
24b3fd59e61f add event "bailout" in profile
heinrichsweikamp
parents: 97
diff changeset
867 btfsc is_bailout ; Choose OC Bailouts (OC Gases)
24b3fd59e61f add event "bailout" in profile
heinrichsweikamp
parents: 97
diff changeset
868 bsf bailoutgas_event ; Bailout gas change
24b3fd59e61f add event "bailout" in profile
heinrichsweikamp
parents: 97
diff changeset
869 btfss is_bailout ; Choose OC Bailouts (OC Gases)
24b3fd59e61f add event "bailout" in profile
heinrichsweikamp
parents: 97
diff changeset
870 bsf stored_gas_changed ; OC gas change
0
heinrichsweikamp
parents:
diff changeset
871 return
heinrichsweikamp
parents:
diff changeset
872
heinrichsweikamp
parents:
diff changeset
873 global setup_gas_registers
heinrichsweikamp
parents:
diff changeset
874 setup_gas_registers: ; With WREG=Gas 0-4
heinrichsweikamp
parents:
diff changeset
875 lfsr FSR1,opt_gas_O2_ratio+0
heinrichsweikamp
parents:
diff changeset
876 movff PLUSW1,char_I_O2_ratio ; O2 (For ppO2 calculations)
heinrichsweikamp
parents:
diff changeset
877 lfsr FSR1,opt_gas_He_ratio+0
heinrichsweikamp
parents:
diff changeset
878 movff PLUSW1,char_I_He_ratio ; He
heinrichsweikamp
parents:
diff changeset
879 incf WREG,W ; Gas# 1-5
heinrichsweikamp
parents:
diff changeset
880 movff WREG,char_I_current_gas ; Set gas
heinrichsweikamp
parents:
diff changeset
881 movff WREG,active_gas ; Set for logbook and display
heinrichsweikamp
parents:
diff changeset
882 banksel char_I_O2_ratio
heinrichsweikamp
parents:
diff changeset
883 movf char_I_O2_ratio,W ; Add O2...
heinrichsweikamp
parents:
diff changeset
884 addwf char_I_He_ratio,W ; ...and He...
heinrichsweikamp
parents:
diff changeset
885 sublw .100 ; ...subtract both from 100
heinrichsweikamp
parents:
diff changeset
886 movwf char_I_N2_ratio ; -> N2!
heinrichsweikamp
parents:
diff changeset
887 banksel common
heinrichsweikamp
parents:
diff changeset
888 return
heinrichsweikamp
parents:
diff changeset
889
heinrichsweikamp
parents:
diff changeset
890 global setup_dil_registers
heinrichsweikamp
parents:
diff changeset
891 setup_dil_registers: ; With WREG=dil 0-4
97
53a99a2dc6a1 CHANGE: Always compute bailout plan based on all active gases
heinrichsweikamp
parents: 89
diff changeset
892 btfsc is_bailout
53a99a2dc6a1 CHANGE: Always compute bailout plan based on all active gases
heinrichsweikamp
parents: 89
diff changeset
893 return ; Ignore in bailout
0
heinrichsweikamp
parents:
diff changeset
894 lfsr FSR1,opt_dil_O2_ratio+0
heinrichsweikamp
parents:
diff changeset
895 movff PLUSW1,char_I_O2_ratio ; O2 (For ppO2 calculations)
heinrichsweikamp
parents:
diff changeset
896 lfsr FSR1,opt_dil_He_ratio+0
heinrichsweikamp
parents:
diff changeset
897 movff PLUSW1,char_I_He_ratio ; He
heinrichsweikamp
parents:
diff changeset
898 incf WREG,W ; Gas# 1-5
heinrichsweikamp
parents:
diff changeset
899 movff WREG,char_I_current_gas ; Set gas
heinrichsweikamp
parents:
diff changeset
900 movff WREG,active_gas ; Set for logbook and display
97
53a99a2dc6a1 CHANGE: Always compute bailout plan based on all active gases
heinrichsweikamp
parents: 89
diff changeset
901 movff WREG,active_diluent ; As a backup when switching back from Bailout to CCR
0
heinrichsweikamp
parents:
diff changeset
902 banksel char_I_O2_ratio
heinrichsweikamp
parents:
diff changeset
903 movf char_I_O2_ratio,W ; Add O2...
heinrichsweikamp
parents:
diff changeset
904 addwf char_I_He_ratio,W ; ...and He...
heinrichsweikamp
parents:
diff changeset
905 sublw .100 ; ...subtract both from 100
heinrichsweikamp
parents:
diff changeset
906 movwf char_I_N2_ratio ; -> N2!
heinrichsweikamp
parents:
diff changeset
907 banksel common
heinrichsweikamp
parents:
diff changeset
908 return
heinrichsweikamp
parents:
diff changeset
909
heinrichsweikamp
parents:
diff changeset
910 divemode_option0: ; Start/Setup Divemode menu
heinrichsweikamp
parents:
diff changeset
911 call TFT_clear_divemode_menu ; Clear menu area
heinrichsweikamp
parents:
diff changeset
912 bcf menuview
heinrichsweikamp
parents:
diff changeset
913 extern do_main_divemenu
heinrichsweikamp
parents:
diff changeset
914 call do_main_divemenu
heinrichsweikamp
parents:
diff changeset
915 global divemode_option0_return
heinrichsweikamp
parents:
diff changeset
916 divemode_option0_return:
heinrichsweikamp
parents:
diff changeset
917 ; movlw .1
heinrichsweikamp
parents:
diff changeset
918 ; movwf menupos ; Set to first option in divemode menu
heinrichsweikamp
parents:
diff changeset
919 call TFT_divemode_menu_cursor; Show the cursor
heinrichsweikamp
parents:
diff changeset
920 movlw divemode_menu_timeout
heinrichsweikamp
parents:
diff changeset
921 movwf timeout_counter3 ; timeout for divemode menu
heinrichsweikamp
parents:
diff changeset
922 bsf divemode_menu ; Set flag
heinrichsweikamp
parents:
diff changeset
923 clrf menupos2 ; Clear option counter
heinrichsweikamp
parents:
diff changeset
924 bra diveloop_loop4 ; Goto back to diveloop (Menuprocessor trashes STKPTR!)
heinrichsweikamp
parents:
diff changeset
925
heinrichsweikamp
parents:
diff changeset
926 divemode_option4:
heinrichsweikamp
parents:
diff changeset
927 movlw d'58' ; two seconds left
heinrichsweikamp
parents:
diff changeset
928 movwf timeout_counter
heinrichsweikamp
parents:
diff changeset
929 movlw apnoe_timeout-1 ; apnoe timeout [min]
heinrichsweikamp
parents:
diff changeset
930 movwf apnoe_timeout_counter
heinrichsweikamp
parents:
diff changeset
931 btfss simulatormode_active ; in simulator mode?
heinrichsweikamp
parents:
diff changeset
932 return ; No
heinrichsweikamp
parents:
diff changeset
933 divemode_option1: ; Quit simulation mode
heinrichsweikamp
parents:
diff changeset
934 banksel isr_backup
heinrichsweikamp
parents:
diff changeset
935 movlw low .1000
heinrichsweikamp
parents:
diff changeset
936 movwf sim_pressure+0
heinrichsweikamp
parents:
diff changeset
937 movlw high .1000
heinrichsweikamp
parents:
diff changeset
938 movwf sim_pressure+1 ; Set to 0m -> End of Dive
heinrichsweikamp
parents:
diff changeset
939 banksel common
heinrichsweikamp
parents:
diff changeset
940 call menuview_toggle_reset ; Reset to zero (Zero=no menuview)
heinrichsweikamp
parents:
diff changeset
941
heinrichsweikamp
parents:
diff changeset
942 btfss FLAG_apnoe_mode ; In Apnoe mode?
heinrichsweikamp
parents:
diff changeset
943 return ; No
heinrichsweikamp
parents:
diff changeset
944 movlw d'58' ; two seconds left
heinrichsweikamp
parents:
diff changeset
945 movwf timeout_counter
heinrichsweikamp
parents:
diff changeset
946 movlw apnoe_timeout-1 ; apnoe timeout [min]
heinrichsweikamp
parents:
diff changeset
947 movwf apnoe_timeout_counter
heinrichsweikamp
parents:
diff changeset
948 return
heinrichsweikamp
parents:
diff changeset
949
heinrichsweikamp
parents:
diff changeset
950 divemode_option3: ; minus 1m
heinrichsweikamp
parents:
diff changeset
951 banksel isr_backup
heinrichsweikamp
parents:
diff changeset
952 movlw d'100'
heinrichsweikamp
parents:
diff changeset
953 subwf sim_pressure+0
heinrichsweikamp
parents:
diff changeset
954 movlw .0
heinrichsweikamp
parents:
diff changeset
955 subwfb sim_pressure+1
heinrichsweikamp
parents:
diff changeset
956 rcall divemode_simulator_check_limits
heinrichsweikamp
parents:
diff changeset
957 banksel common
heinrichsweikamp
parents:
diff changeset
958 return
heinrichsweikamp
parents:
diff changeset
959
heinrichsweikamp
parents:
diff changeset
960 divemode_option2: ; plus 1m
heinrichsweikamp
parents:
diff changeset
961 banksel isr_backup
heinrichsweikamp
parents:
diff changeset
962 movlw d'100'
heinrichsweikamp
parents:
diff changeset
963 addwf sim_pressure+0
heinrichsweikamp
parents:
diff changeset
964 movlw .0
heinrichsweikamp
parents:
diff changeset
965 addwfc sim_pressure+1
heinrichsweikamp
parents:
diff changeset
966 rcall divemode_simulator_check_limits
heinrichsweikamp
parents:
diff changeset
967 banksel common
heinrichsweikamp
parents:
diff changeset
968 return
heinrichsweikamp
parents:
diff changeset
969
heinrichsweikamp
parents:
diff changeset
970 divemode_option5:
heinrichsweikamp
parents:
diff changeset
971 call menuview_toggle_reset ; Reset to zero (Zero=no menuview)
heinrichsweikamp
parents:
diff changeset
972 bsf reset_average_depth ; Set Flag
heinrichsweikamp
parents:
diff changeset
973 return
heinrichsweikamp
parents:
diff changeset
974
heinrichsweikamp
parents:
diff changeset
975 divemode_simulator_check_limits:
heinrichsweikamp
parents:
diff changeset
976 ; Check limits (150m and 0m)
heinrichsweikamp
parents:
diff changeset
977 movlw LOW d'16000' ; Compare to 16bar=16000mbar (150m).
heinrichsweikamp
parents:
diff changeset
978 subwf sim_pressure+0,W
heinrichsweikamp
parents:
diff changeset
979 movlw HIGH d'16000'
heinrichsweikamp
parents:
diff changeset
980 subwfb sim_pressure+1,W
heinrichsweikamp
parents:
diff changeset
981 bnc divemode_simulator_check_limits2 ; No-carry = borrow = not deeper
heinrichsweikamp
parents:
diff changeset
982
heinrichsweikamp
parents:
diff changeset
983 ; Too deep, limit to 150m
heinrichsweikamp
parents:
diff changeset
984 movlw LOW d'16000'
heinrichsweikamp
parents:
diff changeset
985 movwf sim_pressure+0
heinrichsweikamp
parents:
diff changeset
986 movlw HIGH d'16000'
heinrichsweikamp
parents:
diff changeset
987 movwf sim_pressure+1
heinrichsweikamp
parents:
diff changeset
988 return
heinrichsweikamp
parents:
diff changeset
989 divemode_simulator_check_limits2:
heinrichsweikamp
parents:
diff changeset
990 movlw LOW d'1000' ; Compare to 1bar == 0m == 1000 mbar.
heinrichsweikamp
parents:
diff changeset
991 subwf sim_pressure+0,W
heinrichsweikamp
parents:
diff changeset
992 movlw HIGH d'1000'
heinrichsweikamp
parents:
diff changeset
993 subwfb sim_pressure+1,W
heinrichsweikamp
parents:
diff changeset
994 btfsc STATUS,C ; No-carry = borrow = not deeper.
heinrichsweikamp
parents:
diff changeset
995 return ; Deeper than 0m == Ok.
heinrichsweikamp
parents:
diff changeset
996 ; Too shallow, limit to 0m
heinrichsweikamp
parents:
diff changeset
997 movlw LOW d'1000'
heinrichsweikamp
parents:
diff changeset
998 movwf sim_pressure+0
heinrichsweikamp
parents:
diff changeset
999 movlw HIGH d'1000'
heinrichsweikamp
parents:
diff changeset
1000 movwf sim_pressure+1
heinrichsweikamp
parents:
diff changeset
1001 return
heinrichsweikamp
parents:
diff changeset
1002
heinrichsweikamp
parents:
diff changeset
1003 ;=============================================================================
heinrichsweikamp
parents:
diff changeset
1004 ; Compare all enabled gas in list, to see if a better one is available.
heinrichsweikamp
parents:
diff changeset
1005 ;
heinrichsweikamp
parents:
diff changeset
1006 ; Output: better_gas_available, better_gas_number
heinrichsweikamp
parents:
diff changeset
1007 ;
heinrichsweikamp
parents:
diff changeset
1008 check_gas_change: ; Checks if a better gas should be selected (by user)
heinrichsweikamp
parents:
diff changeset
1009 bcf better_gas_available ;=1: A better gas is available and a gas change is advised in divemode
heinrichsweikamp
parents:
diff changeset
1010 clrf better_gas_number ; Clear better gas register
heinrichsweikamp
parents:
diff changeset
1011
heinrichsweikamp
parents:
diff changeset
1012 SAFE_2BYTE_COPY rel_pressure,xA
heinrichsweikamp
parents:
diff changeset
1013 movlw d'100'
heinrichsweikamp
parents:
diff changeset
1014 movwf xB+0
heinrichsweikamp
parents:
diff changeset
1015 clrf xB+1
heinrichsweikamp
parents:
diff changeset
1016 call div16x16 ; compute depth in full m -> result in xC+0
heinrichsweikamp
parents:
diff changeset
1017
heinrichsweikamp
parents:
diff changeset
1018 btfss FLAG_ccr_mode ; In CCR mode...
heinrichsweikamp
parents:
diff changeset
1019 bra check_gas_change_OC_bail; No, check for OC or bailout
heinrichsweikamp
parents:
diff changeset
1020 btfsc is_bailout ; Bailout?
heinrichsweikamp
parents:
diff changeset
1021 bra check_gas_change_OC_bail; Yes, check for OC or bailout
heinrichsweikamp
parents:
diff changeset
1022
heinrichsweikamp
parents:
diff changeset
1023 ; Check Diluents
heinrichsweikamp
parents:
diff changeset
1024 movlw .0
heinrichsweikamp
parents:
diff changeset
1025 rcall check_dil_common ; With Gas 0-4 in WREG
heinrichsweikamp
parents:
diff changeset
1026 movlw .1
heinrichsweikamp
parents:
diff changeset
1027 rcall check_dil_common ; With Gas 0-4 in WREG
heinrichsweikamp
parents:
diff changeset
1028 movlw .2
heinrichsweikamp
parents:
diff changeset
1029 rcall check_dil_common ; With Gas 0-4 in WREG
heinrichsweikamp
parents:
diff changeset
1030 movlw .3
heinrichsweikamp
parents:
diff changeset
1031 rcall check_dil_common ; With Gas 0-4 in WREG
heinrichsweikamp
parents:
diff changeset
1032 movlw .4
heinrichsweikamp
parents:
diff changeset
1033 rcall check_dil_common ; With Gas 0-4 in WREG
heinrichsweikamp
parents:
diff changeset
1034 bra check_gas_change_exit
heinrichsweikamp
parents:
diff changeset
1035
heinrichsweikamp
parents:
diff changeset
1036 check_gas_change_OC_bail:
heinrichsweikamp
parents:
diff changeset
1037 movlw .0
heinrichsweikamp
parents:
diff changeset
1038 rcall check_gas_common ; With Gas 0-4 in WREG
heinrichsweikamp
parents:
diff changeset
1039 movlw .1
heinrichsweikamp
parents:
diff changeset
1040 rcall check_gas_common ; With Gas 0-4 in WREG
heinrichsweikamp
parents:
diff changeset
1041 movlw .2
heinrichsweikamp
parents:
diff changeset
1042 rcall check_gas_common ; With Gas 0-4 in WREG
heinrichsweikamp
parents:
diff changeset
1043 movlw .3
heinrichsweikamp
parents:
diff changeset
1044 rcall check_gas_common ; With Gas 0-4 in WREG
heinrichsweikamp
parents:
diff changeset
1045 movlw .4
heinrichsweikamp
parents:
diff changeset
1046 rcall check_gas_common ; With Gas 0-4 in WREG
heinrichsweikamp
parents:
diff changeset
1047 ; bra check_gas_change_exit
heinrichsweikamp
parents:
diff changeset
1048 check_gas_change_exit:
heinrichsweikamp
parents:
diff changeset
1049 btfss better_gas_available ; Is a better gas available
heinrichsweikamp
parents:
diff changeset
1050 bcf blinking_better_gas ; No, Clear blinking flag
heinrichsweikamp
parents:
diff changeset
1051 btfss better_gas_available ; Is a better gas available
heinrichsweikamp
parents:
diff changeset
1052 clrf better_gas_number ; No, Clear better_gas_number (For gaslist display)
heinrichsweikamp
parents:
diff changeset
1053 call TFT_active_gas_divemode ; Display gas/Setpoint
heinrichsweikamp
parents:
diff changeset
1054 return
heinrichsweikamp
parents:
diff changeset
1055
heinrichsweikamp
parents:
diff changeset
1056 check_gas_common: ; With Gas 0-4 in WREG
heinrichsweikamp
parents:
diff changeset
1057 btfsc better_gas_available ; Better Gas already found?
heinrichsweikamp
parents:
diff changeset
1058 return ; Yes, return
heinrichsweikamp
parents:
diff changeset
1059 lfsr FSR1,opt_gas_type ; 0=Disabled, 1=First, 2=Travel, 3=Deco
heinrichsweikamp
parents:
diff changeset
1060 btfss PLUSW1,0 ; Test for Bit0 and 1 -> type=3 -> Deco
heinrichsweikamp
parents:
diff changeset
1061 return ; No
heinrichsweikamp
parents:
diff changeset
1062 btfss PLUSW1,1 ; Test for Bit0 and 1 -> type=3 -> Deco
heinrichsweikamp
parents:
diff changeset
1063 return ; No
heinrichsweikamp
parents:
diff changeset
1064 incf WREG,W ; 1-5
heinrichsweikamp
parents:
diff changeset
1065 cpfseq active_gas ; is this gas currently selected?
heinrichsweikamp
parents:
diff changeset
1066 bra check_gas_common2 ; No
heinrichsweikamp
parents:
diff changeset
1067 return ; Yes, skip test for active gas
heinrichsweikamp
parents:
diff changeset
1068 check_gas_common2:
heinrichsweikamp
parents:
diff changeset
1069 decf WREG,W ; 0-4
heinrichsweikamp
parents:
diff changeset
1070 movwf hi ; Save tested gas 0-4
97
53a99a2dc6a1 CHANGE: Always compute bailout plan based on all active gases
heinrichsweikamp
parents: 89
diff changeset
1071 lfsr FSR1,opt_OC_bail_gas_change
0
heinrichsweikamp
parents:
diff changeset
1072 movff PLUSW1,lo ; Change depth into lo
heinrichsweikamp
parents:
diff changeset
1073 movlw minimum_change_depth
heinrichsweikamp
parents:
diff changeset
1074 cpfsgt lo ; Change depth>minimum_change_depth?
heinrichsweikamp
parents:
diff changeset
1075 return ; No, Change depth not deep enough, skip!
heinrichsweikamp
parents:
diff changeset
1076 movf xC+0,W ; load depth in m into WREG
heinrichsweikamp
parents:
diff changeset
1077 cpfsgt lo ; gas_change_depth < current depth?
69
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1078 bra check_gas_common3 ; No, check if we are within the better_gas_window_pos window
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1079 incf hi,W ; 1-5
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1080 movwf better_gas_number ; number (1-5) of the "better gas" in divemode, =0: no better gas available
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1081 movlw better_gas_window_neg
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1082 subwf lo,W ; Change depth-better_gas_window_neg
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1083 cpfslt xC+0 ; current depth<Change depth-better_gas_window_neg?
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1084 bsf better_gas_available ;=1: A better gas is available and a gas change is advised in divemode
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1085 return
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1086
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1087 check_gas_common3:
0
heinrichsweikamp
parents:
diff changeset
1088 incf hi,W ; 1-5
heinrichsweikamp
parents:
diff changeset
1089 movwf better_gas_number ; number (1-5) of the "better gas" in divemode, =0: no better gas available
69
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1090 movlw better_gas_window_pos
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1091 addwf lo,W ; Change depth+better_gas_window_pos
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1092 cpfsgt xC+0 ; current depth>Change depth+better_gas_window_pos?
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1093 bra check_gas_common4 ; Ok, now check the better gas ppO2<opt_ppO2_max
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1094 return
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1095
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1096 check_gas_common4:
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1097 movf hi,W ; 0-4
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1098 lfsr FSR1,char_I_deco_N2_ratio
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1099 movff PLUSW1,lo ; N2 ratio into lo
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1100 lfsr FSR1,char_I_deco_He_ratio
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1101 movff PLUSW1,xB+0 ; He ratio into xB+0
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1102 movf xB+0,W
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1103 addwf lo,F
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1104 movlw .101
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1105 bcf STATUS,C
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1106 subfwb lo,F ; O2 ratio in lo
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1107
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1108 SAFE_2BYTE_COPY amb_pressure, xA
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1109 movlw d'10'
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1110 movwf xB+0
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1111 clrf xB+1
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1112 call div16x16 ; xC=p_amb/10
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1113 movff xC+0,xA+0
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1114 movff xC+1,xA+1
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1115 movff lo,xB+0 ; =O2 ratio
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1116 clrf xB+1
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1117 call mult16x16 ; lo * p_amb/10
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1118
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1119 ; Check very high ppO2 manually
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1120 tstfsz xC+2 ; char_I_O2_ratio * p_amb/10 > 65536, ppO2>6,55bar?
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1121 return ; Done.
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1122 ; Check if ppO2>3,30bar
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1123 btfsc xC+1,7
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1124 return ; Done.
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1125
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1126 ; ; Check for low ppo2
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1127 ; movff xC+0,sub_b+0
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1128 ; movff xC+1,sub_b+1
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1129 ; movff opt_ppO2_min,WREG
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1130 ; mullw d'100' ; opt_ppO2_min*100
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1131 ; movff PRODL,sub_a+0
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1132 ; movff PRODH,sub_a+1
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1133 ; call subU16
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1134 ; btfss neg_flag
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1135 ; return ; Done (Too low).
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1136
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1137 ;check if we are within our warning thresholds!
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1138 movff xC+0,sub_b+0
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1139 movff xC+1,sub_b+1
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1140 movff opt_ppO2_max,WREG ; PPO2 Max for MOD calculation and color coding in divemode
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1141 addlw .1 ; e.g. >1.60
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1142 mullw d'100' ; opt_ppO2_max*100
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1143 movff PRODL,sub_a+0
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1144 movff PRODH,sub_a+1
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1145 call subU16
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1146 btfss neg_flag
0
heinrichsweikamp
parents:
diff changeset
1147 bsf better_gas_available ;=1: A better gas is available and a gas change is advised in divemode
69
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1148 return ; Done.
0
heinrichsweikamp
parents:
diff changeset
1149
heinrichsweikamp
parents:
diff changeset
1150 check_dil_common: ; With Dil 0-4 in WREG
heinrichsweikamp
parents:
diff changeset
1151 btfsc better_gas_available ; Better Diluent already found?
heinrichsweikamp
parents:
diff changeset
1152 return ; Yes, return
heinrichsweikamp
parents:
diff changeset
1153 lfsr FSR1,opt_dil_type ; 0=Disabled, 1=First, 2=Normal
heinrichsweikamp
parents:
diff changeset
1154 tstfsz PLUSW1 ; =0?
heinrichsweikamp
parents:
diff changeset
1155 bra check_dil_common1 ; No
heinrichsweikamp
parents:
diff changeset
1156 return ; Yes, skip inactive diluents for test
heinrichsweikamp
parents:
diff changeset
1157 check_dil_common1:
heinrichsweikamp
parents:
diff changeset
1158 incf WREG,W ; 1-5
heinrichsweikamp
parents:
diff changeset
1159 cpfseq active_gas ; is this diluent currently selected?
heinrichsweikamp
parents:
diff changeset
1160 bra check_dil_common2 ; No
heinrichsweikamp
parents:
diff changeset
1161 return ; Yes, skip test for active diluent
heinrichsweikamp
parents:
diff changeset
1162 check_dil_common2:
heinrichsweikamp
parents:
diff changeset
1163 decf WREG,W ; 0-4
heinrichsweikamp
parents:
diff changeset
1164 movwf hi ; Save tested diluent 0-4
heinrichsweikamp
parents:
diff changeset
1165 lfsr FSR1,char_I_dil_change
heinrichsweikamp
parents:
diff changeset
1166 movff PLUSW1,lo ; Change depth into lo
heinrichsweikamp
parents:
diff changeset
1167 movlw minimum_change_depth
heinrichsweikamp
parents:
diff changeset
1168 cpfsgt lo ; Change depth>minimum_change_depth?
heinrichsweikamp
parents:
diff changeset
1169 return ; No, Change depth not deep enough, skip!
heinrichsweikamp
parents:
diff changeset
1170 movf xC+0,W ; load depth in m into WREG
heinrichsweikamp
parents:
diff changeset
1171 cpfsgt lo ; gas_change_depth < current depth?
heinrichsweikamp
parents:
diff changeset
1172 return ; No, check next gas
heinrichsweikamp
parents:
diff changeset
1173 incf hi,W ; 1-5
heinrichsweikamp
parents:
diff changeset
1174 addlw .5 ; 6-10
heinrichsweikamp
parents:
diff changeset
1175 movwf better_gas_number ; number (1-5) of the "better gas" in divemode, =0: no better gas available
69
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1176 movlw better_gas_window_neg
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1177 subwf lo,W ; Change depth-better_gas_window_neg
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1178 cpfslt xC+0 ; current depth<Change depth-better_gas_window_neg?
0
heinrichsweikamp
parents:
diff changeset
1179 bsf better_gas_available ;=1: A better gas is available and a gas change is advised in divemode
heinrichsweikamp
parents:
diff changeset
1180 return
heinrichsweikamp
parents:
diff changeset
1181
heinrichsweikamp
parents:
diff changeset
1182 ;=============================================================================
heinrichsweikamp
parents:
diff changeset
1183 ; Setup everything to enter divemode.
heinrichsweikamp
parents:
diff changeset
1184 ;
heinrichsweikamp
parents:
diff changeset
1185
heinrichsweikamp
parents:
diff changeset
1186 dive_boot_oc:
heinrichsweikamp
parents:
diff changeset
1187 extern get_first_gas_to_WREG
heinrichsweikamp
parents:
diff changeset
1188 call get_first_gas_to_WREG ; Gets first gas (0-4) into WREG
heinrichsweikamp
parents:
diff changeset
1189 movff WREG,char_I_first_gas ; Copy for compatibility
heinrichsweikamp
parents:
diff changeset
1190 movff WREG,active_gas ; Set for logbook and display
heinrichsweikamp
parents:
diff changeset
1191 rcall setup_gas_registers ; With WREG=Gas 0-4
heinrichsweikamp
parents:
diff changeset
1192 return
heinrichsweikamp
parents:
diff changeset
1193
heinrichsweikamp
parents:
diff changeset
1194 dive_boot_cc:
heinrichsweikamp
parents:
diff changeset
1195 rcall divemode_setup_sensor_values ; setup sensor values
heinrichsweikamp
parents:
diff changeset
1196 TSTOSS opt_ccr_mode ; =0: Fixed SP, =1: Sensor
heinrichsweikamp
parents:
diff changeset
1197 movff char_I_setpoint_cbar+0,char_I_const_ppO2 ; Setup fixed Setpoint (Always start with SP1)
heinrichsweikamp
parents:
diff changeset
1198 extern get_first_dil_to_WREG
heinrichsweikamp
parents:
diff changeset
1199 call get_first_dil_to_WREG ; Gets first gas (0-4) into WREG
heinrichsweikamp
parents:
diff changeset
1200 movff WREG,char_I_first_gas ; Copy for compatibility
heinrichsweikamp
parents:
diff changeset
1201 movff WREG,active_gas ; Set for logbook and display
heinrichsweikamp
parents:
diff changeset
1202 rcall setup_dil_registers ; With WREG=Gas 0-4
heinrichsweikamp
parents:
diff changeset
1203 return
heinrichsweikamp
parents:
diff changeset
1204
heinrichsweikamp
parents:
diff changeset
1205 diveloop_boot:
heinrichsweikamp
parents:
diff changeset
1206 call restart_set_modes_and_flags
heinrichsweikamp
parents:
diff changeset
1207
heinrichsweikamp
parents:
diff changeset
1208 call I2C_sleep_accelerometer ; Stop accelerometer
heinrichsweikamp
parents:
diff changeset
1209 call I2C_sleep_compass ; Stop compass
heinrichsweikamp
parents:
diff changeset
1210
heinrichsweikamp
parents:
diff changeset
1211 clrf WREG
heinrichsweikamp
parents:
diff changeset
1212 movff WREG,max_pressure+0 ; clear some variables
heinrichsweikamp
parents:
diff changeset
1213 movff WREG,max_pressure+1
heinrichsweikamp
parents:
diff changeset
1214
heinrichsweikamp
parents:
diff changeset
1215 bcf use_agf ; Start with normal GF set
heinrichsweikamp
parents:
diff changeset
1216 bcf divemode_menu ; clear divemode menu flag
heinrichsweikamp
parents:
diff changeset
1217 movlw d'1'
heinrichsweikamp
parents:
diff changeset
1218 movwf apnoe_max_pressure+0
heinrichsweikamp
parents:
diff changeset
1219 clrf apnoe_max_pressure+1
heinrichsweikamp
parents:
diff changeset
1220 clrf apnoe_surface_mins
heinrichsweikamp
parents:
diff changeset
1221 clrf apnoe_surface_secs
heinrichsweikamp
parents:
diff changeset
1222 clrf apnoe_mins
heinrichsweikamp
parents:
diff changeset
1223 clrf divemins+0
heinrichsweikamp
parents:
diff changeset
1224 clrf divemins+1
heinrichsweikamp
parents:
diff changeset
1225 bcf no_more_divesecs ; =1: Do no longer show seconds in divemode
heinrichsweikamp
parents:
diff changeset
1226 bcf divemode_menu_active
heinrichsweikamp
parents:
diff changeset
1227 clrf menupos
heinrichsweikamp
parents:
diff changeset
1228 clrf menupos2 ; Reset to zero (Zero=no premenu or simulator task)
heinrichsweikamp
parents:
diff changeset
1229
heinrichsweikamp
parents:
diff changeset
1230 bcf is_bailout ; =1: Bailout
heinrichsweikamp
parents:
diff changeset
1231 btfss FLAG_ccr_mode
heinrichsweikamp
parents:
diff changeset
1232 rcall dive_boot_oc
heinrichsweikamp
parents:
diff changeset
1233 btfsc FLAG_ccr_mode
heinrichsweikamp
parents:
diff changeset
1234 rcall dive_boot_cc
heinrichsweikamp
parents:
diff changeset
1235
heinrichsweikamp
parents:
diff changeset
1236 bcf better_gas_available ;=1: A better gas is available and a gas change is advised in divemode
heinrichsweikamp
parents:
diff changeset
1237 clrf better_gas_number ; Clear better gas register
heinrichsweikamp
parents:
diff changeset
1238
104
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
1239 bcf show_safety_stop ;=1: Show the safety stop
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
1240 clrf safety_stop_countdown ; Clear count-down
223579e905c3 Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents: 102
diff changeset
1241
0
heinrichsweikamp
parents:
diff changeset
1242 clrf samplesecs
heinrichsweikamp
parents:
diff changeset
1243 clrf apnoe_timeout_counter ; timeout in minutes
heinrichsweikamp
parents:
diff changeset
1244 clrf timeout_counter ; takes care of the timeout (Low byte)
heinrichsweikamp
parents:
diff changeset
1245 clrf timeout_counter2 ; takes care of the timeout (High byte)
heinrichsweikamp
parents:
diff changeset
1246 clrf AlarmType ; Clear all alarms
heinrichsweikamp
parents:
diff changeset
1247 bcf event_occured ; clear flag
98
24b3fd59e61f add event "bailout" in profile
heinrichsweikamp
parents: 97
diff changeset
1248 bcf event2_occured ; clear flag
0
heinrichsweikamp
parents:
diff changeset
1249 clrf total_divetime_seconds+1
heinrichsweikamp
parents:
diff changeset
1250 clrf average_depth_hold_total+0
heinrichsweikamp
parents:
diff changeset
1251 clrf average_depth_hold_total+1
heinrichsweikamp
parents:
diff changeset
1252 clrf average_depth_hold_total+2
heinrichsweikamp
parents:
diff changeset
1253 clrf average_depth_hold_total+3 ; Clear Non-Resettable Average
heinrichsweikamp
parents:
diff changeset
1254 rcall reset_average1 ; Reset the resettable average depth
heinrichsweikamp
parents:
diff changeset
1255 bcf decostop_active
heinrichsweikamp
parents:
diff changeset
1256 bcf better_gas_available ;=1: A better gas is available and a gas change is advised in divemode
heinrichsweikamp
parents:
diff changeset
1257 call ghostwriter_short_header ; Write short header with divenumber into profile memory
heinrichsweikamp
parents:
diff changeset
1258
heinrichsweikamp
parents:
diff changeset
1259 btfsc simulatormode_active
heinrichsweikamp
parents:
diff changeset
1260 bra diveloop_boot_1
heinrichsweikamp
parents:
diff changeset
1261 ; Normal mode = Surface pressure is the pressure 30mn before dive.
heinrichsweikamp
parents:
diff changeset
1262 SAFE_2BYTE_COPY last_surfpressure_30min, int_I_pres_surface ;copy surfacepressure to deco routine
heinrichsweikamp
parents:
diff changeset
1263 SAFE_2BYTE_COPY last_surfpressure_30min, last_surfpressure ;copy surfacepressure to last_surfpressure for correct depth
heinrichsweikamp
parents:
diff changeset
1264 bra diveloop_boot_2
heinrichsweikamp
parents:
diff changeset
1265
heinrichsweikamp
parents:
diff changeset
1266 diveloop_boot_1:
heinrichsweikamp
parents:
diff changeset
1267 ; Simulator mode: Surface pressure is 1bar.
heinrichsweikamp
parents:
diff changeset
1268 movlw LOW .1000
heinrichsweikamp
parents:
diff changeset
1269 movff WREG,int_I_pres_surface+0 ; LOW copy surfacepressure to deco routine
heinrichsweikamp
parents:
diff changeset
1270 movlw HIGH .1000
heinrichsweikamp
parents:
diff changeset
1271 movff WREG,int_I_pres_surface+1 ; HIGH copy surfacepressure to deco routine
heinrichsweikamp
parents:
diff changeset
1272
heinrichsweikamp
parents:
diff changeset
1273 diveloop_boot_2:
heinrichsweikamp
parents:
diff changeset
1274 SAFE_2BYTE_COPY temperature,minimum_temperature ; Reset Min-Temp registers
heinrichsweikamp
parents:
diff changeset
1275
heinrichsweikamp
parents:
diff changeset
1276 ; Init profile recording parameters
23
e402813343b6 new option to switch samplingrate between 10s and 2s
heinrichsweikamp
parents: 0
diff changeset
1277 movff samplingrate,samplesecs_value ; to avoid EEPROM access in the ISR
0
heinrichsweikamp
parents:
diff changeset
1278 movlw div_temperature
heinrichsweikamp
parents:
diff changeset
1279 movwf divisor_temperature ; load divisors for profile storage
heinrichsweikamp
parents:
diff changeset
1280 movlw div_deco
heinrichsweikamp
parents:
diff changeset
1281 movwf divisor_deco
heinrichsweikamp
parents:
diff changeset
1282 movlw div_gf
heinrichsweikamp
parents:
diff changeset
1283 movwf divisor_gf
heinrichsweikamp
parents:
diff changeset
1284 movlw div_ppo2_sensors
heinrichsweikamp
parents:
diff changeset
1285 movwf divisor_ppo2_sensors
heinrichsweikamp
parents:
diff changeset
1286 movlw div_decoplan
heinrichsweikamp
parents:
diff changeset
1287 movwf divisor_decoplan
heinrichsweikamp
parents:
diff changeset
1288 movlw div_cns
heinrichsweikamp
parents:
diff changeset
1289 movwf divisor_cns
heinrichsweikamp
parents:
diff changeset
1290 movlw div_tank
heinrichsweikamp
parents:
diff changeset
1291 movwf divisor_tank
heinrichsweikamp
parents:
diff changeset
1292
heinrichsweikamp
parents:
diff changeset
1293 btfss FLAG_apnoe_mode ; In Apnoe mode?
102
37275e0fa7f5 NEW: Show End-of-Dive time together with clock during deco
heinrichsweikamp
parents: 99
diff changeset
1294 bra divemode_boot1
0
heinrichsweikamp
parents:
diff changeset
1295 ; Overwrite some parameters in Apnoe mode....
heinrichsweikamp
parents:
diff changeset
1296 movlw samplingrate_apnoe
heinrichsweikamp
parents:
diff changeset
1297 movwf samplesecs_value ; to avoid EEPROM access in the ISR
102
37275e0fa7f5 NEW: Show End-of-Dive time together with clock during deco
heinrichsweikamp
parents: 99
diff changeset
1298 divemode_boot1:
37275e0fa7f5 NEW: Show End-of-Dive time together with clock during deco
heinrichsweikamp
parents: 99
diff changeset
1299 btfsc FLAG_ccr_mode ; =1: CCR mode (Fixed ppO2 or Sensor) active
37275e0fa7f5 NEW: Show End-of-Dive time together with clock during deco
heinrichsweikamp
parents: 99
diff changeset
1300 bra divemode_boot2
37275e0fa7f5 NEW: Show End-of-Dive time together with clock during deco
heinrichsweikamp
parents: 99
diff changeset
1301 ; in OC Mode, disable ppO2 logging
37275e0fa7f5 NEW: Show End-of-Dive time together with clock during deco
heinrichsweikamp
parents: 99
diff changeset
1302 movlw .0
37275e0fa7f5 NEW: Show End-of-Dive time together with clock during deco
heinrichsweikamp
parents: 99
diff changeset
1303 movwf divisor_ppo2_sensors
37275e0fa7f5 NEW: Show End-of-Dive time together with clock during deco
heinrichsweikamp
parents: 99
diff changeset
1304 divemode_boot2:
0
heinrichsweikamp
parents:
diff changeset
1305
heinrichsweikamp
parents:
diff changeset
1306 bcf LEDg
heinrichsweikamp
parents:
diff changeset
1307 bcf LEDr
heinrichsweikamp
parents:
diff changeset
1308 bcf realdive
heinrichsweikamp
parents:
diff changeset
1309 btfss simulatormode_active ; do not disable in simulator mode!
heinrichsweikamp
parents:
diff changeset
1310 call disable_rs232 ; Disable RS232
heinrichsweikamp
parents:
diff changeset
1311 btfsc enable_screen_dumps ; =1: Ignore vin_usb, wait for "l" command (Screen dump)
heinrichsweikamp
parents:
diff changeset
1312 call enable_rs232 ; Also sets to speed_normal ...
39
e4e91fe8b09d remember last customview in dive and surface mode
mh@mh-THINK.fritz.box
parents: 38
diff changeset
1313 ; Reset divetime seconds
e4e91fe8b09d remember last customview in dive and surface mode
mh@mh-THINK.fritz.box
parents: 38
diff changeset
1314 movlw .2 ; Start at 2seconds
0
heinrichsweikamp
parents:
diff changeset
1315 movwf total_divetime_seconds+0
39
e4e91fe8b09d remember last customview in dive and surface mode
mh@mh-THINK.fritz.box
parents: 38
diff changeset
1316 movwf divesecs
e4e91fe8b09d remember last customview in dive and surface mode
mh@mh-THINK.fritz.box
parents: 38
diff changeset
1317 movwf apnoe_secs
0
heinrichsweikamp
parents:
diff changeset
1318 bsf divemode2 ; displayed divetime is running (Divetime starts HERE)
heinrichsweikamp
parents:
diff changeset
1319
heinrichsweikamp
parents:
diff changeset
1320 movff int_O_CNS_fraction+0,CNS_start+0
heinrichsweikamp
parents:
diff changeset
1321 movff int_O_CNS_fraction+1,CNS_start+1 ; Save CNS value at beginning of dive
heinrichsweikamp
parents:
diff changeset
1322 movff char_O_relative_gradient_GF,GF_start ; Save GF value at beginning of dive
heinrichsweikamp
parents:
diff changeset
1323 return ; Done with divemode boot
heinrichsweikamp
parents:
diff changeset
1324
heinrichsweikamp
parents:
diff changeset
1325 divemode_check_for_warnings:
heinrichsweikamp
parents:
diff changeset
1326 btfss secs,1 ; Every four seconds
heinrichsweikamp
parents:
diff changeset
1327 return
heinrichsweikamp
parents:
diff changeset
1328
heinrichsweikamp
parents:
diff changeset
1329 movf warning_counter_backup,W
heinrichsweikamp
parents:
diff changeset
1330 cpfseq warning_counter ; warning_counter_backup = warning_counter?
heinrichsweikamp
parents:
diff changeset
1331 call TFT_clear_warning_text ; No, clear all warnings
heinrichsweikamp
parents:
diff changeset
1332 movff warning_counter,warning_counter_backup ; copy warning_counter
heinrichsweikamp
parents:
diff changeset
1333
heinrichsweikamp
parents:
diff changeset
1334 bcf warning_active ; Clear flag
heinrichsweikamp
parents:
diff changeset
1335 clrf warning_counter ; Clear counter
heinrichsweikamp
parents:
diff changeset
1336
heinrichsweikamp
parents:
diff changeset
1337 ; Warnings for all modes
heinrichsweikamp
parents:
diff changeset
1338 call check_warn_battery ; Check if the battery level should be displayed/warned
55
448ba265fdae Change "O2" warning to "ppO2"
heinrichsweikamp
parents: 39
diff changeset
1339 call check_divetimeout ; Not actually a warning. Check and show the divemode timeout
0
heinrichsweikamp
parents:
diff changeset
1340
heinrichsweikamp
parents:
diff changeset
1341 btfsc FLAG_apnoe_mode ; Done for Apnoe or Gauge mode
heinrichsweikamp
parents:
diff changeset
1342 bra divemode_check_for_warnings2
heinrichsweikamp
parents:
diff changeset
1343 btfsc FLAG_gauge_mode ; Done for Apnoe or Gauge mode
heinrichsweikamp
parents:
diff changeset
1344 bra divemode_check_for_warnings2
heinrichsweikamp
parents:
diff changeset
1345
heinrichsweikamp
parents:
diff changeset
1346 ; Warnings only in deco modes
heinrichsweikamp
parents:
diff changeset
1347 btfss FLAG_ccr_mode ; Don't check in CCR mode
heinrichsweikamp
parents:
diff changeset
1348 rcall check_ppO2 ; check ppO2 and displays warning, if required
heinrichsweikamp
parents:
diff changeset
1349 btfsc is_bailout ; But check in Bailout case...
heinrichsweikamp
parents:
diff changeset
1350 rcall check_ppO2 ; check ppO2 and displays warning, if required
heinrichsweikamp
parents:
diff changeset
1351 rcall check_cns_violation ; Check CNS value and display it, if required
heinrichsweikamp
parents:
diff changeset
1352 btfsc decostop_active ; In deco mode?
heinrichsweikamp
parents:
diff changeset
1353 rcall check_and_store_gf_violation ; Yes, Sets warnings, if required
heinrichsweikamp
parents:
diff changeset
1354 btfsc decostop_active ; In deco mode?
heinrichsweikamp
parents:
diff changeset
1355 call TFT_ftts ; Show @+x time
heinrichsweikamp
parents:
diff changeset
1356 btfsc use_agf ; In aGF mode?
heinrichsweikamp
parents:
diff changeset
1357 rcall warn_agf ; Yes, show a warning for it
heinrichsweikamp
parents:
diff changeset
1358
heinrichsweikamp
parents:
diff changeset
1359 divemode_check_for_warnings2:
heinrichsweikamp
parents:
diff changeset
1360 ; Display the warning icon?
heinrichsweikamp
parents:
diff changeset
1361 btfsc warning_active ; Any warning active?
heinrichsweikamp
parents:
diff changeset
1362 call TFT_divemode_warning ; Yes
heinrichsweikamp
parents:
diff changeset
1363 btfss warning_active ; Any warning active?
heinrichsweikamp
parents:
diff changeset
1364 call TFT_divemode_warning_clear ; No, clear warning icon
heinrichsweikamp
parents:
diff changeset
1365
heinrichsweikamp
parents:
diff changeset
1366 ; Setup warning_page number
heinrichsweikamp
parents:
diff changeset
1367 incf warning_page,F
heinrichsweikamp
parents:
diff changeset
1368 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
1369 rlcf warning_page,W ; *2
heinrichsweikamp
parents:
diff changeset
1370 cpfsgt warning_counter ; > warning_counter
heinrichsweikamp
parents:
diff changeset
1371 clrf warning_page ; No, clear
heinrichsweikamp
parents:
diff changeset
1372
heinrichsweikamp
parents:
diff changeset
1373 ; Clear 2nd row of warnings if there is nothing to show (on this page)
heinrichsweikamp
parents:
diff changeset
1374 btfss second_row_warning ; =1: The second row contains a warning
heinrichsweikamp
parents:
diff changeset
1375 call TFT_clear_warning_text_2nd_row ; No, clear this row
heinrichsweikamp
parents:
diff changeset
1376 return ; Done.
heinrichsweikamp
parents:
diff changeset
1377
heinrichsweikamp
parents:
diff changeset
1378 global check_warn_battery
heinrichsweikamp
parents:
diff changeset
1379 check_warn_battery:
heinrichsweikamp
parents:
diff changeset
1380 movff batt_percent,lo
heinrichsweikamp
parents:
diff changeset
1381 movlw battery_show_level+1
heinrichsweikamp
parents:
diff changeset
1382 cpfslt lo
heinrichsweikamp
parents:
diff changeset
1383 return ; No Display, no warning
heinrichsweikamp
parents:
diff changeset
1384 ; Display Battery, but warn?
heinrichsweikamp
parents:
diff changeset
1385 incf warning_counter,F ; increase counter
heinrichsweikamp
parents:
diff changeset
1386 call TFT_update_batt_percent_divemode ; Show percent
heinrichsweikamp
parents:
diff changeset
1387
86
3bbbfab9818f CHANGE: No warning sign for selected aGF
heinrichsweikamp
parents: 83
diff changeset
1388 movff batt_percent,lo
0
heinrichsweikamp
parents:
diff changeset
1389 movlw color_code_battery_low+1
heinrichsweikamp
parents:
diff changeset
1390 cpfslt lo ;
heinrichsweikamp
parents:
diff changeset
1391 return ; No warning
heinrichsweikamp
parents:
diff changeset
1392 bsf warning_active ; Set Warning flag
heinrichsweikamp
parents:
diff changeset
1393 return
heinrichsweikamp
parents:
diff changeset
1394
55
448ba265fdae Change "O2" warning to "ppO2"
heinrichsweikamp
parents: 39
diff changeset
1395 check_divetimeout:
448ba265fdae Change "O2" warning to "ppO2"
heinrichsweikamp
parents: 39
diff changeset
1396 btfsc divemode2
448ba265fdae Change "O2" warning to "ppO2"
heinrichsweikamp
parents: 39
diff changeset
1397 return ; displayed divetime is not running
448ba265fdae Change "O2" warning to "ppO2"
heinrichsweikamp
parents: 39
diff changeset
1398 incf warning_counter,F ; increase counter
448ba265fdae Change "O2" warning to "ppO2"
heinrichsweikamp
parents: 39
diff changeset
1399 call TFT_divetimeout ; Show timeout counter
448ba265fdae Change "O2" warning to "ppO2"
heinrichsweikamp
parents: 39
diff changeset
1400 return
448ba265fdae Change "O2" warning to "ppO2"
heinrichsweikamp
parents: 39
diff changeset
1401
448ba265fdae Change "O2" warning to "ppO2"
heinrichsweikamp
parents: 39
diff changeset
1402
0
heinrichsweikamp
parents:
diff changeset
1403 check_ppO2: ; check current ppO2 and display warning if required
heinrichsweikamp
parents:
diff changeset
1404 SAFE_2BYTE_COPY amb_pressure, xA
heinrichsweikamp
parents:
diff changeset
1405 movlw d'10'
heinrichsweikamp
parents:
diff changeset
1406 movwf xB+0
heinrichsweikamp
parents:
diff changeset
1407 clrf xB+1
heinrichsweikamp
parents:
diff changeset
1408 call div16x16 ; xC=p_amb/10
heinrichsweikamp
parents:
diff changeset
1409
heinrichsweikamp
parents:
diff changeset
1410 movff xC+0,xA+0
heinrichsweikamp
parents:
diff changeset
1411 movff xC+1,xA+1
heinrichsweikamp
parents:
diff changeset
1412 movff char_I_O2_ratio,xB+0 ; =O2 ratio
heinrichsweikamp
parents:
diff changeset
1413 clrf xB+1
heinrichsweikamp
parents:
diff changeset
1414 call mult16x16 ; char_I_O2_ratio * p_amb/10
heinrichsweikamp
parents:
diff changeset
1415
heinrichsweikamp
parents:
diff changeset
1416 ; Check very high ppO2 manually
heinrichsweikamp
parents:
diff changeset
1417 tstfsz xC+2 ; char_I_O2_ratio * p_amb/10 > 65536, ppO2>6,55bar?
heinrichsweikamp
parents:
diff changeset
1418 bra check_ppO2_1 ; Yes, display Value!
heinrichsweikamp
parents:
diff changeset
1419 ; Check if ppO2>3,30bar
heinrichsweikamp
parents:
diff changeset
1420 btfsc xC+1,7
heinrichsweikamp
parents:
diff changeset
1421 bra check_ppO2_1 ; Yes!
heinrichsweikamp
parents:
diff changeset
1422
heinrichsweikamp
parents:
diff changeset
1423 ; Check for low ppo2
heinrichsweikamp
parents:
diff changeset
1424 movff xC+0,sub_b+0
heinrichsweikamp
parents:
diff changeset
1425 movff xC+1,sub_b+1
heinrichsweikamp
parents:
diff changeset
1426 movff opt_ppO2_min,WREG
heinrichsweikamp
parents:
diff changeset
1427 mullw d'100' ; opt_ppO2_min*100
heinrichsweikamp
parents:
diff changeset
1428 movff PRODL,sub_a+0
heinrichsweikamp
parents:
diff changeset
1429 movff PRODH,sub_a+1
heinrichsweikamp
parents:
diff changeset
1430 call subU16
heinrichsweikamp
parents:
diff changeset
1431 btfsc neg_flag
heinrichsweikamp
parents:
diff changeset
1432 bra check_ppO2_0 ; Not too low
heinrichsweikamp
parents:
diff changeset
1433 ; ppO2 low
heinrichsweikamp
parents:
diff changeset
1434 incf warning_counter,F ; increase counter
heinrichsweikamp
parents:
diff changeset
1435 call TFT_display_ppo2 ; Show ppO2
heinrichsweikamp
parents:
diff changeset
1436 movlw d'4' ; Type of Alarm (ppO2 low)
heinrichsweikamp
parents:
diff changeset
1437 movwf AlarmType ; Copy to Alarm Register
heinrichsweikamp
parents:
diff changeset
1438 bsf event_occured ; Set Event Flag
heinrichsweikamp
parents:
diff changeset
1439 bsf warning_active ; Set Warning flag
heinrichsweikamp
parents:
diff changeset
1440 return ; Done.
heinrichsweikamp
parents:
diff changeset
1441
heinrichsweikamp
parents:
diff changeset
1442 check_ppO2_0:
heinrichsweikamp
parents:
diff changeset
1443 ; Check if ppO2 should be displayed
heinrichsweikamp
parents:
diff changeset
1444 movlw ppo2_display_high
heinrichsweikamp
parents:
diff changeset
1445 mullw d'100' ; ppo2_display_high*100
heinrichsweikamp
parents:
diff changeset
1446 movff PRODL,sub_a+0
heinrichsweikamp
parents:
diff changeset
1447 movff PRODH,sub_a+1
heinrichsweikamp
parents:
diff changeset
1448 call subU16
heinrichsweikamp
parents:
diff changeset
1449 btfss neg_flag
heinrichsweikamp
parents:
diff changeset
1450 return ; No Display, no warning
heinrichsweikamp
parents:
diff changeset
1451 ; Display ppO2, but warn?
heinrichsweikamp
parents:
diff changeset
1452 incf warning_counter,F ; increase counter
heinrichsweikamp
parents:
diff changeset
1453 call TFT_display_ppo2 ; Show ppO2
heinrichsweikamp
parents:
diff changeset
1454
heinrichsweikamp
parents:
diff changeset
1455 ;check if we are within our warning thresholds!
heinrichsweikamp
parents:
diff changeset
1456 movff xC+0,sub_b+0
heinrichsweikamp
parents:
diff changeset
1457 movff xC+1,sub_b+1
heinrichsweikamp
parents:
diff changeset
1458 movff opt_ppO2_max,WREG ; PPO2 Max for MOD calculation and color coding in divemode
69
50697bd41c54 +CHANGE: Some French Translations
heinrichsweikamp
parents: 55
diff changeset
1459 addlw .1 ; e.g. >1.60
0
heinrichsweikamp
parents:
diff changeset
1460 mullw d'100' ; opt_ppO2_max*100
heinrichsweikamp
parents:
diff changeset
1461 movff PRODL,sub_a+0
heinrichsweikamp
parents:
diff changeset
1462 movff PRODH,sub_a+1
heinrichsweikamp
parents:
diff changeset
1463 call subU16
heinrichsweikamp
parents:
diff changeset
1464 btfss neg_flag
heinrichsweikamp
parents:
diff changeset
1465 return ; Done. Not too high
heinrichsweikamp
parents:
diff changeset
1466 movlw d'5' ; Type of Alarm (ppO2 high)
heinrichsweikamp
parents:
diff changeset
1467 movwf AlarmType ; Copy to Alarm Register
heinrichsweikamp
parents:
diff changeset
1468 bsf event_occured ; Set Event Flag
heinrichsweikamp
parents:
diff changeset
1469 bsf warning_active ; Set Warning flag
heinrichsweikamp
parents:
diff changeset
1470 return ; Done.
heinrichsweikamp
parents:
diff changeset
1471
heinrichsweikamp
parents:
diff changeset
1472 check_ppO2_1: ; ppO2 very high
heinrichsweikamp
parents:
diff changeset
1473 incf warning_counter,F ; increase counter
heinrichsweikamp
parents:
diff changeset
1474 call TFT_display_ppo2 ; Show ppO2
heinrichsweikamp
parents:
diff changeset
1475 movlw d'5' ; Type of Alarm
heinrichsweikamp
parents:
diff changeset
1476 movwf AlarmType ; Copy to Alarm Register
heinrichsweikamp
parents:
diff changeset
1477 bsf event_occured ; Set Event Flag
heinrichsweikamp
parents:
diff changeset
1478 bsf warning_active ; Set Warning flag
heinrichsweikamp
parents:
diff changeset
1479 return ; Done.
heinrichsweikamp
parents:
diff changeset
1480
heinrichsweikamp
parents:
diff changeset
1481 global check_cns_violation
heinrichsweikamp
parents:
diff changeset
1482 check_cns_violation:
heinrichsweikamp
parents:
diff changeset
1483 ; Check if CNS should be displayed
heinrichsweikamp
parents:
diff changeset
1484 movff int_O_CNS_fraction+1,lo ; copy into bank1
heinrichsweikamp
parents:
diff changeset
1485 tstfsz lo ; >255% ?
heinrichsweikamp
parents:
diff changeset
1486 bra check_cns_violation2 ; Yes
heinrichsweikamp
parents:
diff changeset
1487 movff int_O_CNS_fraction+0,lo ; copy into bank1
heinrichsweikamp
parents:
diff changeset
1488
heinrichsweikamp
parents:
diff changeset
1489 movlw cns_warning_high ; cns_warning_high
heinrichsweikamp
parents:
diff changeset
1490 subwf lo,W
heinrichsweikamp
parents:
diff changeset
1491 btfsc STATUS,C
heinrichsweikamp
parents:
diff changeset
1492 bsf warning_active ; Set Warning flag
heinrichsweikamp
parents:
diff changeset
1493
heinrichsweikamp
parents:
diff changeset
1494 movlw cns_display_high ; cns_display_high
heinrichsweikamp
parents:
diff changeset
1495 subwf lo,W
heinrichsweikamp
parents:
diff changeset
1496 btfss STATUS,C
heinrichsweikamp
parents:
diff changeset
1497 return ; No Display, no warning
heinrichsweikamp
parents:
diff changeset
1498 ; Display CNS
heinrichsweikamp
parents:
diff changeset
1499 incf warning_counter,F ; increase counter
heinrichsweikamp
parents:
diff changeset
1500 call TFT_display_cns ; Show CNS
heinrichsweikamp
parents:
diff changeset
1501 return
heinrichsweikamp
parents:
diff changeset
1502
heinrichsweikamp
parents:
diff changeset
1503 check_cns_violation2:
heinrichsweikamp
parents:
diff changeset
1504 incf warning_counter,F ; increase counter
heinrichsweikamp
parents:
diff changeset
1505 call TFT_display_cns ; Show CNS
heinrichsweikamp
parents:
diff changeset
1506 bsf warning_active ; Set Warning flag
heinrichsweikamp
parents:
diff changeset
1507 return
heinrichsweikamp
parents:
diff changeset
1508
heinrichsweikamp
parents:
diff changeset
1509 global check_and_store_gf_violation
heinrichsweikamp
parents:
diff changeset
1510 check_and_store_gf_violation:
heinrichsweikamp
parents:
diff changeset
1511 movff char_O_gradient_factor,lo ; gradient factor absolute (Non-GF model)
heinrichsweikamp
parents:
diff changeset
1512 movff char_I_deco_model,hi
heinrichsweikamp
parents:
diff changeset
1513 decfsz hi,F ; jump over next line if char_I_deco_model == 1
heinrichsweikamp
parents:
diff changeset
1514 movff char_O_relative_gradient_GF,lo ; gradient factor relative (GF model)
heinrichsweikamp
parents:
diff changeset
1515
heinrichsweikamp
parents:
diff changeset
1516 movlw gf_warning_high
heinrichsweikamp
parents:
diff changeset
1517 cpfsgt lo
heinrichsweikamp
parents:
diff changeset
1518 bra check_and_store_gf_violation2 ; No warning
heinrichsweikamp
parents:
diff changeset
1519 movlw d'2' ; Type of Alarm
heinrichsweikamp
parents:
diff changeset
1520 movwf AlarmType ; Copy to Alarm Register
heinrichsweikamp
parents:
diff changeset
1521 bsf event_occured ; Set Event Flag
heinrichsweikamp
parents:
diff changeset
1522 bsf warning_active ; Set Warning flag
heinrichsweikamp
parents:
diff changeset
1523 check_and_store_gf_violation2:
heinrichsweikamp
parents:
diff changeset
1524 movlw gf_display_high
heinrichsweikamp
parents:
diff changeset
1525 cpfsgt lo
heinrichsweikamp
parents:
diff changeset
1526 return ; No Display, no warning
heinrichsweikamp
parents:
diff changeset
1527 ; Display GF
heinrichsweikamp
parents:
diff changeset
1528 incf warning_counter,F ; increase counter
heinrichsweikamp
parents:
diff changeset
1529 call TFT_warning_gf ; Show GF Warning
heinrichsweikamp
parents:
diff changeset
1530 return
heinrichsweikamp
parents:
diff changeset
1531
heinrichsweikamp
parents:
diff changeset
1532 warn_agf:
heinrichsweikamp
parents:
diff changeset
1533 incf warning_counter,F ; increase counter
heinrichsweikamp
parents:
diff changeset
1534 call TFT_warning_agf ; Show aGF warning
86
3bbbfab9818f CHANGE: No warning sign for selected aGF
heinrichsweikamp
parents: 83
diff changeset
1535 ; bsf warning_active ; Set Warning flag
0
heinrichsweikamp
parents:
diff changeset
1536 return
heinrichsweikamp
parents:
diff changeset
1537
heinrichsweikamp
parents:
diff changeset
1538
heinrichsweikamp
parents:
diff changeset
1539 END