|
0
|
1
|
|
|
2 ; OSTC - diving computer code
|
|
|
3 ; Copyright (C) 2008 HeinrichsWeikamp GbR
|
|
|
4
|
|
|
5 ; This program is free software: you can redistribute it and/or modify
|
|
|
6 ; it under the terms of the GNU General Public License as published by
|
|
|
7 ; the Free Software Foundation, either version 3 of the License, or
|
|
|
8 ; (at your option) any later version.
|
|
|
9
|
|
|
10 ; This program is distributed in the hope that it will be useful,
|
|
|
11 ; but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
12 ; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
13 ; GNU General Public License for more details.
|
|
|
14
|
|
|
15 ; You should have received a copy of the GNU General Public License
|
|
|
16 ; along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
|
17
|
|
|
18
|
|
|
19 ; Mainroutines for divemode
|
|
|
20 ; written by: Matthias Heinrichs, info@heinrichsweikamp.com
|
|
|
21 ; written: 10/01/05
|
|
|
22 ; last updated: 15/05/08
|
|
|
23 ; known bugs:
|
|
|
24 ; ToDo:
|
|
|
25
|
|
|
26 diveloop:
|
|
|
27 call diveloop_boot ; Boot tasks for all modes
|
|
|
28
|
|
|
29 ; Startup Tasks for all modes
|
|
|
30 ostc_debug 'R' ; Sends debug-information to screen if debugmode active
|
|
|
31 call PLED_ClearScreen ; clean up OLED
|
|
|
32 call PLED_divemode_mask ; Display mask
|
|
|
33 call PLED_active_gas_divemode ; Display gas, if required
|
|
|
34 call PLED_temp_divemode ; Displays temperature
|
|
|
35
|
|
|
36 btfsc FLAG_apnoe_mode
|
|
|
37 bsf realdive ; Set Realdive flag in Apnoe mode
|
|
|
38
|
|
|
39 btfsc gauge_mode
|
|
|
40 bra diveloop_loop ; Skip in gauge mode
|
|
|
41 btfsc FLAG_apnoe_mode
|
|
|
42 bra diveloop_loop ; Skip in apnoe mode
|
|
|
43
|
|
|
44 ; Startup Tasks for deco modes
|
|
|
45 call PLED_display_ndl_mask ; display "no stop" if not in gauge or apnoe mode
|
|
|
46
|
|
|
47 diveloop_loop: ; The diveloop starts here
|
|
|
48 btfss onesecupdate ; tasks any new second
|
|
|
49 bra diveloop_loop2
|
|
|
50
|
|
|
51 btfsc gauge_mode ; Only in gauge mode
|
|
|
52 bra diveloop_loop1a ; One Second Tasks in Gauge mode
|
|
|
53 btfsc FLAG_apnoe_mode ; Only in apnoe mode
|
|
|
54 bra diveloop_loop1b ; One Second Tasks in Apnoe mode
|
|
|
55 btfsc FLAG_const_ppO2_mode ; only in const_ppO2_mode
|
|
|
56 bra diveloop_loop1c ; One Second Tasks in const_ppO2 mode
|
|
|
57
|
|
|
58 ; Tasks only for OC modes
|
|
|
59 call check_ppO2 ; check ppO2 and displays warning if required
|
|
|
60 call calc_deko_divemode ; calculate decompression and display result (any two seconds)
|
|
|
61 bra diveloop_loop1x ; Common Tasks
|
|
|
62
|
|
|
63 ; Tasks only for Gauge mode
|
|
|
64 diveloop_loop1a:
|
|
|
65 btfss premenu ; Is the divemode menu active?
|
|
|
66 call PLED_divemins ; display (new) divetime!
|
|
|
67 call timeout_divemode ; dive finished? This routine sets the required flags
|
|
|
68
|
|
|
69 btfsc stopwatch_active ; =1: Show Average Depth instead of Temperature
|
|
|
70 call PLED_stopwatch_show ; Show stopwatch only in Average mode
|
|
|
71
|
|
|
72 btfsc twosecupdate ; two seconds after the last call
|
|
|
73 bra diveloop_loop1a2 ; Common Tasks
|
|
|
74
|
|
|
75 bsf twosecupdate ; Routines used in the "other second"
|
|
|
76 call calc_average_depth ; calculate average depth
|
|
|
77
|
|
|
78 bra diveloop_loop1x ; Common Tasks
|
|
|
79
|
|
|
80 diveloop_loop1a2:
|
|
|
81 bcf twosecupdate
|
|
|
82 bra diveloop_loop1x ; Common Tasks
|
|
|
83
|
|
|
84 ; Tasks only for Apnoe mode
|
|
|
85 diveloop_loop1b:
|
|
|
86 call divemode_apnoe_tasks ; 1 sec. Apnoe tasks
|
|
|
87 bra diveloop_loop1x ; Common Tasks
|
|
|
88
|
|
|
89 ; Tasks only for ppO2 mode
|
|
|
90 diveloop_loop1c:
|
|
|
91 call PLED_const_ppO2_value ; display const ppO2 setting in [Bar]
|
|
|
92 call calc_deko_divemode ; calculate decompression and display result (any two seconds)
|
|
3
|
93 btfsc is_bailout ; Are we in Bailout mode?
|
|
|
94 call check_ppO2_bail ; Yes, display ppO2 (If required)
|
|
|
95
|
|
0
|
96 bra diveloop_loop1x ; Common Tasks
|
|
|
97
|
|
|
98 ; Common Tasks for all modes
|
|
|
99 diveloop_loop1x:
|
|
|
100 call timeout_divemode ; dive finished? This routine sets the required flags
|
|
|
101 btfsc low_battery_state ; If battery is low, then...
|
|
|
102 call update_batt_voltage_divemode ; Display Battery Symbol/Voltage!
|
|
|
103 btfsc premenu ; is Menu? displayed?
|
|
|
104 call timeout_premenu_divemode ; No, so check for timeout premenu
|
|
|
105 btfsc menubit ; is the Dive mode menu displayed?
|
|
|
106 call timeout_divemenu ; Yes, so check for timeout divemenu
|
|
|
107 call set_leds_divemode ; Sets warnings, if required. Also Sets buzzer
|
|
|
108 btfsc enter_error_sleep ; Enter Fatal Error Routine?
|
|
16
|
109 call fatal_error_sleep ; Yes (In Sleepmode_vxx.asm!)
|
|
0
|
110
|
|
|
111 btfsc stopwatch_active ; =1: Show Average Depth instead of Temperature
|
|
|
112 call PLED_stopwatch_show ; Show stopwatch only in Average mode
|
|
|
113
|
|
|
114 bcf onesecupdate ; one seconds update done
|
|
|
115
|
|
|
116 GETCUSTOM8 d'38' ; Show seconds (=1?)
|
|
|
117 movwf lo
|
|
|
118 movlw d'1'
|
|
|
119 cpfseq lo ; =1?
|
|
|
120 bra diveloop_loop2 ; No, minutes only
|
|
|
121 bsf update_divetime ; Set Update flag
|
|
|
122
|
|
|
123
|
|
|
124 diveloop_loop2:
|
|
|
125 btfss update_divetime ; display new divetime?
|
|
|
126 bra diveloop_loop3 ; No
|
|
|
127 btfsc premenu ; Is the divemode menu active?
|
|
|
128 bra diveloop_loop2a ; Yes
|
|
|
129 call PLED_divemins ; Display (new) divetime!
|
|
|
130 btfsc FLAG_const_ppO2_mode ; only in const_ppO2_mode
|
|
|
131 call PLED_const_ppO2_value ; display const ppO2 setting in [Bar]
|
|
|
132 btfsc ppO2_show_value ; show ppO2?
|
|
|
133 call check_ppO2 ; check ppO2 and displays warning if required
|
|
|
134
|
|
|
135 diveloop_loop2a:
|
|
|
136 bcf update_divetime ; clear flag
|
|
|
137
|
|
|
138
|
|
|
139 diveloop_loop3:
|
|
|
140 btfss menubit ; Divemode menu active?
|
|
|
141 call test_switches_divemode ; No, Check switches normal
|
|
|
142
|
|
|
143 btfsc menubit ; Divemode menu active?
|
|
|
144 call test_switches_divemode_menu ; Yes, check switches divemode menu
|
|
|
145
|
|
|
146 btfss divemode ; Dive finished?
|
|
|
147 bra end_dive ; Dive finished!
|
|
|
148
|
|
|
149 btfsc pressure_refresh ; new pressure available?
|
|
|
150 call update_divemode1 ; Yes, display new depth
|
|
|
151 bcf pressure_refresh ; until new pressure is available
|
|
|
152
|
|
|
153 btfsc oneminupdate ; one minute tasks
|
|
|
154 call update_divemode60 ; Update clock, etc.
|
|
|
155
|
|
|
156 btfsc store_sample ; store new sample?
|
|
|
157 call store_dive_data ; Store profile data
|
|
|
158
|
|
2
|
159 btfsc menubit ; Sleep only with inactive menu...
|
|
|
160 bra diveloop_loop4
|
|
|
161
|
|
|
162 btfsc simulatormode_active ; Do not sleep in Simualtor mode
|
|
|
163 bra diveloop_loop4
|
|
|
164
|
|
0
|
165 sleep
|
|
|
166 nop
|
|
2
|
167 diveloop_loop4:
|
|
0
|
168 bra diveloop_loop ; Loop the divemode
|
|
|
169
|
|
|
170 timeout_premenu_divemode:
|
|
|
171 incf timeout_counter3,F ; Yes...
|
|
|
172
|
|
|
173 GETCUSTOM8 d'4' ; loads premenu_timeout into WREG
|
|
|
174 cpfsgt timeout_counter3 ; ... longer then premenu_timeout
|
|
|
175 return ; No!
|
|
|
176
|
|
|
177 bcf premenu ; Yes, so clear "Menu?" and clear pre_menu bit
|
|
|
178 call PLED_menu_clear ; Remove "Menu?"
|
|
|
179 return
|
|
|
180
|
|
|
181 divemode_apnoe_tasks: ; 1 sec. Apnoe tasks
|
|
|
182 call PLED_display_apnoe_descent ; Show descent timer
|
|
|
183
|
|
|
184 btfsc divemode2 ; Time running?
|
|
|
185 bra divemode_apnoe_tasks2 ; New descent, reset data if flag is set
|
|
|
186
|
|
|
187 call PLED_display_apnoe_surface
|
|
|
188 incf apnoe_surface_secs,F
|
|
|
189 movlw d'60'
|
|
|
190 cpfseq apnoe_surface_secs
|
|
|
191 bra divemode_apnoe_tasks1
|
|
|
192 clrf apnoe_surface_secs
|
|
|
193 incf apnoe_surface_mins,F
|
|
|
194
|
|
|
195 divemode_apnoe_tasks1:
|
|
|
196 bcf FLAG_active_descent ; Clear flag
|
|
|
197 btfsc divemode2 ; Time running?
|
|
|
198 return ; Yes, return
|
|
|
199
|
|
|
200 bsf FLAG_active_descent ; Set Flag
|
|
|
201 return
|
|
|
202
|
|
|
203 divemode_apnoe_tasks2:
|
|
|
204 btfss FLAG_active_descent ; Are descending?
|
|
|
205 return ; No, We are at the surface
|
|
|
206 rcall apnoe_calc_maxdepth ; Yes!
|
|
|
207
|
|
|
208 divemode_apnoe_tasks3:
|
|
|
209 call PLED_apnoe_clear_surface ; Clear Surface timer
|
|
|
210
|
|
|
211 clrf apnoe_timeout_counter ; Delete timeout
|
|
|
212 clrf apnoe_surface_secs
|
|
|
213 clrf apnoe_surface_mins
|
|
|
214 clrf apnoe_secs
|
|
|
215 clrf apnoe_mins ; Reset Descent time
|
|
|
216 clrf max_pressure+0
|
|
|
217 clrf max_pressure+1 ; Reset Max. Depth
|
|
|
218 bcf FLAG_active_descent ; Clear flag
|
|
|
219 return
|
|
|
220
|
|
|
221 apnoe_calc_maxdepth:
|
|
|
222 movff apnoe_max_pressure+0,sub_a+0
|
|
|
223 movff apnoe_max_pressure+1,sub_a+1
|
|
|
224 movff max_pressure+0,sub_b+0
|
|
|
225 movff max_pressure+1,sub_b+1
|
|
|
226 call sub16 ; sub_c = sub_a - sub_b
|
|
|
227 ; apnoe_max_pressure<max_pressure -> neg_flag=1
|
|
|
228 ; max_pressure<=apnoe_max_pressure -> neg_flag=0
|
|
|
229 btfss neg_flag
|
|
|
230 return
|
|
|
231 ;apnoe_max_pressure<max_pressure
|
|
|
232 movff max_pressure+0,apnoe_max_pressure+0
|
|
|
233 movff max_pressure+1,apnoe_max_pressure+1
|
|
|
234 return
|
|
|
235
|
|
|
236 set_leds_divemode:
|
|
21
|
237 bcf LED_red ; LEDy OFF
|
|
0
|
238 movff char_O_gradient_factor,lo ; gradient factor absolute
|
|
|
239
|
|
|
240 GETCUSTOM8 d'14' ; threshold for LED warning
|
|
|
241 cpfslt lo ;
|
|
|
242 call warn_gf1 ; show warning, set flags
|
|
|
243
|
|
|
244 btfsc ppO2_warn_value ; warn because of too high ppO2?
|
|
21
|
245 bsf LED_red ; Yes
|
|
0
|
246
|
|
|
247 movff char_I_deco_model,lo
|
|
|
248 decfsz lo,W ; jump over return if char_I_deco_model == 1
|
|
|
249 return
|
|
|
250
|
|
|
251 movff char_O_relative_gradient_GF,lo ; gradient factor relative (GF model)
|
|
|
252
|
|
|
253 GETCUSTOM8 d'14' ; threshold for LED warning
|
|
|
254 cpfslt lo ;
|
|
|
255 call warn_gf1 ; show warning, set flags
|
|
|
256
|
|
|
257 btfsc ppO2_warn_value ; warn because of too high ppO2?
|
|
21
|
258 bsf LED_red ; Yes
|
|
0
|
259
|
|
|
260 return
|
|
|
261
|
|
|
262 warn_gf1:
|
|
21
|
263 bsf LED_red ; LED Yellow on
|
|
0
|
264 movlw d'2' ; Type of Alarm
|
|
|
265 movwf AlarmType ; Copy to Alarm Register
|
|
|
266 bsf event_occured ; Set Event Flag
|
|
|
267 return
|
|
|
268
|
|
|
269 calc_deko_divemode:
|
|
|
270 btfsc twosecupdate ; two seconds after the last call
|
|
|
271 bra calc_deko_divemode2 ; Yes, calculate and display deco data ("first second")
|
|
|
272
|
|
|
273 ; Routines used in the "other second"
|
|
|
274
|
|
|
275 bsf twosecupdate ; No, but next second!
|
|
|
276 call calc_average_depth ; calculate average depth
|
|
|
277 call calc_velocity ; calculate vertical velocity and display if > threshold (every two seconds)
|
|
|
278
|
|
|
279 ; calculate ppO2 in 0.1Bar (e.g. 150 = 1.50Bar ppO2)
|
|
|
280 movff amb_pressure+0,xA+0
|
|
|
281 movff amb_pressure+1,xA+1
|
|
|
282 movlw LOW d'10'
|
|
|
283 movwf xB+0
|
|
|
284 movlw HIGH d'10'
|
|
|
285 clrf xB+1
|
|
|
286 call div16x16 ; xC=p_amb/10
|
|
|
287 movff xC+0,xA+0
|
|
|
288 movff xC+1,xA+1
|
|
|
289 movff char_I_O2_ratio,xB+0
|
|
|
290 clrf xB+1
|
|
|
291 call mult16x16 ; char_I_O2_ratio * p_amb/10
|
|
|
292 movff xC+0,xA+0
|
|
|
293 movff xC+1,xA+1
|
|
|
294 movlw LOW d'100'
|
|
|
295 movwf xB+0
|
|
|
296 movlw HIGH d'100'
|
|
|
297 clrf xB+1
|
|
|
298 call div16x16 ; xC=(char_I_O2_ratio * p_amb/10)/100
|
|
|
299
|
|
|
300 ; Copy ppO2 for CNS calculation
|
|
|
301 movff xC+0, char_I_actual_ppO2 ; copy last ppO2 to buffer register
|
|
|
302 btfsc FLAG_const_ppO2_mode ; do in const_ppO2_mode
|
|
|
303 movff char_I_const_ppO2, char_I_actual_ppO2 ; copy last ppO2 to buffer register
|
|
|
304
|
|
|
305 ; Calculate CNS
|
|
|
306 call main_calc_CNS_fraction ; calculate CNS
|
|
|
307 movlb b'00000001' ; rambank 1 selected
|
|
|
308
|
|
|
309 ; Check if CNS should be displayed
|
|
|
310 movff char_O_CNS_fraction,lo ; copy into bank1
|
|
|
311 GETCUSTOM8 d'27' ; cns_display_high
|
|
|
312 subwf lo,W
|
|
|
313 btfsc STATUS,C
|
|
|
314 call PLED_display_cns ; Show CNS
|
|
|
315
|
|
8
|
316 call check_gas_change ; Checks if a better gas should be selected (by user)
|
|
|
317
|
|
0
|
318 ; Check for decompression gases if in decomode
|
|
|
319 divemode_check_decogases: ; CALLed from Simulator
|
|
|
320 btfss dekostop_active
|
|
|
321 bra reset_decompression_gases ; While in NDL, do not set deompression gas
|
|
|
322
|
|
33
|
323 ; Copy active gases to char_I_deco_N2_ratio and char_I_deco_He_ratio
|
|
0
|
324
|
|
33
|
325 clrf hi ; # of gas (0-4)
|
|
|
326 ; Gas0 is Start gas, do not copy
|
|
|
327
|
|
|
328 lfsr FSR1, char_I_deco_He_ratio5 ; most shallow decogas
|
|
|
329
|
|
|
330 divemode_check_decogases2:
|
|
|
331 incf hi,F ; increase
|
|
|
332 rcall copy_decogas_info
|
|
|
333 movlw d'4'
|
|
|
334 cpfseq hi ; 4 Gases copied?
|
|
|
335 bra divemode_check_decogases2 ; No, Continue
|
|
0
|
336
|
|
33
|
337 ; Now, set change depth. Inactive gases get depth=0!
|
|
0
|
338
|
|
|
339 read_int_eeprom d'27' ; read flag register
|
|
33
|
340 movff EEDATA,hi ; temp
|
|
|
341
|
|
|
342 read_int_eeprom d'28' ; read gas_change_depth Gas1
|
|
|
343 movlw d'0'
|
|
|
344 btfsc hi,1 ; Skip if clear -> Skip if inactive
|
|
|
345 movf EEDATA,W
|
|
|
346 movff WREG,char_I_deco_gas_change5
|
|
0
|
347
|
|
33
|
348 read_int_eeprom d'29' ; read gas_change_depth Gas2
|
|
|
349 movlw d'0'
|
|
|
350 btfsc hi,2 ; Skip if clear -> Skip if inactive
|
|
|
351 movf EEDATA,W
|
|
|
352 movff WREG,char_I_deco_gas_change4
|
|
0
|
353
|
|
33
|
354 read_int_eeprom d'30' ; read gas_change_depth Gas3
|
|
|
355 movlw d'0'
|
|
|
356 btfsc hi,3 ; Skip if clear -> Skip if inactive
|
|
|
357 movf EEDATA,W
|
|
|
358 movff WREG,char_I_deco_gas_change3
|
|
0
|
359
|
|
33
|
360 read_int_eeprom d'31' ; read gas_change_depth Gas1
|
|
|
361 movlw d'0'
|
|
|
362 btfsc hi,4 ; Skip if clear -> Skip if inactive
|
|
|
363 movf EEDATA,W
|
|
|
364 movff WREG,char_I_deco_gas_change2
|
|
|
365
|
|
|
366 return
|
|
0
|
367
|
|
33
|
368 copy_decogas_info:
|
|
|
369 movf hi,W ; Gas 1-4
|
|
|
370 mullw d'4' ; times 4...
|
|
|
371 movf PRODL,W ;
|
|
|
372 addlw d'7' ; +7 = address for He ratio
|
|
0
|
373 movwf EEADR
|
|
|
374 call read_eeprom ; Read He ratio
|
|
33
|
375 movff EEDATA,INDF1 ; And copy into hold register
|
|
0
|
376
|
|
33
|
377 movf hi,W ; Gas 1-4
|
|
|
378 mullw d'4' ; times 4...
|
|
|
379 movf PRODL,W ;
|
|
|
380 addlw d'6' ; +6 = address for O2 ratio
|
|
0
|
381 movwf EEADR
|
|
|
382 call read_eeprom ; Read O2 ratio
|
|
33
|
383 ; movff EEDATA, char_I_O2_ratio ; O2 ratio
|
|
|
384 movff POSTDEC1, wait_temp ; copy into bank1 register
|
|
|
385 bsf STATUS,C ;
|
|
0
|
386 movlw d'100' ; 100%
|
|
|
387 subfwb wait_temp,W ; minus He
|
|
|
388 subfwb EEDATA,F ; minus O2
|
|
33
|
389 movff EEDATA, POSTDEC1 ; = N2!
|
|
|
390 return
|
|
0
|
391
|
|
33
|
392 ;; 1. Find active gas with deepest change depth < current depth
|
|
|
393 ;; 2. Set Decogas
|
|
|
394 ;
|
|
|
395 ; movff rel_pressure+0,xA+0
|
|
|
396 ; movff rel_pressure+1,xA+1
|
|
|
397 ; movlw d'100'
|
|
|
398 ; movwf xB+0
|
|
|
399 ; clrf xB+1
|
|
|
400 ; call div16x16 ; compute depth in full m -> result in xC+0
|
|
|
401 ; clrf lo ; clear depth for comparison
|
|
|
402 ;
|
|
|
403 ;; check gas1
|
|
|
404 ; read_int_eeprom d'27' ; read flag register
|
|
|
405 ; btfss EEDATA,0 ; check active flag
|
|
|
406 ; bra check_decogas2 ; skip inactive gases!
|
|
|
407 ; read_int_eeprom d'28' ; read gas_change_depth
|
|
|
408 ; movf xC+0,W ; load depth in m into WREG
|
|
|
409 ; cpfslt EEDATA ; gas_change_depth > current depth?
|
|
|
410 ; bra check_decogas2 ; W < EEDATA -> current depth lower then gas_change_depth
|
|
|
411 ;
|
|
|
412 ; movff EEDATA,lo ; deepest gas_change_depth in lo
|
|
|
413 ; movlw d'1'
|
|
|
414 ; movwf hi ; Decogas # in hi (1-5)
|
|
|
415 ;
|
|
|
416 ;check_decogas2:
|
|
|
417 ; read_int_eeprom d'27' ; read flag register
|
|
|
418 ; btfss EEDATA,1 ; check active flag
|
|
|
419 ; bra check_decogas3 ; skip inactive gases!
|
|
|
420 ; read_int_eeprom d'29' ; read gas_change_depth
|
|
|
421 ; movf xC+0,W ; load depth in m into WREG
|
|
|
422 ; cpfslt EEDATA ; gas_change_depth > current depth?
|
|
|
423 ; bra check_decogas3 ; W < EEDATA -> current depth lower then gas_change_depth
|
|
|
424 ;
|
|
|
425 ; read_int_eeprom d'29' ; read gas_change_depth
|
|
|
426 ; movf lo,W ; load current gas_change_depth into WREG
|
|
|
427 ; cpfsgt EEDATA ; last gas_change_depth > current gas_change_depth ?
|
|
|
428 ; bra check_decogas3 ; W < lo -> last gas_change_depth > current gas_change_depth
|
|
|
429 ; movff EEDATA,lo ; deepest gas_change_depth in lo
|
|
|
430 ; movlw d'2'
|
|
|
431 ; movwf hi ; Decogas # in hi (1-5)
|
|
|
432 ;
|
|
|
433 ;check_decogas3:
|
|
|
434 ; read_int_eeprom d'27' ; read flag register
|
|
|
435 ; btfss EEDATA,2 ; check active flag
|
|
|
436 ; bra check_decogas4 ; skip inactive gases!
|
|
|
437 ; read_int_eeprom d'30' ; read gas_change_depth
|
|
|
438 ; movf xC+0,W ; load depth in m into WREG
|
|
|
439 ; cpfslt EEDATA ; gas_change_depth > current depth?
|
|
|
440 ; bra check_decogas4 ; W < EEDATA -> current depth lower then gas_change_depth
|
|
|
441 ;
|
|
|
442 ; read_int_eeprom d'30' ; read gas_change_depth
|
|
|
443 ; movf lo,W ; load current gas_change_depth into WREG
|
|
|
444 ; cpfsgt EEDATA ; last gas_change_depth > current gas_change_depth ?
|
|
|
445 ; bra check_decogas4 ; W < lo -> last gas_change_depth > current gas_change_depth
|
|
|
446 ; movff EEDATA,lo ; deepest gas_change_depth in lo
|
|
|
447 ; movlw d'3'
|
|
|
448 ; movwf hi ; Decogas # in hi (1-5)
|
|
|
449 ;
|
|
|
450 ;check_decogas4:
|
|
|
451 ; read_int_eeprom d'27' ; read flag register
|
|
|
452 ; btfss EEDATA,3 ; check active flag
|
|
|
453 ; bra check_decogas5 ; skip inactive gases!
|
|
|
454 ; read_int_eeprom d'31' ; read gas_change_depth
|
|
|
455 ; movf xC+0,W ; load depth in m into WREG
|
|
|
456 ; cpfslt EEDATA ; gas_change_depth > current depth?
|
|
|
457 ; bra check_decogas5 ; W < EEDATA -> current depth lower then gas_change_depth
|
|
|
458 ;
|
|
|
459 ; read_int_eeprom d'31' ; read gas_change_depth
|
|
|
460 ; movf lo,W ; load current gas_change_depth into WREG
|
|
|
461 ; cpfsgt EEDATA ; last gas_change_depth > current gas_change_depth ?
|
|
|
462 ; bra check_decogas5 ; W < lo -> last gas_change_depth > current gas_change_depth
|
|
|
463 ; movff EEDATA,lo ; deepest gas_change_depth in lo
|
|
|
464 ; movlw d'4'
|
|
|
465 ; movwf hi ; Decogas # in hi (1-5)
|
|
|
466 ;
|
|
|
467 ;check_decogas5:
|
|
|
468 ; read_int_eeprom d'27' ; read flag register
|
|
|
469 ; btfss EEDATA,4 ; check active flag
|
|
|
470 ; bra check_decogas_done ; skip inactive gases!
|
|
|
471 ; read_int_eeprom d'32' ; read gas_change_depth
|
|
|
472 ; movf xC+0,W ; load depth in m into WREG
|
|
|
473 ; cpfslt EEDATA ; gas_change_depth > current depth?
|
|
|
474 ; bra check_decogas_done ; W < EEDATA -> current depth lower then gas_change_depth
|
|
|
475 ;
|
|
|
476 ; read_int_eeprom d'32' ; read gas_change_depth
|
|
|
477 ; movf lo,W ; load current gas_change_depth into WREG
|
|
|
478 ; cpfsgt EEDATA ; last gas_change_depth > current gas_change_depth ?
|
|
|
479 ; bra check_decogas_done ; W < lo -> last gas_change_depth > current gas_change_depth
|
|
|
480 ; movff EEDATA,lo ; deepest gas_change_depth in lo
|
|
|
481 ; movlw d'5'
|
|
|
482 ; movwf hi ; Decogas # in hi (1-5)
|
|
|
483 ;
|
|
|
484 ;check_decogas_done:
|
|
|
485 ; ostc_debug 'E' ; Sends debug-information to screen if debugmode active
|
|
|
486 ;
|
|
|
487 ; decf hi,F ; Gas 0-4
|
|
|
488 ; movff lo, char_I_deco_gas_change ; copy change_depth
|
|
|
489 ;
|
|
|
490 ; movf hi,W ; Gas 0-4
|
|
|
491 ; mullw d'4'
|
|
|
492 ; movf PRODL,W
|
|
|
493 ; addlw d'7' ; = address for He ratio
|
|
|
494 ; movwf EEADR
|
|
|
495 ; call read_eeprom ; Read He ratio
|
|
|
496 ; movff EEDATA,char_I_deco_He_ratio ; And copy into hold register
|
|
|
497 ;
|
|
|
498 ;
|
|
|
499 ; movf hi,W ; Gas 0-4
|
|
|
500 ; mullw d'4'
|
|
|
501 ; movf PRODL,W
|
|
|
502 ; addlw d'6' ; = address for O2 ratio
|
|
|
503 ; movwf EEADR
|
|
|
504 ; call read_eeprom ; Read O2 ratio
|
|
|
505 ;
|
|
|
506 ; movff char_I_deco_He_ratio, wait_temp ; copy into bank1 register
|
|
|
507 ; bsf STATUS,C ; Borrow bit
|
|
|
508 ; movlw d'100' ; 100%
|
|
|
509 ; subfwb wait_temp,W ; minus He
|
|
|
510 ; bsf STATUS,C ; Borrow bit
|
|
|
511 ; subfwb EEDATA,F ; minus O2
|
|
|
512 ; movff EEDATA, char_I_deco_N2_ratio ; = N2!
|
|
|
513 ; bra skip_decompression_gases
|
|
|
514 ;
|
|
0
|
515 reset_decompression_gases: ; reset the deco gas while in NDL
|
|
|
516 ostc_debug 'F' ; Sends debug-information to screen if debugmode active
|
|
|
517 clrf lo
|
|
|
518 movff lo, char_I_deco_gas_change ; clear
|
|
|
519 movff lo, char_I_deco_N2_ratio ; clear
|
|
|
520 movff lo, char_I_deco_He_ratio ; clear
|
|
|
521 skip_decompression_gases:
|
|
|
522 ;call PLED_gaschange_DEBUG
|
|
|
523 return
|
|
|
524
|
|
|
525 calc_deko_divemode2:
|
|
|
526 bcf twosecupdate
|
|
|
527
|
|
|
528 btfsc gauge_mode ; ignore decompression calculation in gauge mode
|
|
|
529 return
|
|
|
530 btfsc FLAG_apnoe_mode ; ignore decompression calculation in apnoe mode
|
|
|
531 return
|
|
|
532
|
|
|
533 ostc_debug 'B' ; Sends debug-information to screen if debugmode active
|
|
|
534 call divemode_prepare_flags_for_deco
|
|
|
535 call deco_main_calc_hauptroutine ; calc_tissue
|
|
|
536 movlb b'00000001' ; rambank 1 selected
|
|
|
537 ostc_debug 'C' ; Sends debug-information to screen if debugmode active
|
|
|
538
|
|
|
539 movff char_O_deco_status,deco_status ;
|
|
|
540 tstfsz deco_status ; deco_status=0 if decompression calculation done
|
|
|
541 return ; calculation not yet finished!
|
|
|
542
|
|
|
543 movff char_O_array_decodepth+0,wait_temp ; copy ceiling to temp register
|
|
|
544 tstfsz wait_temp ; Ceiling<0m?
|
|
|
545 bra calc_deko_divemode3 ; Yes!
|
|
|
546
|
|
|
547 btfsc dekostop_active
|
|
|
548 call PLED_display_ndl_mask ; Clear deco data, display nostop time
|
|
|
549 bcf dekostop_active ; clear flag
|
|
|
550
|
|
|
551 clrf decodata+0 ; for profile memory
|
|
|
552 movff char_O_nullzeit,decodata+1 ; nostop time
|
|
|
553
|
|
|
554 call PLED_display_ndl ; display no deco limit
|
|
|
555 return
|
|
|
556
|
|
|
557 divemode_prepare_flags_for_deco:
|
|
|
558 movff amb_pressure+0,int_I_pres_respiration+0 ; lo and copy result to deco routine
|
|
|
559 movff amb_pressure+1,int_I_pres_respiration+1 ; hi
|
|
|
560 GETCUSTOM8 d'11' ; Saturation multiplier %
|
|
|
561 movwf wait_temp
|
|
|
562 movff wait_temp,char_I_saturation_multiplier
|
|
|
563 GETCUSTOM8 d'12' ; Desaturation multiplier %
|
|
|
564 movwf wait_temp
|
|
|
565 movff wait_temp,char_I_desaturation_multiplier
|
|
|
566 GETCUSTOM8 d'16' ; Deco distance to decostop in 1/10 meter for simulation
|
|
|
567 movwf wait_temp
|
|
|
568 movff wait_temp,char_I_deco_distance
|
|
|
569 GETCUSTOM8 d'29' ; Depth Last Deco in meter for simulation
|
|
|
570 movwf wait_temp
|
|
|
571 movff wait_temp,char_I_depth_last_deco
|
|
|
572 call restart_set_modes_and_flags ; Sets decomode (char_I_deco_model) and flags (again)
|
|
|
573 return
|
|
|
574
|
|
|
575 calc_deko_divemode3:
|
|
|
576 btfss dekostop_active
|
|
|
577 call PLED_display_deko_mask ; clear nostop time, display decodata
|
|
|
578 bsf dekostop_active ; Set flag
|
|
|
579
|
|
|
580 movff char_O_array_decodepth+0,decodata+0 ; ceiling
|
|
|
581 movff char_O_array_decotime,decodata+1 ; length of first stop in minues
|
|
|
582
|
|
|
583 call PLED_display_deko ; display decodata
|
|
|
584 return
|
|
|
585
|
|
|
586 store_dive_data: ; CF20 seconds gone
|
|
|
587 bcf store_sample ; update only any CF20 seconds
|
|
|
588 bsf update_divetime ; update divemins every CF20 seconds
|
|
|
589
|
|
21
|
590 bcf LED_red ; LEDr off (Marker)
|
|
0
|
591
|
|
33
|
592 btfsc simulatormode_active ; Are we in simulator mode?
|
|
|
593 return ; Yes, discard everything
|
|
|
594
|
|
0
|
595 btfsc header_stored ; Header already stored?
|
|
|
596 bra store_dive_data2 ; Yes, store only profile data
|
|
|
597 bsf header_stored ; Store header
|
|
|
598
|
|
|
599 movff eeprom_address+0, eeprom_header_address+0 ; store startposition
|
|
|
600 movff eeprom_address+1, eeprom_header_address+1 ; store startposition
|
|
|
601
|
|
|
602 ; shift address for header
|
|
|
603 ; the header will be stored after the dive
|
|
|
604 incf_eeprom_address d'47' ; Macro, that adds 8Bit to eeprom_address:2 with banking at 0x8000
|
|
|
605
|
|
|
606 store_dive_data2:
|
|
|
607 movf rel_pressure+0,W ; store depth with every sample
|
|
|
608 call write_external_eeprom
|
|
|
609 movf rel_pressure+1,W
|
|
|
610 call write_external_eeprom
|
|
|
611
|
|
|
612 ;First, find out how many bytes will append to this sample....
|
|
|
613 clrf ProfileFlagByte ; clear number of bytes to append
|
|
|
614
|
|
|
615 ; Check Extented informations
|
|
|
616 decfsz divisor_temperature,W ; Check divisor
|
|
|
617 bra check_extended1
|
|
|
618 movlw d'2' ; Information length
|
|
|
619 addwf ProfileFlagByte,F ; add to ProfileFlagByte
|
|
|
620 check_extended1:
|
|
|
621 decfsz divisor_deco,W ; Check divisor
|
|
|
622 bra check_extended2
|
|
|
623 movlw d'2' ; Information length
|
|
|
624 addwf ProfileFlagByte,F ; add to ProfileFlagByte
|
|
|
625 check_extended2:
|
|
|
626 decfsz divisor_tank,W ; Check divisor
|
|
|
627 bra check_extended3
|
|
|
628 movlw d'2' ; Information length
|
|
|
629 addwf ProfileFlagByte,F ; add to ProfileFlagByte
|
|
|
630 check_extended3:
|
|
|
631 decfsz divisor_ppo2,W ; Check divisor
|
|
|
632 bra check_extended4
|
|
|
633 movlw d'3' ; Information length
|
|
|
634 addwf ProfileFlagByte,F ; add to ProfileFlagByte
|
|
|
635 check_extended4:
|
|
|
636 decfsz divisor_deco_debug,W; Check divisor
|
|
|
637 bra check_extended5
|
|
|
638 movlw d'9' ; Information length
|
|
|
639 addwf ProfileFlagByte,F ; add to ProfileFlagByte
|
|
|
640 check_extended5:
|
|
|
641 decfsz divisor_nuy2,W ; Check divisor
|
|
|
642 bra check_extended6
|
|
|
643 movlw d'0' ; Information length
|
|
|
644 addwf ProfileFlagByte,F ; add to ProfileFlagByte
|
|
|
645 check_extended6:
|
|
|
646
|
|
|
647 ; Second, check global event flag
|
|
|
648 btfss event_occured ; Check global event flag
|
|
|
649 bra store_dive_data3 ; No Event
|
|
|
650 movlw d'1'
|
|
|
651 addwf ProfileFlagByte,F ; add one byte (The EventByte)
|
|
|
652
|
|
|
653 clrf EventByte ; reset EventByte
|
|
|
654
|
|
|
655 movf AlarmType,W ; Type of Alarm Bit 0-3
|
|
|
656 addwf EventByte,F ; Copy to EventByte Bit 0-3
|
|
|
657 clrf AlarmType ; Reset AlarmType
|
|
|
658
|
|
|
659 ; Third, check events and add aditional bytes
|
|
|
660 btfss manual_gas_changed ; Check flag
|
|
|
661 bra check_event1
|
|
|
662 movlw d'2' ; Information length
|
|
|
663 addwf ProfileFlagByte,F ; add to ProfileFlagByte
|
|
|
664 bsf EventByte,4 ; Also set Flag in EventByte!
|
|
|
665 check_event1:
|
|
|
666 btfss stored_gas_changed ; Check flag
|
|
|
667 bra check_event2
|
|
|
668 movlw d'1' ; Information length
|
|
|
669 addwf ProfileFlagByte,F ; add to ProfileFlagByte
|
|
|
670 bsf EventByte,5 ; Also set Flag in EventByte!
|
|
|
671 check_event2:
|
|
|
672 bsf ProfileFlagByte,7 ; Set EventByte Flag in ProfileFlagByte
|
|
|
673
|
|
|
674 store_dive_data3:
|
|
|
675 movf ProfileFlagByte,W ; finally, write ProfileFlagByte!
|
|
|
676 call write_external_eeprom
|
|
|
677
|
|
|
678 btfss event_occured ; Check global event flag (again)
|
|
|
679 bra store_dive_data4 ; No Event
|
|
|
680
|
|
|
681 ; Store the EventByte + additional bytes now
|
|
|
682 movf EventByte,W
|
|
|
683 call write_external_eeprom
|
|
|
684
|
|
|
685 btfss manual_gas_changed ; Check flag
|
|
|
686 bra store_dive_data3a
|
|
|
687 read_int_eeprom d'24' ; % O2 Gas6
|
|
|
688 movf EEDATA,W
|
|
|
689 call write_external_eeprom
|
|
|
690 read_int_eeprom d'25' ; % He Gas6
|
|
|
691 movf EEDATA,W
|
|
|
692 call write_external_eeprom
|
|
|
693
|
|
|
694 store_dive_data3a:
|
|
|
695 btfss stored_gas_changed ; Check flag
|
|
|
696 bra store_dive_data3b
|
|
|
697 movf active_gas,W ; Store active gas
|
|
|
698 call write_external_eeprom
|
|
|
699
|
|
|
700 store_dive_data3b:
|
|
|
701
|
|
|
702 store_dive_data4:
|
|
|
703 bcf event_occured ; Clear the global event flag
|
|
|
704 bcf manual_gas_changed ; Clear all events
|
|
|
705 bcf stored_gas_changed ; Clear all events
|
|
|
706
|
|
|
707 ; Store extended informations
|
|
|
708 decfsz divisor_temperature,F ; Check divisor
|
|
|
709 bra store_extended1
|
|
|
710 rcall store_dive_temperature
|
|
|
711 store_extended1:
|
|
|
712 decfsz divisor_deco,F ; Check divisor
|
|
|
713 bra store_extended2
|
|
|
714 rcall store_dive_decodata
|
|
|
715 store_extended2:
|
|
|
716 decfsz divisor_tank,F ; Check divisor
|
|
|
717 bra store_extended3
|
|
|
718 rcall store_dive_tankdata
|
|
|
719 store_extended3:
|
|
|
720 decfsz divisor_ppo2,F ; Check divisor
|
|
|
721 bra store_extended4
|
|
|
722 rcall store_dive_ppo2
|
|
|
723 store_extended4:
|
|
|
724 decfsz divisor_deco_debug,F; Check divisor
|
|
|
725 bra store_extended5
|
|
|
726 rcall store_dive_decodebug
|
|
|
727 store_extended5:
|
|
|
728 decfsz divisor_nuy2,F ; Check divisor
|
|
|
729 bra store_extended6
|
|
|
730 rcall store_dive_nuy2
|
|
|
731 store_extended6:
|
|
|
732
|
|
|
733 ; The next block is required to take care of "store never"
|
|
|
734 btfsc divisor_temperature,7 ; Test highest Bit (Register must have been zero before the "decfsz" command!)
|
|
|
735 clrf divisor_temperature ; And clear register again, so it will never reach zero...
|
|
|
736 btfsc divisor_deco,7 ; Test highest Bit (Register must have been zero before the "decfsz" command!)
|
|
|
737 clrf divisor_deco ; And clear register again, so it will never reach zero...
|
|
|
738 btfsc divisor_tank,7 ; Test highest Bit (Register must have been zero before the "decfsz" command!)
|
|
|
739 clrf divisor_tank ; And clear register again, so it will never reach zero...
|
|
|
740 btfsc divisor_ppo2,7 ; Test highest Bit (Register must have been zero before the "decfsz" command!)
|
|
|
741 clrf divisor_ppo2 ; And clear register again, so it will never reach zero...
|
|
|
742 btfsc divisor_deco_debug,7 ; Test highest Bit (Register must have been zero before the "decfsz" command!)
|
|
|
743 clrf divisor_deco_debug ; And clear register again, so it will never reach zero...
|
|
|
744 btfsc divisor_nuy2,7 ; Test highest Bit (Register must have been zero before the "decfsz" command!)
|
|
|
745 clrf divisor_nuy2 ; And clear register again, so it will never reach zero...
|
|
|
746
|
|
|
747 ostc_debug 'D' ; Sends debug-information to screen if debugmode active
|
|
|
748 return ; Done.
|
|
|
749
|
|
|
750 store_dive_nuy2:
|
|
|
751 GETCUSTOM8 d'26'
|
|
|
752 movwf divisor_nuy2 ; Reload divisor from CF
|
|
|
753 return
|
|
|
754
|
|
|
755 store_dive_decodebug:
|
|
|
756 movff 0x931,divisor_deco_debug ; Used as temp
|
|
|
757 movf divisor_deco_debug,W ; copy to WREG
|
|
|
758 call write_external_eeprom ; Store in EEPROM
|
|
|
759 movff 0x930,divisor_deco_debug ; Used as temp
|
|
|
760 movf divisor_deco_debug,W ; copy to WREG
|
|
|
761 call write_external_eeprom ; Store in EEPROM
|
|
|
762 movff 0x933,divisor_deco_debug ; Used as temp
|
|
|
763 movf divisor_deco_debug,W ; copy to WREG
|
|
|
764 call write_external_eeprom ; Store in EEPROM
|
|
|
765 movff 0x932,divisor_deco_debug ; Used as temp
|
|
|
766 movf divisor_deco_debug,W ; copy to WREG
|
|
|
767 call write_external_eeprom ; Store in EEPROM
|
|
|
768 movff 0x935,divisor_deco_debug ; Used as temp
|
|
|
769 movf divisor_deco_debug,W ; copy to WREG
|
|
|
770 call write_external_eeprom ; Store in EEPROM
|
|
|
771 movff 0x934,divisor_deco_debug ; Used as temp
|
|
|
772 movf divisor_deco_debug,W ; copy to WREG
|
|
|
773 call write_external_eeprom ; Store in EEPROM
|
|
|
774 movff 0x937,divisor_deco_debug ; Used as temp
|
|
|
775 movf divisor_deco_debug,W ; copy to WREG
|
|
|
776 call write_external_eeprom ; Store in EEPROM
|
|
|
777 movff 0x936,divisor_deco_debug ; Used as temp
|
|
|
778 movf divisor_deco_debug,W ; copy to WREG
|
|
|
779 call write_external_eeprom ; Store in EEPROM
|
|
|
780 movff 0x938,divisor_deco_debug ; Used as temp
|
|
|
781 movf divisor_deco_debug,W ; copy to WREG
|
|
|
782 call write_external_eeprom ; Store in EEPROM
|
|
|
783 GETCUSTOM8 d'25'
|
|
|
784 movwf divisor_deco_debug ; Reload divisor from CF
|
|
|
785 return
|
|
|
786
|
|
|
787 store_dive_ppo2:
|
|
|
788 movlw 0x00 ; Dummy
|
|
|
789 call write_external_eeprom
|
|
|
790 movlw 0x00 ; Dummy
|
|
|
791 call write_external_eeprom
|
|
|
792 movlw 0x00 ; Dummy
|
|
|
793 call write_external_eeprom
|
|
|
794 GETCUSTOM8 d'24'
|
|
|
795 movwf divisor_ppo2 ; Reload divisor from CF
|
|
|
796 return
|
|
|
797
|
|
|
798 store_dive_tankdata:
|
|
|
799 movlw d'0' ; Dummy Tank1
|
|
|
800 call write_external_eeprom
|
|
|
801 movlw d'0' ; Dummy Tank2
|
|
|
802 call write_external_eeprom
|
|
|
803 GETCUSTOM8 d'23'
|
|
|
804 movwf divisor_tank ; Reload divisor from CF
|
|
|
805 return
|
|
|
806
|
|
|
807 store_dive_decodata:
|
|
|
808 movf decodata+0,W ; =0:no stop dive, if in deco mode: ceiling in m
|
|
|
809 call write_external_eeprom
|
|
|
810 movf decodata+1,W ; no stop time of length of first stop
|
|
|
811 call write_external_eeprom
|
|
|
812 GETCUSTOM8 d'22'
|
|
|
813 movwf divisor_deco ; Reload divisor from CF
|
|
|
814 return
|
|
|
815
|
|
|
816 store_dive_temperature:
|
|
|
817 movf temperature+0,W ; append temperature to current sample!
|
|
|
818 call write_external_eeprom
|
|
|
819 movf temperature+1,W
|
|
|
820 call write_external_eeprom
|
|
|
821 GETCUSTOM8 d'21'
|
|
|
822 movwf divisor_temperature ; Reload divisor from CF
|
|
|
823 return
|
|
|
824
|
|
|
825 calc_velocity: ; called every two seconds
|
|
|
826 btfss divemode
|
|
|
827 bra do_not_display_velocity ; display velocity only in divemode
|
|
|
828
|
|
|
829 calc_velocity2:
|
|
|
830 movff amb_pressure+0,sub_a+0
|
|
|
831 movff amb_pressure+1,sub_a+1
|
|
|
832 movff last_pressure+0,sub_b+0
|
|
|
833 movff last_pressure+1,sub_b+1
|
|
|
834 movff amb_pressure+0,last_pressure+0 ; store old value for velocity
|
|
|
835 movff amb_pressure+1,last_pressure+1
|
|
|
836
|
|
|
837 call sub16 ; sub_c = amb_pressure - last_pressure
|
|
|
838
|
|
|
839 movff sub_c+0,xA+0
|
|
|
840 movff sub_c+1,xA+1
|
|
|
841 movlw d'39' ;77 when called every second....
|
|
|
842 movwf xB+0
|
|
|
843 clrf xB+1
|
|
|
844 call mult16x16 ; differential pressure in mBar*77...
|
|
|
845 movff xC+0,divA+0
|
|
|
846 movff xC+1,divA+1
|
|
|
847 movlw d'7'
|
|
|
848 movwf divB
|
|
|
849 call div16 ; devided by 2^7 equals velocity in m/min
|
|
|
850
|
|
|
851 movlw d'99'
|
|
|
852 cpfsgt divA
|
|
|
853 bra calc_velocity3
|
|
|
854 movwf divA ; divA=99
|
|
|
855
|
|
|
856 calc_velocity3:
|
|
|
857
|
|
|
858 GETCUSTOM8 d'5' ; threshold for display vertical velocity
|
|
|
859 subwf divA+0,W ;
|
|
|
860
|
|
|
861 btfss STATUS,C
|
|
|
862 bra do_not_display_velocity
|
|
|
863
|
|
|
864 update_velocity:
|
|
|
865 bsf display_velocity
|
|
|
866 call PLED_display_velocity
|
|
|
867 return
|
|
|
868
|
|
|
869 do_not_display_velocity:
|
|
|
870 btfss display_velocity ; Velocity was not displayed, do not delete
|
|
|
871 return
|
|
|
872
|
|
|
873 bcf display_velocity ; Velocity was displayed, delete velocity now
|
|
|
874 call PLED_display_velocity_clear
|
|
|
875 return
|
|
|
876
|
|
|
877 check_ppO2: ; check current ppO2 and display warning if required
|
|
|
878 btfsc FLAG_const_ppO2_mode ; ignore in ppO2 mode....
|
|
|
879 return
|
|
|
880
|
|
3
|
881 check_ppO2_bail: ; In CC mode but bailout active!
|
|
0
|
882 movff amb_pressure+0,xA+0
|
|
|
883 movff amb_pressure+1,xA+1
|
|
|
884 movlw d'10'
|
|
|
885 movwf xB+0
|
|
|
886 clrf xB+1
|
|
|
887 call div16x16 ; xC=p_amb/10
|
|
|
888 movff xC+0,xA+0
|
|
|
889 movff xC+1,xA+1
|
|
|
890 movff char_I_O2_ratio,xB+0
|
|
|
891 clrf xB+1
|
|
|
892 call mult16x16 ; char_I_O2_ratio * p_amb/10
|
|
|
893
|
|
|
894 ; Check if ppO2 should be displayed
|
|
|
895 movff xC+0,sub_b+0
|
|
|
896 movff xC+1,sub_b+1
|
|
|
897 GETCUSTOM8 d'19' ; ppo2_display_high
|
|
|
898 mullw d'100' ; ppo2_display_high*100
|
|
|
899 movff PRODL,sub_a+0
|
|
|
900 movff PRODH,sub_a+1
|
|
|
901 call sub16
|
|
|
902 bcf ppO2_show_value ; clear flag
|
|
|
903 btfsc neg_flag
|
|
|
904 bsf ppO2_show_value ; set flag if required
|
|
|
905
|
|
|
906 ;check if we are within our warning thresholds!
|
|
|
907 bcf ppO2_warn_value ; clear flag
|
|
|
908 movff xC+0,sub_b+0
|
|
|
909 movff xC+1,sub_b+1
|
|
|
910 GETCUSTOM8 d'18' ; ppo2_warning_high
|
|
|
911 mullw d'100' ; ppo2_warning_high*100
|
|
|
912 movff PRODL,sub_a+0
|
|
|
913 movff PRODH,sub_a+1
|
|
|
914 call sub16
|
|
|
915 btfss neg_flag
|
|
|
916 bra check_ppO2_0 ; Not too high
|
|
|
917
|
|
|
918 bsf ppO2_warn_value ; set flag
|
|
|
919 movlw d'5' ; Type of Alarm
|
|
|
920 movwf AlarmType ; Copy to Alarm Register
|
|
|
921 bsf event_occured ; Set Event Flag
|
|
|
922
|
|
|
923 check_ppO2_0:
|
|
|
924 movff xC+0,sub_b+0
|
|
|
925 movff xC+1,sub_b+1
|
|
|
926 GETCUSTOM8 d'17' ; ppo2_warning_low
|
|
|
927 mullw d'100' ; ppo2_warning_low*100
|
|
|
928 movff PRODL,sub_a+0
|
|
|
929 movff PRODH,sub_a+1
|
|
|
930 call sub16
|
|
|
931 btfsc neg_flag
|
|
|
932 bra check_ppO2_1 ; Not too low
|
|
|
933
|
|
|
934 bsf ppO2_warn_value ; set flag
|
|
|
935 bsf ppO2_show_value ; show ppO2 if below threshold!
|
|
|
936 movlw d'4' ; Type of Alarm
|
|
|
937 movwf AlarmType ; Copy to Alarm Register
|
|
|
938 bsf event_occured ; Set Event Flag
|
|
|
939
|
|
|
940 check_ppO2_1:
|
|
|
941 btfsc ppO2_show_value ; show value?
|
|
|
942 bra check_ppO2_2 ; yes!
|
|
|
943
|
|
|
944 btfss ppO2_display_active ; is the value displayed?
|
|
|
945 bra check_ppO2_3 ; No, so clear not required
|
|
|
946
|
|
|
947 call PLED_show_ppO2_clear; Clear ppO2 value
|
|
|
948 bcf ppO2_display_active ; clear flag
|
|
|
949 bra check_ppO2_3 ; done
|
|
|
950
|
|
|
951 check_ppO2_2:
|
|
|
952 call PLED_show_ppO2 ; Display ppO2 (stored in xC)
|
|
|
953 bsf ppO2_display_active ; Set flag
|
|
|
954
|
|
|
955 check_ppO2_3:
|
|
|
956 return ; done
|
|
|
957
|
|
|
958
|
|
8
|
959 check_gas_change: ; Checks if a better gas should be selected (by user)
|
|
|
960 bcf better_gas_available ;=1: A better gas is available and a gas change is advised in divemode
|
|
|
961
|
|
|
962 movff rel_pressure+0,xA+0
|
|
|
963 movff rel_pressure+1,xA+1
|
|
|
964 movlw d'100'
|
|
|
965 movwf xB+0
|
|
|
966 clrf xB+1
|
|
|
967 call div16x16 ; compute depth in full m -> result in xC+0
|
|
|
968
|
|
|
969 check_gas_change1: ; check gas1
|
|
|
970 read_int_eeprom d'27' ; read flag register
|
|
|
971 btfss EEDATA,0 ; check active flag
|
|
|
972 bra check_gas_change2 ; skip inactive gases!
|
|
|
973 movlw d'1'
|
|
|
974 cpfseq active_gas ; is this gas currently selected?
|
|
|
975 bra check_gas_change1x ; No...
|
|
|
976 bra check_gas_change2 ; Yes, skip depth check
|
|
|
977 check_gas_change1x:
|
|
|
978 read_int_eeprom d'28' ; read gas_change_depth
|
|
|
979 movlw d'3'
|
|
|
980 cpfsgt EEDATA ; Change depth>3m?
|
|
|
981 bra check_gas_change2 ; No, Change depth not deep enough, skip!
|
|
|
982 movf xC+0,W ; load depth in m into WREG
|
|
|
983 cpfsgt EEDATA ; gas_change_depth < current depth?
|
|
|
984 bra check_gas_change2 ; No, check next gas
|
|
|
985 movlw d'3'
|
|
|
986 subwf EEDATA,W ; Change depth-3m
|
|
|
987 cpfslt xC+0 ; current depth<Change depth-3m?
|
|
|
988 bsf better_gas_available ;=1: A better gas is available and a gas change is advised in divemode
|
|
|
989
|
|
|
990 check_gas_change2: ; check gas2
|
|
|
991 read_int_eeprom d'27' ; read flag register
|
|
|
992 btfss EEDATA,1 ; check active flag
|
|
|
993 bra check_gas_change3 ; skip inactive gases!
|
|
|
994 movlw d'2'
|
|
|
995 cpfseq active_gas ; is this gas currently selected?
|
|
|
996 bra check_gas_change2x ; No...
|
|
|
997 bra check_gas_change3 ; Yes, skip depth check
|
|
|
998 check_gas_change2x:
|
|
|
999 read_int_eeprom d'29' ; read gas_change_depth
|
|
|
1000 movlw d'3'
|
|
|
1001 cpfsgt EEDATA ; Change depth>3m?
|
|
|
1002 bra check_gas_change3 ; No, Change depth not deep enough, skip!
|
|
|
1003 movf xC+0,W ; load depth in m into WREG
|
|
|
1004 cpfsgt EEDATA ; gas_change_depth < current depth?
|
|
|
1005 bra check_gas_change3 ; No, check next gas
|
|
|
1006 movlw d'3'
|
|
|
1007 subwf EEDATA,W ; Change depth-3m
|
|
|
1008 cpfslt xC+0 ; current depth<Change depth-3m?
|
|
|
1009 bsf better_gas_available ;=1: A better gas is available and a gas change is advised in divemode
|
|
|
1010
|
|
|
1011 check_gas_change3: ; check gas3
|
|
|
1012 read_int_eeprom d'27' ; read flag register
|
|
|
1013 btfss EEDATA,2 ; check active flag
|
|
|
1014 bra check_gas_change4 ; skip inactive gases!
|
|
|
1015 movlw d'3'
|
|
|
1016 cpfseq active_gas ; is this gas currently selected?
|
|
|
1017 bra check_gas_change3x ; No...
|
|
|
1018 bra check_gas_change4 ; Yes, skip depth check
|
|
|
1019 check_gas_change3x:
|
|
|
1020 read_int_eeprom d'30' ; read gas_change_depth
|
|
|
1021 movlw d'3'
|
|
|
1022 cpfsgt EEDATA ; Change depth>3m?
|
|
|
1023 bra check_gas_change4 ; No, Change depth not deep enough, skip!
|
|
|
1024 movf xC+0,W ; load depth in m into WREG
|
|
|
1025 cpfsgt EEDATA ; gas_change_depth < current depth?
|
|
|
1026 bra check_gas_change4 ; No, check next gas
|
|
|
1027 movlw d'3'
|
|
|
1028 subwf EEDATA,W ; Change depth-3m
|
|
|
1029 cpfslt xC+0 ; current depth<Change depth-3m?
|
|
|
1030 bsf better_gas_available ;=1: A better gas is available and a gas change is advised in divemode
|
|
|
1031
|
|
|
1032 check_gas_change4: ; check gas4
|
|
|
1033 read_int_eeprom d'27' ; read flag register
|
|
|
1034 btfss EEDATA,3 ; check active flag
|
|
|
1035 bra check_gas_change5 ; skip inactive gases!
|
|
|
1036 movlw d'4'
|
|
|
1037 cpfseq active_gas ; is this gas currently selected?
|
|
|
1038 bra check_gas_change4x ; No...
|
|
|
1039 bra check_gas_change5 ; Yes, skip depth check
|
|
|
1040 check_gas_change4x:
|
|
|
1041 read_int_eeprom d'31' ; read gas_change_depth
|
|
|
1042 cpfsgt EEDATA ; Change depth>3m?
|
|
|
1043 bra check_gas_change5 ; No, Change depth not deep enough, skip!
|
|
|
1044 movf xC+0,W ; load depth in m into WREG
|
|
|
1045 cpfsgt EEDATA ; gas_change_depth < current depth?
|
|
|
1046 bra check_gas_change5 ; No, check next gas
|
|
|
1047 movlw d'3'
|
|
|
1048 subwf EEDATA,W ; Change depth-3m
|
|
|
1049 cpfslt xC+0 ; current depth<Change depth-3m?
|
|
|
1050 bsf better_gas_available ;=1: A better gas is available and a gas change is advised in divemode
|
|
|
1051
|
|
|
1052 check_gas_change5: ; check gas5
|
|
|
1053 read_int_eeprom d'27' ; read flag register
|
|
|
1054 btfss EEDATA,4 ; check active flag
|
|
|
1055 bra check_gas_change6 ; skip inactive gases!
|
|
|
1056 movlw d'5'
|
|
|
1057 cpfseq active_gas ; is this gas currently selected?
|
|
|
1058 bra check_gas_change5x ; No...
|
|
|
1059 bra check_gas_change6 ; Yes, skip depth check
|
|
|
1060 check_gas_change5x:
|
|
|
1061 read_int_eeprom d'32' ; read gas_change_depth
|
|
|
1062 cpfsgt EEDATA ; Change depth>3m?
|
|
|
1063 bra check_gas_change6 ; No, Change depth not deep enough, skip!
|
|
|
1064 movf xC+0,W ; load depth in m into WREG
|
|
|
1065 cpfsgt EEDATA ; gas_change_depth < current depth?
|
|
|
1066 bra check_gas_change6 ; No, check next gas
|
|
|
1067 movlw d'3'
|
|
|
1068 subwf EEDATA,W ; Change depth-3m
|
|
|
1069 cpfslt xC+0 ; current depth<Change depth-3m?
|
|
|
1070 bsf better_gas_available ;=1: A better gas is available and a gas change is advised in divemode
|
|
|
1071
|
|
|
1072 check_gas_change6: ;Done
|
|
|
1073 call PLED_active_gas_divemode ; Display gas, if required (and with "*" if irequired...)
|
|
|
1074 return
|
|
|
1075
|
|
0
|
1076 calculate_noflytime:
|
|
|
1077 ; calculate nofly time
|
|
|
1078 movff int_O_desaturation_time+0,xA+0
|
|
|
1079 movff int_O_desaturation_time+1,xA+1
|
|
|
1080 tstfsz xA+0 ; Desat=0?
|
|
|
1081 bra calculate_noflytime2
|
|
|
1082 tstfsz xA+1 ; Desat=0?
|
|
|
1083 bra calculate_noflytime2
|
|
|
1084 ; Desaturation time = zero
|
|
|
1085 movlw d'1'
|
|
|
1086 movwf nofly_time+0 ; Clear nofly time
|
|
|
1087 clrf nofly_time+1 ; Clear nofly time
|
|
|
1088 bcf nofly_active ; Clear flag
|
|
|
1089 return
|
|
|
1090
|
|
|
1091 calculate_noflytime2:
|
|
|
1092 movff xA+0,int_I_temp+0
|
|
|
1093 movff xA+1,int_I_temp+1
|
|
|
1094 GETCUSTOM8 .13 ; nofly_time_ratio
|
|
|
1095 movwf xB+0
|
|
|
1096 movff xB,char_I_temp
|
|
|
1097 ostc_debug 'K' ; Sends debug-information to screen if debugmode active
|
|
|
1098 call main_calc_percentage
|
|
|
1099 movlb b'00000001' ; select ram bank 1
|
|
|
1100 ostc_debug 'L' ; Sends debug-information to screen if debugmode active
|
|
|
1101 movff int_I_temp+0,xA+0
|
|
|
1102 movff int_I_temp+1,xA+1
|
|
|
1103 tstfsz xA+0 ; Desat=0?
|
|
|
1104 bra calculate_noflytime_2_final
|
|
|
1105 tstfsz xA+1 ; Desat=0?
|
|
|
1106 bra calculate_noflytime_2_final
|
|
|
1107 ; noflytime = zero
|
|
|
1108 movlw d'1'
|
|
|
1109 movwf nofly_time+0 ; Clear nofly time
|
|
|
1110 clrf nofly_time+1 ; Clear nofly time
|
|
|
1111 bcf nofly_active ; Clear flag
|
|
|
1112 return
|
|
|
1113 calculate_noflytime_2_final:
|
|
|
1114 movff xA+0,nofly_time+0
|
|
|
1115 movff xA+1,nofly_time+1
|
|
|
1116 bsf nofly_active ; Set flag
|
|
|
1117 return
|
|
|
1118
|
|
|
1119 end_dive:
|
|
|
1120 btfss realdive ; dive longer then one minute
|
|
|
1121 goto end_dive_common ; No, discard everything
|
|
|
1122
|
|
33
|
1123 btfsc simulatormode_active ; Are we in simulator mode?
|
|
|
1124 goto end_dive_common ; Yes, discard everything
|
|
|
1125
|
|
0
|
1126 ; Dive finished (and longer then one minute or Apnoe timeout occured)
|
|
|
1127
|
|
|
1128 btfsc FLAG_apnoe_mode ; Calc max. depth (again) for very short apnoe dives
|
|
|
1129 rcall apnoe_calc_maxdepth
|
|
|
1130
|
|
|
1131 ; calculate desaturation time
|
|
|
1132 movff last_surfpressure_30min+0,int_I_pres_respiration+0 ; copy surface air pressure to deco routine
|
|
|
1133 movff last_surfpressure_30min+1,int_I_pres_respiration+1 ; 30min old values
|
|
|
1134
|
|
|
1135 GETCUSTOM8 d'12' ; Desaturation multiplier %
|
|
|
1136 movwf wait_temp
|
|
|
1137 movff wait_temp,char_I_desaturation_multiplier
|
|
|
1138
|
|
|
1139 ostc_debug 'G' ; Sends debug-information to screen if debugmode active
|
|
|
1140 call deco_main_calc_desaturation_time ; calculate desaturation time
|
|
|
1141 movlb b'00000001' ; select ram bank 1
|
|
|
1142 rcall calculate_noflytime ; Calc NoFly time
|
|
|
1143 ostc_debug 'H' ; Sends debug-information to screen if debugmode active
|
|
|
1144 ; store header and ...
|
|
|
1145 movlw 0xFD ; .... End-of-Profile Bytes
|
|
|
1146 call write_external_eeprom
|
|
|
1147 movlw 0xFD
|
|
|
1148 call write_external_eeprom
|
|
|
1149 movlw 0xFE ; This positon will be overwritten for the next profile
|
|
|
1150 call write_external_eeprom ; and is required to find the newest dive after a firmware reset
|
|
|
1151
|
|
|
1152 movff eeprom_header_address+0, eeprom_address+0 ; set header adress
|
|
|
1153 movff eeprom_header_address+1, eeprom_address+1 ; write header
|
|
|
1154
|
|
|
1155 movlw 0xFA ; Header start
|
|
|
1156 call write_external_eeprom
|
|
|
1157 movlw 0xFA
|
|
|
1158 call write_external_eeprom
|
|
|
1159 movlw logbook_profile_version ; Defined in definitions_vxyy.asm
|
|
|
1160 call write_external_eeprom
|
|
|
1161 movf month,W ; Date
|
|
|
1162 call write_external_eeprom
|
|
|
1163 movf day,W
|
|
|
1164 call write_external_eeprom
|
|
|
1165 movf year,W
|
|
|
1166 call write_external_eeprom
|
|
|
1167 movf hours,W ; End of dive time
|
|
|
1168 call write_external_eeprom
|
|
|
1169 movf mins,W
|
|
|
1170 call write_external_eeprom
|
|
|
1171
|
|
|
1172 btfss FLAG_apnoe_mode ; Store apnoe max or normal max (Which is only max from the last descent)
|
|
|
1173 bra end_dive1 ; Store normal depth
|
|
|
1174
|
|
|
1175 movff apnoe_max_pressure+0,lo
|
|
|
1176 movff apnoe_max_pressure+1,hi
|
|
|
1177 call adjust_depth_with_salinity ; computes salinity setting into lo:hi [mBar]
|
|
|
1178 movff lo,apnoe_max_pressure+0
|
|
|
1179 movff hi,apnoe_max_pressure+1
|
|
|
1180
|
|
|
1181 movf apnoe_max_pressure+0,W ; Max. depth
|
|
|
1182 call write_external_eeprom
|
|
|
1183 movf apnoe_max_pressure+1,W
|
|
|
1184 call write_external_eeprom
|
|
|
1185 bra end_dive2 ; skip
|
|
|
1186
|
|
|
1187 end_dive1:
|
|
|
1188 movff max_pressure+0,lo
|
|
|
1189 movff max_pressure+1,hi
|
|
|
1190 call adjust_depth_with_salinity ; computes salinity setting into lo:hi [mBar]
|
|
|
1191 movff lo,max_pressure+0
|
|
|
1192 movff hi,max_pressure+1
|
|
|
1193
|
|
|
1194 movf max_pressure+0,W ; Max. depth
|
|
|
1195 call write_external_eeprom
|
|
|
1196 movf max_pressure+1,W
|
|
|
1197 call write_external_eeprom
|
|
|
1198
|
|
|
1199 end_dive2:
|
|
|
1200 movf divemins+0,W ; divetime minutes
|
|
|
1201 call write_external_eeprom
|
|
|
1202 movf divemins+1,W
|
|
|
1203 call write_external_eeprom
|
|
|
1204 movf divesecs,W ; divetime seconds
|
|
|
1205 call write_external_eeprom
|
|
|
1206 movf mintemp+0,W ; minimum temperature
|
|
|
1207 call write_external_eeprom
|
|
|
1208 movf mintemp+1,W
|
|
|
1209 call write_external_eeprom
|
|
|
1210 movf last_surfpressure_30min+0,W ; airpressure before dive
|
|
|
1211 call write_external_eeprom
|
|
|
1212 movf last_surfpressure_30min+1,W
|
|
|
1213 call write_external_eeprom
|
|
|
1214 movff int_O_desaturation_time+0,lo ;
|
|
|
1215 movff int_O_desaturation_time+1,hi
|
|
|
1216 movf lo,W ; desaturation time in minutes
|
|
|
1217 call write_external_eeprom
|
|
|
1218 movf hi,W ;
|
|
|
1219 call write_external_eeprom
|
|
|
1220
|
|
|
1221 ; Gases....
|
|
|
1222 read_int_eeprom d'6' ; Read byte (stored in EEDATA)
|
|
|
1223 movf EEDATA,W
|
|
|
1224 call write_external_eeprom
|
|
|
1225 read_int_eeprom d'7' ; Read byte (stored in EEDATA)
|
|
|
1226 movf EEDATA,W
|
|
|
1227 call write_external_eeprom
|
|
|
1228
|
|
|
1229 read_int_eeprom d'10' ; Read byte (stored in EEDATA)
|
|
|
1230 movf EEDATA,W
|
|
|
1231 call write_external_eeprom
|
|
|
1232 read_int_eeprom d'11' ; Read byte (stored in EEDATA)
|
|
|
1233 movf EEDATA,W
|
|
|
1234 call write_external_eeprom
|
|
|
1235
|
|
|
1236 read_int_eeprom d'14' ; Read byte (stored in EEDATA)
|
|
|
1237 movf EEDATA,W
|
|
|
1238 call write_external_eeprom
|
|
|
1239 read_int_eeprom d'15' ; Read byte (stored in EEDATA)
|
|
|
1240 movf EEDATA,W
|
|
|
1241 call write_external_eeprom
|
|
|
1242
|
|
|
1243 read_int_eeprom d'18' ; Read byte (stored in EEDATA)
|
|
|
1244 movf EEDATA,W
|
|
|
1245 call write_external_eeprom
|
|
|
1246 read_int_eeprom d'19' ; Read byte (stored in EEDATA)
|
|
|
1247 movf EEDATA,W
|
|
|
1248 call write_external_eeprom
|
|
|
1249
|
|
|
1250 read_int_eeprom d'22' ; Read byte (stored in EEDATA)
|
|
|
1251 movf EEDATA,W
|
|
|
1252 call write_external_eeprom
|
|
|
1253 read_int_eeprom d'23' ; Read byte (stored in EEDATA)
|
|
|
1254 movf EEDATA,W
|
|
|
1255 call write_external_eeprom
|
|
|
1256
|
|
|
1257 read_int_eeprom d'24' ; % O2 Gas6
|
|
|
1258 movf EEDATA,W
|
|
|
1259 call write_external_eeprom
|
|
|
1260 read_int_eeprom d'25' ; % He Gas6
|
|
|
1261 movf EEDATA,W
|
|
|
1262 call write_external_eeprom
|
|
|
1263 read_int_eeprom d'33' ; start gas
|
|
|
1264 movf EEDATA,W
|
|
|
1265 call write_external_eeprom
|
|
|
1266
|
|
|
1267 movlw softwareversion_x ; Firmware version
|
|
|
1268 call write_external_eeprom
|
|
|
1269 movlw softwareversion_y
|
|
|
1270 call write_external_eeprom
|
|
|
1271 movf batt_voltage+0,W ; Battery voltage
|
|
|
1272 call write_external_eeprom
|
|
|
1273 movf batt_voltage+1,W
|
|
|
1274 call write_external_eeprom
|
|
|
1275
|
|
|
1276 GETCUSTOM8 d'20' ; sampling rate in WREG
|
|
|
1277 btfsc FLAG_apnoe_mode ; Apnoe mode?
|
|
|
1278 movlw d'1' ; Apnoe sampling rate
|
|
|
1279 call write_external_eeprom
|
|
|
1280
|
|
|
1281 movlw d'2' ; information size temperature
|
|
|
1282 movwf temp1 ; copy to bits 0-3
|
|
|
1283 swapf temp1,F ; swap nibbels 0-3 with 4-7
|
|
|
1284 GETCUSTOM8 d'21' ; Divisor temperature
|
|
|
1285 addwf temp1,W ; copy to bits 0-3, result in WREG
|
|
|
1286 call write_external_eeprom
|
|
|
1287
|
|
|
1288 movlw d'2' ; information size deco
|
|
|
1289 movwf temp1 ; copy to bits 0-3
|
|
|
1290 swapf temp1,F ; swap nibbels 0-3 with 4-7
|
|
|
1291 GETCUSTOM8 d'22' ; Divisor deco
|
|
|
1292 addwf temp1,W ; copy to bits 0-3, result in WREG
|
|
|
1293 call write_external_eeprom
|
|
|
1294
|
|
|
1295 movlw d'2' ; information size tank
|
|
|
1296 movwf temp1 ; copy to bits 0-3
|
|
|
1297 swapf temp1,F ; swap nibbels 0-3 with 4-7
|
|
|
1298 GETCUSTOM8 d'23' ; Divisor Tank
|
|
|
1299 addwf temp1,W ; copy to bits 0-3, result in WREG
|
|
|
1300 call write_external_eeprom
|
|
|
1301
|
|
|
1302 movlw d'3' ; information size pp02
|
|
|
1303 movwf temp1 ; copy to bits 0-3
|
|
|
1304 swapf temp1,F ; swap nibbels 0-3 with 4-7
|
|
|
1305 GETCUSTOM8 d'24' ; Divisor pp02
|
|
|
1306 addwf temp1,W ; copy to bits 0-3, result in WREG
|
|
|
1307 call write_external_eeprom
|
|
|
1308
|
|
|
1309 movlw d'9' ; information size Decodebug
|
|
|
1310 movwf temp1 ; copy to bits 0-3
|
|
|
1311 swapf temp1,F ; swap nibbels 0-3 with 4-7
|
|
|
1312 GETCUSTOM8 d'25' ; Divisor Decodebug
|
|
|
1313 addwf temp1,W ; copy to bits 0-3, result in WREG
|
|
|
1314 call write_external_eeprom
|
|
|
1315
|
|
|
1316 movlw d'0' ; information size nuy2
|
|
|
1317 movwf temp1 ; copy to bits 0-3
|
|
|
1318 swapf temp1,F ; swap nibbels 0-3 with 4-7
|
|
|
1319 GETCUSTOM8 d'26' ; Divisor nuy2
|
|
|
1320 addwf temp1,W ; copy to bits 0-3, result in WREG
|
|
|
1321 call write_external_eeprom
|
|
|
1322
|
|
|
1323 read_int_eeprom d'26' ; Read Salinity from EEPROM
|
|
|
1324 movf EEDATA,W
|
|
|
1325 call write_external_eeprom ; Store Salinity to Dive
|
|
|
1326
|
|
|
1327 movlw d'0' ; Spare
|
|
|
1328 call write_external_eeprom
|
|
|
1329
|
|
|
1330 movlw 0xFB ; Header stop
|
|
|
1331 call write_external_eeprom
|
|
|
1332 movlw 0xFB
|
|
|
1333 call write_external_eeprom
|
|
|
1334
|
|
25
|
1335 btfsc simulatormode_active ; Are we in simulator mode?
|
|
|
1336 bra change_logbook_offset2 ; Yes, do not update history
|
|
|
1337
|
|
0
|
1338 ; Increase total dive counter
|
|
|
1339 read_int_eeprom d'2' ; Read byte (stored in EEDATA)
|
|
|
1340 movff EEDATA,temp1 ; Low byte
|
|
|
1341 read_int_eeprom d'3' ; Read byte (stored in EEDATA)
|
|
|
1342 movff EEDATA,temp2 ; high byte
|
|
|
1343 bcf STATUS,C
|
|
|
1344 movlw d'1'
|
|
|
1345 addwf temp1
|
|
|
1346 movlw d'0'
|
|
|
1347 addwfc temp2
|
|
|
1348 movff temp1,EEDATA
|
|
|
1349 write_int_eeprom d'2' ; write byte stored in EEDATA
|
|
|
1350 movff temp2,EEDATA
|
|
|
1351 write_int_eeprom d'3' ; write byte stored in EEDATA
|
|
|
1352
|
|
|
1353 GETCUSTOM15 .28 ; Logbook Offset -> lo, hi
|
|
|
1354 tstfsz lo ; lo=0?
|
|
|
1355 bra change_logbook_offset1 ; No, adjust offset
|
|
|
1356 tstfsz hi ; hi=0?
|
|
|
1357 bra change_logbook_offset1 ; No, adjust offset
|
|
|
1358 bra change_logbook_offset2 ; lo=0 and hi=0 -> skip Offset routine
|
|
|
1359 change_logbook_offset1:
|
|
|
1360 movlw d'1'
|
|
|
1361 addwf lo
|
|
|
1362 movlw d'0'
|
|
|
1363 addwfc hi
|
|
|
1364 movlw d'112' ; CF28 *4 Bytes...
|
|
|
1365 addlw 0x82
|
|
|
1366 movwf EEADR
|
|
|
1367 movff lo,EEDATA
|
|
|
1368 call write_eeprom ; Lowbyte
|
|
|
1369 movlw d'112' ; CF28 *4 Bytes...
|
|
|
1370 addlw 0x83
|
|
|
1371 movwf EEADR
|
|
|
1372 movff hi,EEDATA
|
|
|
1373 call write_eeprom ; Highbyte
|
|
|
1374
|
|
|
1375 change_logbook_offset2:
|
|
25
|
1376 bcf LED_blue
|
|
33
|
1377
|
|
|
1378 end_dive_common:
|
|
0
|
1379 bcf simulatormode_active ; if we were in simulator mode
|
|
|
1380
|
|
|
1381 btfsc restore_deco_data ; Restore decodata?
|
|
|
1382 call simulator_restore_tissue_data ; Yes!
|
|
|
1383
|
|
|
1384 call deco_main_gradient_array
|
|
|
1385 movlb b'00000001' ; select ram bank 1
|
|
|
1386
|
|
|
1387 clrf surface_interval+0
|
|
|
1388 clrf surface_interval+1 ; Clear surface interval timer
|
|
|
1389
|
|
|
1390 goto surfloop ; and return to surfaceloop
|
|
|
1391
|
|
|
1392 timeout_divemode:
|
|
|
1393 btfss realdive ; Dive longer then one minute
|
|
|
1394 return
|
|
|
1395
|
|
|
1396 btfsc FLAG_apnoe_mode ; In Apnoe mode?
|
|
|
1397 bra timeout_divemode2 ; Yes, use CF30 [min] for timeout
|
|
|
1398
|
|
|
1399 btfsc simulatormode_active ; In Simulator mode?
|
|
|
1400 bra timeout_divemode3 ; Yes, use fixed 5 seconds timeout
|
|
|
1401
|
|
|
1402 bcf divemode
|
|
|
1403 incf timeout_counter,F
|
|
|
1404 GETCUSTOM8 d'2' ; diveloop_timeout
|
|
|
1405 addlw d'2' ; adds two seconds in case timout=zero!
|
|
|
1406 btfsc STATUS,C ; > 255?
|
|
|
1407 movlw d'255' ; Set to 255...
|
|
|
1408 decf WREG,F ; Limit to 254
|
|
|
1409 cpfsgt timeout_counter
|
|
|
1410 bsf divemode
|
|
|
1411 return
|
|
|
1412
|
|
|
1413 timeout_divemode2:
|
|
|
1414 incf timeout_counter,F ; seconds...
|
|
|
1415 movlw d'60'
|
|
|
1416 cpfseq timeout_counter ; timeout_counter=60?
|
|
|
1417 return ; No.
|
|
|
1418
|
|
|
1419 clrf timeout_counter
|
|
|
1420 bcf divemode
|
|
|
1421 incf apnoe_timeout_counter,F
|
|
|
1422 GETCUSTOM8 d'30' ; apnoe timeout [min]
|
|
|
1423 cpfseq apnoe_timeout_counter
|
|
|
1424 bsf divemode
|
|
|
1425 return
|
|
|
1426
|
|
|
1427 timeout_divemode3:
|
|
|
1428 bcf divemode
|
|
|
1429 incf timeout_counter,F
|
|
|
1430 movlw d'5' ; Fixed timeout of 5 seconds
|
|
|
1431 cpfsgt timeout_counter
|
|
|
1432 bsf divemode
|
|
|
1433 return
|
|
|
1434
|
|
|
1435 update_divemode1: ; update any second
|
|
|
1436 call set_dive_modes ; tests if depth>threshold
|
|
|
1437
|
|
|
1438 btfsc divemode
|
|
|
1439 call set_max_depth ; update max. depth if required
|
|
|
1440
|
|
|
1441 btfsc divemode
|
|
|
1442 call set_min_temp ; store min. temp if required
|
|
|
1443
|
|
|
1444 bcf temp_changed ; Display temperature?
|
|
|
1445 movf temperature+0,W
|
|
|
1446 cpfseq last_temperature+0
|
|
|
1447 bsf temp_changed ; Yes
|
|
|
1448 movf temperature+1,W
|
|
|
1449 cpfseq last_temperature+1
|
|
|
1450 bsf temp_changed ; Yes
|
|
|
1451 btfsc temp_changed
|
|
|
1452 call PLED_temp_divemode ; Displays temperature
|
|
|
1453
|
|
|
1454 bcf pres_changed ; Display new depth?
|
|
|
1455 movf amb_pressure+0,W
|
|
|
1456 cpfseq last_pressure+0
|
|
|
1457 bsf pres_changed ; Yes
|
|
|
1458 movf amb_pressure+1,W
|
|
|
1459 cpfseq last_pressure+1
|
|
|
1460 bsf pres_changed ; Yes
|
|
|
1461
|
|
|
1462 btfsc simulatormode_active ; always update depth when in simulator mode
|
|
|
1463 bsf pres_changed
|
|
|
1464
|
|
|
1465 btfsc pres_changed
|
|
|
1466 call PLED_depth ; Displays new depth
|
|
|
1467 return
|
|
|
1468
|
|
|
1469 update_divemode60: ; update any minute
|
|
|
1470 call get_battery_voltage ; gets battery voltage
|
|
|
1471 call set_powersafe ; red LED blinking if battery is low
|
|
|
1472 call PLED_max_pressure ; No, use normal max. depth
|
|
|
1473 call check_temp_extrema ; check for new temperature extremas
|
|
|
1474 bcf oneminupdate
|
|
|
1475 return
|
|
|
1476
|
|
|
1477 set_max_depth:
|
|
|
1478 movff max_pressure+0,sub_a+0
|
|
|
1479 movff max_pressure+1,sub_a+1
|
|
|
1480 movff rel_pressure+0,sub_b+0
|
|
|
1481 movff rel_pressure+1,sub_b+1
|
|
|
1482 call sub16 ; sub_c = sub_a - sub_b
|
|
|
1483 ; max_pressure<rel_pressure -> neg_flag=1
|
|
|
1484 ; rel_pressure<=max_pressure -> neg_flag=0
|
|
|
1485 btfss neg_flag
|
|
|
1486 return
|
|
|
1487 ;max_pressure<rel_pressure
|
|
|
1488 movff rel_pressure+0,max_pressure+0
|
|
|
1489 movff rel_pressure+1,max_pressure+1
|
|
|
1490 call PLED_max_pressure ; No, use normal max. depth
|
|
|
1491 return
|
|
|
1492
|
|
|
1493 set_min_temp:
|
|
|
1494 movff mintemp+0,sub_a+0
|
|
|
1495 movff mintemp+1,sub_a+1
|
|
|
1496 movff temperature+0,sub_b+0
|
|
|
1497 movff temperature+1,sub_b+1
|
|
|
1498 call sub16 ; sub_c = sub_a - sub_b
|
|
|
1499 ; mintemp<T -> neg_flag=1
|
|
|
1500 ; T<=mintemp -> neg_flag=0
|
|
|
1501 btfsc neg_flag
|
|
|
1502 return
|
|
|
1503 ;mintemp>=T
|
|
|
1504 movff temperature+0,mintemp+0
|
|
|
1505 movff temperature+1,mintemp+1
|
|
|
1506 return
|
|
|
1507
|
|
|
1508 set_dive_modes:
|
|
|
1509 bcf divemode2 ; Stop time
|
|
|
1510
|
|
|
1511 GETCUSTOM8 .0 ; loads dive_threshold in WREG
|
|
|
1512 movwf sub_a+0 ; dive_treshold is in cm
|
|
|
1513 clrf sub_a+1
|
|
|
1514
|
|
|
1515 movff rel_pressure+0,sub_b+0
|
|
|
1516 movff rel_pressure+1,sub_b+1
|
|
|
1517
|
|
|
1518 call sub16 ; sub_c = sub_a - sub_b
|
|
|
1519
|
|
|
1520 btfss neg_flag
|
|
|
1521 bra set_dive_modes2 ; too shallow (rel_pressure<dive_threshold)
|
|
|
1522
|
|
|
1523 btfsc realdive ; Dive longer than one minute?
|
|
|
1524 clrf timeout_counter
|
|
|
1525
|
|
|
1526 bsf divemode
|
|
|
1527 bsf divemode2 ; displayed divetime is running
|
|
|
1528 return
|
|
|
1529
|
|
|
1530 set_dive_modes2:
|
|
|
1531 btfss realdive ; dive longer then one minute?
|
|
|
1532 bcf divemode ; no -> this was no real dive
|
|
|
1533 return
|
|
|
1534
|
|
|
1535 set_powersafe:
|
|
|
1536 btfsc low_battery_state ; battery warning alread active?
|
|
|
1537 bra set_powersafe2 ; Yes, but is it still required?
|
|
|
1538 ; battery voltage in mV (value*256+Lowbyte=actual treshold)
|
|
|
1539 movlw d'12' ; 3,328V
|
|
|
1540 cpfsgt batt_voltage+1
|
|
|
1541 bra set_powersafe1
|
|
|
1542 return
|
|
|
1543
|
|
|
1544 set_powersafe1:
|
|
|
1545 movlw d'7' ; Type of Alarm (Battery Low)
|
|
|
1546 movwf AlarmType ; Copy to Alarm Register
|
|
|
1547 bsf event_occured ; Set Event Flag
|
|
|
1548 bsf low_battery_state ; set flag for battery warning
|
|
|
1549 return ; return
|
|
|
1550
|
|
|
1551 set_powersafe2:
|
|
|
1552 movlw d'13' ; 3,584V
|
|
|
1553 cpfsgt batt_voltage+1
|
|
|
1554 bra set_powersafe1 ; Still to low
|
|
|
1555 bcf low_battery_state ; clear flag for battery warning mode
|
|
|
1556 return
|
|
|
1557
|
|
|
1558 calc_average_depth:
|
|
|
1559 ; 1. Add new 2xdepth to the Sum of depths registers
|
|
|
1560 movff rel_pressure+0,b0_lo
|
|
|
1561 movff rel_pressure+1,b0_hi
|
|
|
1562
|
|
|
1563 movf b0_lo,w
|
|
|
1564 addwf average_depth_hold+0,F
|
|
|
1565 movf b0_hi,w
|
|
|
1566 addwfc average_depth_hold+1,F
|
|
|
1567 movlw d'0'
|
|
|
1568 addwfc average_depth_hold+2,F
|
|
|
1569 addwfc average_depth_hold+3,F ; Will work up to 9999mBar*60*60*24=863913600mBar
|
|
|
1570
|
|
|
1571 movf b0_lo,w
|
|
|
1572 addwf average_depth_hold+0,F
|
|
|
1573 movf b0_hi,w
|
|
|
1574 addwfc average_depth_hold+1,F
|
|
|
1575 movlw d'0'
|
|
|
1576 addwfc average_depth_hold+2,F
|
|
|
1577 addwfc average_depth_hold+3,F ; Will work up to 9999mBar*60*60*24=863913600mBar
|
|
|
1578
|
|
|
1579 ; 2. Compute Average Depth on base of average_divesecs:2
|
|
|
1580
|
|
|
1581 movff average_divesecs+0,xB+0
|
|
|
1582 movff average_divesecs+1,xB+1 ; Copy
|
|
|
1583 movff average_depth_hold+0,xC+0
|
|
|
1584 movff average_depth_hold+1,xC+1
|
|
|
1585 movff average_depth_hold+2,xC+2
|
|
|
1586 movff average_depth_hold+3,xC+3
|
|
|
1587
|
|
|
1588 call div32x16 ; xC:4 / xB:2 = xC+3:xC+2 with xC+1:xC+0 as remainder
|
|
|
1589 movff xC+0,avr_rel_pressure+0
|
|
|
1590 movff xC+1,avr_rel_pressure+1
|
|
|
1591 return
|
|
|
1592
|
|
|
1593
|
|
|
1594 diveloop_boot:
|
|
|
1595 ostc_debug 'Q' ; Sends debug-information to screen if debugmode active
|
|
|
1596 clrf max_pressure+0 ; clear some variables
|
|
|
1597 clrf max_pressure+1
|
|
|
1598
|
|
|
1599 clrf avr_rel_pressure+0
|
|
|
1600 clrf avr_rel_pressure+1
|
|
|
1601
|
|
|
1602 call PLED_brightness_low
|
|
|
1603 read_int_eeprom d'90' ; Brightness offset? (Dim>0, Normal = 0)
|
|
|
1604 movlw d'0'
|
|
|
1605 cpfsgt EEDATA
|
|
|
1606 call PLED_brightness_full
|
|
|
1607
|
|
|
1608 clrf average_depth_hold+0
|
|
|
1609 clrf average_depth_hold+1
|
|
|
1610 clrf average_depth_hold+2
|
|
|
1611 clrf average_depth_hold+3 ; Clear average depth register
|
|
|
1612 movlw d'1'
|
|
|
1613 movwf average_divesecs+0
|
|
|
1614 clrf average_divesecs+1
|
|
|
1615
|
|
|
1616 movlw d'1'
|
|
|
1617 movwf apnoe_max_pressure+0
|
|
|
1618 clrf apnoe_max_pressure+1
|
|
|
1619 clrf apnoe_surface_mins
|
|
|
1620 clrf apnoe_surface_secs
|
|
|
1621 clrf apnoe_mins
|
|
|
1622 clrf apnoe_secs
|
|
|
1623 clrf divemins+0
|
|
|
1624 clrf divemins+1
|
|
|
1625 clrf divesecs
|
|
|
1626 clrf samplesecs
|
|
|
1627 clrf apnoe_timeout_counter ; timeout in minutes
|
|
|
1628 clrf timeout_counter ; takes care of the timeout
|
|
|
1629 clrf timeout_counter2 ; Here: counts to six, then store deco data and temperature
|
|
|
1630 clrf AlarmType ; Clear all alarms
|
|
|
1631 bcf event_occured ; clear flag
|
|
|
1632 bcf depth_greater_100m ; clear flag
|
|
|
1633 setf last_diluent ; to be displayed after first calculation (range: 0 to 100 [%])
|
|
|
1634 clrf char_last_pointer
|
|
3
|
1635 bcf dekostop_active
|
|
|
1636 bcf is_bailout ;=1: CC mode, but bailout active!
|
|
8
|
1637 bcf better_gas_available ;=1: A better gas is available and a gas change is advised in divemode
|
|
|
1638
|
|
0
|
1639 call get_free_EEPROM_location ; get last position in external EEPROM, may be up to 2 secs!
|
|
|
1640
|
|
|
1641 movff last_surfpressure_30min+1,int_I_pres_surface+1 ; HIGH copy surfacepressure to deco routine
|
|
|
1642 movff last_surfpressure_30min+0,int_I_pres_surface+0 ; LOW copy surfacepressure to deco routine
|
|
|
1643 movff temperature+0,mintemp+0 ; Reset Min-Temp registers
|
|
|
1644 movff temperature+1,mintemp+1 ; Reset Min-Temp registers
|
|
|
1645
|
|
|
1646 clrf wait_temp ; Used to clear Bankx registers
|
|
|
1647 movff wait_temp,char_O_GF_low_pointer
|
|
|
1648 movff wait_temp,char_O_actual_pointer
|
|
|
1649 lfsr FSR0,0x250
|
|
|
1650 movlw 0x20
|
|
|
1651 movwf wait_temp
|
|
|
1652 clear_deco_lists: ; Clear Deco list
|
|
|
1653 clrf POSTINC0
|
|
|
1654 decfsz wait_temp,F
|
|
|
1655 bra clear_deco_lists
|
|
|
1656 lfsr FSR0,0x270
|
|
|
1657 movlw 0x20
|
|
|
1658 movwf wait_temp
|
|
|
1659 set_no_forced_stops: ; Init Deco list
|
|
|
1660 movlw 0x01
|
|
|
1661 movwf POSTINC0
|
|
|
1662 decfsz wait_temp,F
|
|
|
1663 bra set_no_forced_stops
|
|
|
1664 lfsr FSR0,0x290 ; clear int_O_calc_tissue_call_counter (DEBUG)
|
|
|
1665 clrf POSTINC0
|
|
|
1666 clrf POSTINC0
|
|
|
1667
|
|
|
1668 ; Load GF values into RAM
|
|
|
1669 GETCUSTOM8 d'32' ; GF low
|
|
|
1670 movff EEDATA,char_I_GF_Lo_percentage
|
|
|
1671 GETCUSTOM8 d'33' ; GF high
|
|
|
1672 movff EEDATA,char_I_GF_Hi_percentage
|
|
|
1673
|
|
|
1674 ; Start with active Stopwatch?
|
|
|
1675 bsf stopwatch_active
|
|
|
1676 GETCUSTOM8 d'41' ; =1: Start with active Stopwatch
|
|
|
1677 movwf lo
|
|
|
1678 movlw d'1'
|
|
|
1679 cpfseq lo ; CF41=1?
|
|
|
1680 bcf stopwatch_active ; No!
|
|
|
1681
|
|
|
1682 ; Init profile recording parameters
|
|
|
1683 GETCUSTOM8 d'20' ; sample rate
|
|
|
1684 movwf samplesecs_value ; to avoid EEPROM access in the ISR
|
|
|
1685 GETCUSTOM8 d'21'
|
|
|
1686 movwf divisor_temperature ; load divisors for profile storage
|
|
|
1687 GETCUSTOM8 d'22'
|
|
|
1688 movwf divisor_deco
|
|
|
1689 GETCUSTOM8 d'23'
|
|
|
1690 movwf divisor_tank
|
|
|
1691 GETCUSTOM8 d'24'
|
|
|
1692 movwf divisor_ppo2
|
|
|
1693 GETCUSTOM8 d'25'
|
|
|
1694 movwf divisor_deco_debug
|
|
|
1695 GETCUSTOM8 d'26'
|
|
|
1696 movwf divisor_nuy2
|
|
|
1697
|
|
|
1698 btfss FLAG_apnoe_mode ; In Apnoe mode?
|
|
|
1699 bra divemode1
|
|
|
1700 ; Overwrite some parameters in Apnoe mode....
|
|
|
1701 movlw d'1'
|
|
|
1702 movwf samplesecs_value ; to avoid EEPROM access in the ISR
|
|
|
1703
|
|
|
1704 divemode1:
|
|
|
1705 read_int_eeprom d'36' ; Read mix 1 ppO2
|
|
|
1706 btfsc FLAG_const_ppO2_mode
|
|
|
1707 movff EEDATA,char_I_const_ppO2 ; Set ppO2 setpoint if in ppO2 mode
|
|
4
|
1708 movff EEDATA, ppO2_setpoint_store ; Store also in this byte...
|
|
0
|
1709
|
|
21
|
1710 bcf LED_blue
|
|
0
|
1711 bcf low_battery_state ; clear flag for battery warning mode
|
|
|
1712 bcf header_stored
|
|
|
1713 bcf premenu
|
|
|
1714 bcf realdive
|
|
|
1715 bsf update_divetime ; set flag
|
|
|
1716 btfss simulatormode_active ; do not disable in simulator mode!
|
|
|
1717 call disable_rs232 ; Disable RS232 unless in external O2 Sensor mode
|
|
|
1718
|
|
|
1719 read_int_eeprom d'33' ; Read byte (stored in EEDATA)
|
|
|
1720 movff EEDATA,active_gas ; Read start gas (1-5)
|
|
|
1721
|
|
|
1722 ; Read Start Gas and configure char_I_He_ratio, char_I_O2_ratio and char_I_N2_ratio
|
|
|
1723 decf active_gas,W ; Gas 0-4
|
|
|
1724 mullw d'4'
|
|
|
1725 movf PRODL,W
|
|
|
1726 addlw d'7' ; = address for He ratio
|
|
|
1727 movwf EEADR
|
|
|
1728 call read_eeprom ; Read He ratio
|
|
|
1729 movff EEDATA,char_I_He_ratio ; And copy into hold register
|
|
|
1730 decf active_gas,W ; Gas 0-4
|
|
|
1731 mullw d'4'
|
|
|
1732 movf PRODL,W
|
|
|
1733 addlw d'6' ; = address for O2 ratio
|
|
|
1734 movwf EEADR
|
|
|
1735 call read_eeprom ; Read O2 ratio
|
|
|
1736 movff EEDATA, char_I_O2_ratio ; O2 ratio
|
|
|
1737 movff char_I_He_ratio, wait_temp ; copy into bank1 register
|
|
|
1738 bsf STATUS,C ; Borrow bit
|
|
|
1739 movlw d'100' ; 100%
|
|
|
1740 subfwb wait_temp,W ; minus He
|
|
|
1741 bsf STATUS,C ; Borrow bit
|
|
|
1742 subfwb EEDATA,F ; minus O2
|
|
|
1743 movff EEDATA, char_I_N2_ratio ; = N2!
|
|
|
1744
|
|
|
1745 ; New in 1.09 - DecoGas can be configured to achieve exact decompression proposal
|
|
|
1746 ; required variables
|
|
|
1747 ; These values are set when the OSTC is in decompression mode - will be done in routine "check_decogas"
|
|
|
1748 ; char_I_deco_gas_change; ; next gas change in meter
|
|
|
1749 ; char_I_deco_N2_ratio; ; next gas N2
|
|
|
1750 ; char_I_deco_He_ratio; ; next gas He
|
|
|
1751 clrf lo
|
|
|
1752 movff lo, char_I_deco_gas_change ; clear
|
|
|
1753 movff lo, char_I_deco_N2_ratio ; clear
|
|
|
1754 movff lo, char_I_deco_He_ratio ; clear
|
|
|
1755 bcf multi_gf_display ; Do not display the multi-gf table screen
|
|
|
1756 return |
