annotate code_part1/OSTC_code_asm_part1/divemode.asm @ 40:92001c045088

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