|
0
|
1
|
|
|
2 ; OSTC - diving computer code
|
|
|
3 ; Copyright (C) 2008 HeinrichsWeikamp GbR
|
|
|
4
|
|
|
5 ; This program is free software: you can redistribute it and/or modify
|
|
|
6 ; it under the terms of the GNU General Public License as published by
|
|
|
7 ; the Free Software Foundation, either version 3 of the License, or
|
|
|
8 ; (at your option) any later version.
|
|
|
9
|
|
|
10 ; This program is distributed in the hope that it will be useful,
|
|
|
11 ; but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
12 ; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
13 ; GNU General Public License for more details.
|
|
|
14
|
|
|
15 ; You should have received a copy of the GNU General Public License
|
|
|
16 ; along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
|
17
|
|
|
18
|
|
|
19 ; written by: Matthias Heinrichs, info@heinrichsweikamp.com
|
|
|
20 ; written: 10/30/05
|
|
|
21 ; last updated: 05/16/08
|
|
|
22 ; known bugs:
|
|
|
23 ; ToDo:
|
|
|
24
|
|
|
25 ; the timer1 module interrupts every 62.5ms (16x/second)
|
|
|
26 ; temperature and pressure is averaged over 4 measurements
|
|
|
27 ; flag pressure_refresh is set every 500ms
|
|
|
28 ; and provides accurate pressure (+/-1mBar stable) and temperature (0.1C stable)
|
|
|
29
|
|
|
30 uartint:
|
|
|
31 btfsc simulatormode_active ; are we in simulatormode?
|
|
|
32 bra simulator_int ; Yes, reading is depth in m!
|
|
|
33
|
|
|
34 movff RCREG,uart1_temp
|
|
|
35 movlw d'96'
|
|
|
36 subwf uart1_temp,F
|
|
|
37 dcfsnz uart1_temp,F ; "a"
|
|
|
38 bsf dump_external_eeprom ; set flag
|
|
|
39 dcfsnz uart1_temp,F ; "b"
|
|
|
40 bsf uart_settime ; set flag
|
|
|
41 dcfsnz uart1_temp,F ; "c"
|
|
|
42 bsf simulatormode_active ; set flag
|
|
|
43 dcfsnz uart1_temp,F ; "d"
|
|
|
44 bsf internal_eeprom_write ; set flag
|
|
|
45 dcfsnz uart1_temp,F ; "e"
|
|
|
46 bsf uart_send_hash ; set flag
|
|
|
47 dcfsnz uart1_temp,F ; "f"
|
|
49
|
48 nop ; no longer used command "f"
|
|
0
|
49 dcfsnz uart1_temp,F ; "g"
|
|
|
50 bsf uart_send_int_eeprom ; set flag
|
|
|
51 dcfsnz uart1_temp,F ; "h"
|
|
|
52 bsf uart_reset_decodata ; set flag
|
|
|
53 dcfsnz uart1_temp,F ; "i"
|
|
|
54 bsf internal_eeprom_write2 ; set flag
|
|
|
55 dcfsnz uart1_temp,F ; "j"
|
|
|
56 bsf uart_send_int_eeprom2 ; set flag
|
|
|
57 dcfsnz uart1_temp,F ; "k"
|
|
|
58 bsf uart_store_tissue_data ; set flag
|
|
|
59
|
|
|
60
|
|
|
61 uartint1:
|
|
|
62 movf RCREG,w ; unload RCREG in stand-alone simulator mode
|
|
|
63 bcf PIR1,RCIF ; Clear flag
|
|
|
64 bcf RCSTA,CREN ; Clear receiver status
|
|
|
65 bsf RCSTA,CREN
|
|
|
66 return
|
|
|
67
|
|
|
68 simulator_int:
|
|
|
69 btfsc standalone_simulator ; ignore in standalone simulator mode
|
|
|
70 bra uartint1
|
|
|
71
|
|
21
|
72 bsf LED_blue
|
|
0
|
73 tstfsz RCREG ; =0x00?
|
|
|
74 bra simulator_int1 ; No
|
|
|
75 incf RCREG,F ; Yes, so force RCREG=1
|
|
|
76
|
|
|
77 simulator_int1:
|
|
|
78 movf RCREG,w ; depth in m
|
|
|
79 mullw d'100' ; result will be mbar
|
|
|
80 movff PRODL,sim_pressure+0 ; stored for pressure overwrite
|
|
|
81 movff PRODH,sim_pressure+1
|
|
|
82 bra uartint1 ; exit uart int
|
|
|
83
|
|
238
|
84 switch_left_int:
|
|
0
|
85 bcf INTCON,INT0IF ; Clear flag
|
|
|
86
|
|
|
87 btfsc T0CON,TMR0ON ; Timer0 running?
|
|
|
88 bra timer0_restart ; Yes, restart
|
|
|
89
|
|
|
90 bsf switch_left ; Set flag, button press is OK
|
|
|
91
|
|
|
92 bsf T0CON,TMR0ON ; Start Timer 0
|
|
|
93 return
|
|
|
94
|
|
|
95
|
|
238
|
96 switch_right_int:
|
|
0
|
97 bcf INTCON3,INT1IF ; Clear flag
|
|
|
98
|
|
|
99 btfsc T0CON,TMR0ON ; Timer0 running?
|
|
|
100 bra timer0_restart ; Yes, restart
|
|
|
101
|
|
|
102 bsf switch_right ; Set flag, button press is OK
|
|
|
103
|
|
|
104 bsf T0CON,TMR0ON ; Start Timer 0
|
|
|
105 return
|
|
|
106
|
|
|
107 timer0_restart:
|
|
|
108 bcf INTCON,TMR0IF ; Clear flag
|
|
|
109 clrf T0CON ; Timer0
|
|
|
110 clrf TMR0H
|
|
|
111 clrf TMR0L
|
|
|
112 bsf T0CON,TMR0ON ; Start Timer 0
|
|
|
113 return
|
|
|
114
|
|
|
115 timer0int:
|
|
|
116 bcf INTCON,TMR0IF ; Clear flag
|
|
|
117 bcf T0CON,TMR0ON ; Stop Timer 0
|
|
|
118 clrf TMR0H
|
|
|
119 clrf TMR0L
|
|
|
120 return
|
|
|
121
|
|
|
122 timer0int_left_reset:
|
|
|
123 bcf INTCON2, INTEDG0 ; Interrupt on faling edge again
|
|
|
124 bcf switch_left_isr ; Clear flag, button press is done
|
|
|
125
|
|
|
126 movlw T0CON_debounce ; Timer0
|
|
|
127 movwf T0CON
|
|
|
128
|
|
|
129 bsf T0CON,TMR0ON ; Start Timer 0
|
|
|
130 return
|
|
|
131
|
|
|
132 timer0int_left:
|
|
|
133 bsf INTCON2, INTEDG0 ; Interrupt on rising edge again
|
|
|
134 return
|
|
|
135
|
|
|
136 timer0int_right_reset:
|
|
|
137 bcf INTCON2, INTEDG1 ; Interrupt on faling edge again
|
|
|
138 bcf switch_right_isr ; Clear flag, button press is done
|
|
|
139
|
|
|
140 movlw T0CON_debounce ; Timer0
|
|
|
141 movwf T0CON
|
|
|
142
|
|
|
143 bsf T0CON,TMR0ON ; Start Timer 0
|
|
|
144 return
|
|
|
145
|
|
|
146 timer0int_right:
|
|
|
147 bsf INTCON2, INTEDG1 ; Interrupt on rising edge again
|
|
|
148 return
|
|
|
149
|
|
|
150 timer1int:
|
|
|
151 bcf PIR1,TMR1IF ; Clear flag
|
|
|
152
|
|
|
153 timer1int_debug:
|
|
21
|
154 bcf LED_red ; LEDr off (For charge indicator)
|
|
0
|
155
|
|
|
156 movlw 0x08 ; Timer1 int after 62.5ms (=16/second)
|
|
|
157 cpfslt TMR1H ; Did we miss a 1/16 second?
|
|
|
158 incf timer1int_counter1,F ; Yes, add extra 1/16 second
|
|
|
159
|
|
|
160 movlw 0x08 ; Timer1 int after 62.5ms (=16/second)
|
|
|
161 subwf TMR1H,F
|
|
|
162
|
|
238
|
163 incf timer1int_counter1,F ; Increase timer1 counter
|
|
|
164
|
|
0
|
165 movlw d'15' ; One second 16
|
|
|
166 cpfsgt timer1int_counter1
|
|
|
167 bra sensor_int_pre ; only pressure sensor
|
|
238
|
168 rcall RTCisr ; adjust time, then query pressure sensor
|
|
0
|
169
|
|
|
170 sensor_int_pre:
|
|
238
|
171 btfsc sleepmode ; In sleepmode?
|
|
|
172 return ; Yes
|
|
0
|
173
|
|
|
174 sensor_int:
|
|
|
175 btfsc no_sensor_int ; No sensor interrupt (because it's addressed during sleep)
|
|
|
176 return
|
|
|
177
|
|
238
|
178 incf timer1int_counter2,F ; counts to eight for state maschine
|
|
0
|
179
|
|
238
|
180 ; State 1: Clear flags and average registers, get temperature (51us) and start pressure integration (73,5us)
|
|
|
181 ; State 2: Get pressure (51us), start temperature integration (73,5us) and calculate temperature compensated pressure (233us)
|
|
|
182 ; State 3: Get temperature (51us) and start pressure integration (73,5us)
|
|
|
183 ; State 4: Get pressure (51us), start temperature integration (73,5us) and calculate temperature compensated pressure (233us)
|
|
|
184 ; State 5: Get temperature (51us) and start pressure integration (73,5us)
|
|
|
185 ; State 6: Get pressure (51us), start temperature integration (73,5us) and calculate temperature compensated pressure (233us)
|
|
|
186 ; State 7: Get temperature (51us) and start pressure integration (73,5us)
|
|
|
187 ; State 8: Get pressure (51us), start temperature integration (73,5us), calculate temperature compensated pressure (233us) and build average for half-second update of tempperature and pressure
|
|
|
188
|
|
|
189 movff timer1int_counter2,isr_divB ; isr_divB used as temp here...
|
|
|
190 dcfsnz isr_divB,F
|
|
|
191 bra sensor_int_state1_plus_restart ; Do State 1
|
|
|
192 dcfsnz isr_divB,F
|
|
|
193 bra sensor_int_state2 ; Do State 2
|
|
|
194 dcfsnz isr_divB,F
|
|
|
195 bra sensor_int_state1 ; Do State 3
|
|
|
196 dcfsnz isr_divB,F
|
|
|
197 bra sensor_int_state2 ; Do State 4
|
|
|
198 dcfsnz isr_divB,F
|
|
|
199 bra sensor_int_state1 ; Do State 5
|
|
|
200 dcfsnz isr_divB,F
|
|
|
201 bra sensor_int_state2 ; Do State 6
|
|
|
202 dcfsnz isr_divB,F
|
|
|
203 bra sensor_int_state1 ; Do State 7
|
|
|
204 ; bra sensor_int2_plus_average ; Do State 8
|
|
|
205
|
|
|
206 ;sensor_int2_plus_average:
|
|
|
207 rcall sensor_int_state2
|
|
|
208 sensor_int2_plus_average2:
|
|
0
|
209 bcf STATUS,C
|
|
|
210 rrcf isr3_temp+1 ; isr3_temp / 2
|
|
|
211 rrcf isr3_temp+0
|
|
|
212 bcf STATUS,C
|
|
|
213 rrcf temperature_temp+1 ; temperature_temp /2
|
|
|
214 rrcf temperature_temp+0
|
|
238
|
215
|
|
|
216 bcf STATUS,C
|
|
|
217 rrcf isr3_temp+1 ; isr3_temp / 4
|
|
|
218 rrcf isr3_temp+0
|
|
|
219 bcf STATUS,C
|
|
|
220 rrcf temperature_temp+1 ; temperature_temp /4
|
|
|
221 rrcf temperature_temp+0
|
|
|
222
|
|
0
|
223 movff isr3_temp+1,amb_pressure+1 ; copy into actual register
|
|
|
224 movff isr3_temp+0,amb_pressure+0
|
|
|
225
|
|
|
226 movff temperature_temp+1,temperature+1
|
|
|
227 movff temperature_temp+0,temperature+0
|
|
|
228
|
|
|
229 bsf pressure_refresh ; Set flag! Temp and pressure were updated!
|
|
238
|
230 clrf timer1int_counter2 ; Then reset State counter
|
|
0
|
231
|
|
|
232 btfss simulatormode_active ; are we in simulator mode?
|
|
|
233 bra comp_air_pressure ; no
|
|
|
234
|
|
|
235 comp_air_pressure0:
|
|
|
236 movlw LOW d'1000' ; yes, so simulate 1Bar surface pressure
|
|
|
237 movwf last_surfpressure+0
|
|
|
238 movlw HIGH d'1000'
|
|
|
239 movwf last_surfpressure+1
|
|
|
240
|
|
|
241 comp_air_pressure:
|
|
|
242 bcf neg_flag
|
|
|
243 movf last_surfpressure+0,W ; compensate airpressure
|
|
|
244 subwf amb_pressure+0,W
|
|
238
|
245 movwf rel_pressure+0 ; rel_pressure stores depth!
|
|
0
|
246
|
|
|
247 movf last_surfpressure+1,W
|
|
|
248 subwfb amb_pressure+1,W
|
|
|
249 movwf rel_pressure+1
|
|
238
|
250 btfss STATUS,N ; result is below zero?
|
|
|
251 return
|
|
|
252 clrf rel_pressure+0 ; Yes, do not display negative depths
|
|
|
253 clrf rel_pressure+1 ; e.g. when surface air pressure dropped during the dive
|
|
0
|
254 return
|
|
238
|
255
|
|
|
256
|
|
|
257 sensor_int_state1_plus_restart:
|
|
|
258 bcf pressure_refresh ; clear flags
|
|
|
259 clrf isr3_temp+0 ; pressure average registers
|
|
|
260 clrf isr3_temp+1
|
|
|
261 clrf temperature_temp+0
|
|
|
262 clrf temperature_temp+1
|
|
|
263
|
|
|
264 sensor_int_state1:
|
|
|
265 call get_temperature_value ; State 1: Get temperature
|
|
|
266 call get_pressure_start ; and start pressure integration.
|
|
|
267 return ; Done.
|
|
|
268
|
|
|
269 sensor_int_state2:
|
|
|
270 call get_pressure_value ; State2: Get pressure (51us)
|
|
|
271 call get_temperature_start ; and start temperature integration (73,5us)
|
|
|
272 call calculate_compensation ; calculate temperature compensated pressure (233us)
|
|
|
273 movf amb_pressure+0,W
|
|
|
274 addwf isr3_temp+0 ; average pressure
|
|
|
275 movf amb_pressure+1,W
|
|
|
276 addwfc isr3_temp+1
|
|
|
277 movf temperature+0,W
|
|
|
278 addwf temperature_temp+0 ; average temperature
|
|
|
279 movf temperature+1,W
|
|
|
280 addwfc temperature_temp+1
|
|
|
281 return
|
|
|
282
|
|
0
|
283
|
|
|
284 RTCisr:
|
|
|
285 clrf timer1int_counter1 ; counts to 16 (one second / 62.5ms)
|
|
|
286 bsf onesecupdate ; we have a new second!
|
|
|
287
|
|
|
288 bcf STATUS,Z ; are we in dive mode?
|
|
|
289 btfss divemode
|
|
238
|
290 bra RTCisr2 ; No, must be surface or sleepmode
|
|
0
|
291
|
|
|
292 incf samplesecs,F ; CF20 diving seconds done
|
|
|
293 decf samplesecs_value,W ; holds CF20 value (minus 1 into WREG)
|
|
|
294 cpfsgt samplesecs
|
|
238
|
295 bra RTCisr1 ; no
|
|
0
|
296
|
|
|
297 clrf samplesecs ; clear counter...
|
|
|
298 bsf store_sample ; ...and set bit for profile storage
|
|
238
|
299
|
|
0
|
300 RTCisr1:
|
|
|
301 ; Increase re-setable average depth divetime counter
|
|
111
|
302 incf average_divesecs+0,F ; increase stopwatch registers
|
|
0
|
303 btfsc STATUS,Z
|
|
111
|
304 incf average_divesecs+1,F ; increase stopwatch registers
|
|
0
|
305
|
|
|
306 btfss divemode2 ; displayed divetime is running?
|
|
|
307 bra RTCisr2 ; No (e.g. too shallow)
|
|
|
308
|
|
|
309 incf divesecs,F ; increase divetime registers
|
|
|
310 movlw d'59'
|
|
|
311 cpfsgt divesecs
|
|
|
312 bra RTCisr1a
|
|
238
|
313
|
|
0
|
314 clrf divesecs
|
|
|
315 bsf realdive ; this bit is always set (again) if the dive is longer then one minute
|
|
|
316
|
|
|
317 incf divemins+0,F ; increase divemins
|
|
|
318 btfsc STATUS,Z
|
|
|
319 incf divemins+1,F ; and now do the realtime clock routine anyway
|
|
|
320
|
|
|
321 RTCisr1a:
|
|
|
322 btfss FLAG_apnoe_mode ; Are we in Apnoe mode?
|
|
|
323 bra RTCisr2 ; No, skip the following
|
|
|
324
|
|
|
325 incf apnoe_secs,F ; increase descent registers
|
|
|
326 movlw d'59'
|
|
|
327 cpfsgt apnoe_secs
|
|
|
328 bra RTCisr2
|
|
|
329 clrf apnoe_secs
|
|
|
330
|
|
|
331 incf apnoe_mins,F ; increase descent mins
|
|
|
332 ; Now, do the RTC routine....
|
|
|
333 RTCisr2:
|
|
|
334 incf secs,F ; adjusts seconds, minutes, hours, day, month and year. Checks for a leap year and works until 2099!
|
|
|
335 movlw d'59'
|
|
|
336 cpfsgt secs
|
|
|
337 return
|
|
|
338 clrf secs
|
|
|
339 bsf oneminupdate
|
|
|
340 incf mins,F
|
|
|
341 movlw d'59'
|
|
|
342 cpfsgt mins
|
|
|
343 return
|
|
|
344 clrf mins
|
|
|
345 incf hours,F
|
|
|
346 movlw d'23'
|
|
|
347 cpfsgt hours
|
|
|
348 return
|
|
|
349 clrf hours
|
|
13
|
350 incf day,F
|
|
43
|
351 movff time_correction_value,secs ; Correct too slow clock
|
|
13
|
352
|
|
0
|
353 check_date:
|
|
|
354 movff month,isr_divB ; new month?
|
|
|
355 dcfsnz isr_divB,F
|
|
|
356 movlw .31
|
|
|
357 dcfsnz isr_divB,F
|
|
|
358 movlw .28
|
|
|
359 dcfsnz isr_divB,F
|
|
|
360 movlw .31
|
|
|
361 dcfsnz isr_divB,F
|
|
|
362 movlw .30
|
|
|
363 dcfsnz isr_divB,F
|
|
|
364 movlw .31
|
|
|
365 dcfsnz isr_divB,F
|
|
|
366 movlw .30
|
|
|
367 dcfsnz isr_divB,F
|
|
|
368 movlw .31
|
|
|
369 dcfsnz isr_divB,F
|
|
|
370 movlw .31
|
|
|
371 dcfsnz isr_divB,F
|
|
|
372 movlw .30
|
|
|
373 dcfsnz isr_divB,F
|
|
|
374 movlw .31
|
|
|
375 dcfsnz isr_divB,F
|
|
|
376 movlw .30
|
|
|
377 dcfsnz isr_divB,F
|
|
|
378 movlw .31
|
|
|
379 cpfsgt day,1
|
|
|
380 return
|
|
|
381 movlw .1
|
|
|
382 movwf day
|
|
|
383 incf month,F
|
|
|
384 movlw .12
|
|
|
385 cpfsgt month,1
|
|
|
386 return
|
|
|
387 movlw .1
|
|
|
388 movwf month
|
|
|
389 incf year,F
|
|
|
390 return |
