|
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
|
|
|
84 schalter_links: ;
|
|
|
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
|
|
|
96 schalter_rechts: ;
|
|
|
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
|
|
|
110 clrf T0CON ; Timer0
|
|
|
111 clrf TMR0H
|
|
|
112 clrf TMR0L
|
|
|
113 bsf T0CON,TMR0ON ; Start Timer 0
|
|
|
114 return
|
|
|
115
|
|
|
116 timer0int:
|
|
|
117 bcf INTCON,TMR0IF ; Clear flag
|
|
|
118 bcf T0CON,TMR0ON ; Stop Timer 0
|
|
|
119 clrf TMR0H
|
|
|
120 clrf TMR0L
|
|
|
121 return
|
|
|
122
|
|
|
123
|
|
|
124 timer0int_left_reset:
|
|
|
125 bcf INTCON2, INTEDG0 ; Interrupt on faling edge again
|
|
|
126 bcf switch_left_isr ; Clear flag, button press is done
|
|
|
127
|
|
|
128 movlw T0CON_debounce ; Timer0
|
|
|
129 movwf T0CON
|
|
|
130
|
|
|
131 bsf T0CON,TMR0ON ; Start Timer 0
|
|
|
132 return
|
|
|
133
|
|
|
134 timer0int_left:
|
|
|
135 bsf INTCON2, INTEDG0 ; Interrupt on rising edge again
|
|
|
136 return
|
|
|
137
|
|
|
138 timer0int_right_reset:
|
|
|
139 bcf INTCON2, INTEDG1 ; Interrupt on faling edge again
|
|
|
140 bcf switch_right_isr ; Clear flag, button press is done
|
|
|
141
|
|
|
142 movlw T0CON_debounce ; Timer0
|
|
|
143 movwf T0CON
|
|
|
144
|
|
|
145 bsf T0CON,TMR0ON ; Start Timer 0
|
|
|
146 return
|
|
|
147
|
|
|
148 timer0int_right:
|
|
|
149 bsf INTCON2, INTEDG1 ; Interrupt on rising edge again
|
|
|
150 return
|
|
|
151
|
|
|
152 timer3int:
|
|
|
153 bcf PIR2,TMR3IF ; Clear flag
|
|
|
154 bcf T3CON,TMR0ON ; Stop Timer 3
|
|
|
155 bcf T2CON,2 ; stop Timer 2
|
|
|
156 return
|
|
|
157
|
|
|
158 timer1int:
|
|
|
159 bcf PIR1,TMR1IF ; Clear flag
|
|
|
160
|
|
|
161 timer1int_debug:
|
|
21
|
162 bcf LED_red ; LEDr off (For charge indicator)
|
|
0
|
163
|
|
|
164 movlw 0x08 ; Timer1 int after 62.5ms (=16/second)
|
|
|
165 cpfslt TMR1H ; Did we miss a 1/16 second?
|
|
|
166 incf timer1int_counter1,F ; Yes, add extra 1/16 second
|
|
|
167
|
|
|
168 movlw 0x08 ; Timer1 int after 62.5ms (=16/second)
|
|
|
169 subwf TMR1H,F
|
|
|
170
|
|
|
171 incf timer1int_counter1,F
|
|
|
172 movlw d'15' ; One second 16
|
|
|
173 cpfsgt timer1int_counter1
|
|
|
174 bra sensor_int_pre ; only pressure sensor
|
|
|
175 call RTCisr ; adjust time, then query pressure sensor
|
|
|
176
|
|
|
177 sensor_int_pre:
|
|
|
178 btfss sleepmode ; In sleepmode?
|
|
|
179 bra sensor_int ; No
|
|
|
180 return
|
|
|
181
|
|
|
182 sensor_int:
|
|
|
183 btfsc no_sensor_int ; No sensor interrupt (because it's addressed during sleep)
|
|
|
184 return
|
|
|
185
|
|
|
186 incf timer1int_counter2,F ; counts to eight for state maschine
|
|
|
187
|
|
|
188 movlw d'1'
|
|
|
189 cpfseq timer1int_counter2 ; State 1?
|
|
|
190 bra sensor_int1 ; No
|
|
|
191
|
|
|
192 bcf pressure_refresh ; clear flags
|
|
|
193 clrf isr3_temp+0 ; pressure average registers
|
|
|
194 clrf isr3_temp+1
|
|
|
195 clrf temperature_temp+0
|
|
|
196 clrf temperature_temp+1
|
|
|
197 sensor_int0:
|
|
|
198 call get_temperature_value ; State 1: Get temperature
|
|
|
199 call get_pressure_start ; and start pressure integration.
|
|
|
200 return ; Done.
|
|
|
201 sensor_int1:
|
|
|
202 movlw d'2'
|
|
|
203 cpfseq timer1int_counter2 ; State 2?
|
|
|
204 bra sensor_int2 ; No
|
|
|
205
|
|
|
206 sensor_int1_1:
|
|
|
207 call get_pressure_value ; State2: Get pressure (51us)
|
|
|
208 call get_temperature_start ; and start temperature integration (73,5us)
|
|
|
209 call calculate_compensation ; calculate temperature compensated pressure (233us)
|
|
|
210 movf amb_pressure+0,W
|
|
|
211 addwf isr3_temp+0 ; average pressure
|
|
|
212 movf amb_pressure+1,W
|
|
|
213 addwfc isr3_temp+1
|
|
|
214 movf temperature+0,W
|
|
|
215 addwf temperature_temp+0 ; average temperature
|
|
|
216 movf temperature+1,W
|
|
|
217 addwfc temperature_temp+1
|
|
|
218 return
|
|
|
219 sensor_int2:
|
|
|
220 movlw d'3'
|
|
|
221 cpfseq timer1int_counter2 ; State 3?
|
|
|
222 bra sensor_int3 ; No
|
|
|
223 bra sensor_int0 ; Yes, but same as State 1!
|
|
|
224 sensor_int3:
|
|
|
225 movlw d'4'
|
|
|
226 cpfseq timer1int_counter2 ; State 4?
|
|
|
227 bra sensor_int4 ; No
|
|
|
228 bra sensor_int1_1 ; Yes, but same as State 2!
|
|
|
229 sensor_int4:
|
|
|
230 movlw d'5'
|
|
|
231 cpfseq timer1int_counter2 ; State 5?
|
|
|
232 bra sensor_int5 ; No
|
|
|
233 bra sensor_int0 ; Yes, but same as State 1!
|
|
|
234 sensor_int5:
|
|
|
235 movlw d'6'
|
|
|
236 cpfseq timer1int_counter2 ; State 6?
|
|
|
237 bra sensor_int6 ; No
|
|
|
238 bra sensor_int1_1 ; Yes, but same as State 2!
|
|
|
239 sensor_int6:
|
|
|
240 movlw d'7'
|
|
|
241 cpfseq timer1int_counter2 ; State 7?
|
|
|
242 bra sensor_int7 ; No
|
|
|
243 bra sensor_int0 ; Yes, but same as State 1!
|
|
|
244 sensor_int7:
|
|
|
245 rcall sensor_int1_1 ; Do State 2...
|
|
|
246 clrf timer1int_counter2 ; ..then reset State counter...
|
|
|
247 movlw d'2' ; and calculate average!
|
|
|
248 movwf isr2_temp
|
|
|
249 sensor_int8:
|
|
|
250 bcf STATUS,C
|
|
|
251 rrcf isr3_temp+1 ; isr3_temp / 2
|
|
|
252 rrcf isr3_temp+0
|
|
|
253 bcf STATUS,C
|
|
|
254 rrcf temperature_temp+1 ; temperature_temp /2
|
|
|
255 rrcf temperature_temp+0
|
|
|
256 decfsz isr2_temp,F
|
|
|
257 bra sensor_int8 ; once more
|
|
|
258
|
|
|
259 movff isr3_temp+1,amb_pressure+1 ; copy into actual register
|
|
|
260 movff isr3_temp+0,amb_pressure+0
|
|
|
261
|
|
|
262 movff temperature_temp+1,temperature+1
|
|
|
263 movff temperature_temp+0,temperature+0
|
|
|
264
|
|
|
265 bsf pressure_refresh ; Set flag! Temp and pressure were updated!
|
|
|
266
|
|
|
267 btfss simulatormode_active ; are we in simulator mode?
|
|
|
268 bra comp_air_pressure ; no
|
|
|
269
|
|
|
270 comp_air_pressure0:
|
|
|
271 movlw LOW d'1000' ; yes, so simulate 1Bar surface pressure
|
|
|
272 movwf last_surfpressure+0
|
|
|
273 movlw HIGH d'1000'
|
|
|
274 movwf last_surfpressure+1
|
|
|
275
|
|
|
276 comp_air_pressure:
|
|
|
277 bcf neg_flag
|
|
|
278 movf last_surfpressure+0,W ; compensate airpressure
|
|
|
279 subwf amb_pressure+0,W
|
|
|
280 movwf rel_pressure+0 ; rel_pressure stores depth!
|
|
|
281
|
|
|
282 movf last_surfpressure+1,W
|
|
|
283 subwfb amb_pressure+1,W
|
|
|
284 movwf rel_pressure+1
|
|
|
285 btfss STATUS,N ; result is below zero?
|
|
|
286 return
|
|
|
287 clrf rel_pressure+0 ; Yes, do not display negative depths
|
|
|
288 clrf rel_pressure+1 ; e.g. when surface air pressure dropped during the dive
|
|
|
289 return
|
|
|
290
|
|
|
291 RTCisr:
|
|
|
292 clrf timer1int_counter1 ; counts to 16 (one second / 62.5ms)
|
|
|
293 bsf onesecupdate ; we have a new second!
|
|
|
294
|
|
|
295 bcf STATUS,Z ; are we in dive mode?
|
|
|
296 btfss divemode
|
|
|
297 bra RTCisr2 ; No, must be surface or sleepmode
|
|
|
298
|
|
|
299 incf samplesecs,F ; CF20 diving seconds done
|
|
|
300 decf samplesecs_value,W ; holds CF20 value (minus 1 into WREG)
|
|
|
301 cpfsgt samplesecs
|
|
|
302 bra RTCisr1 ; no
|
|
|
303
|
|
|
304 clrf samplesecs ; clear counter...
|
|
|
305 bsf store_sample ; ...and set bit for profile storage
|
|
|
306 RTCisr1:
|
|
|
307 ; Increase re-setable average depth divetime counter
|
|
111
|
308 incf average_divesecs+0,F ; increase stopwatch registers
|
|
0
|
309 btfsc STATUS,Z
|
|
111
|
310 incf average_divesecs+1,F ; increase stopwatch registers
|
|
0
|
311
|
|
|
312 btfss divemode2 ; displayed divetime is running?
|
|
|
313 bra RTCisr2 ; No (e.g. too shallow)
|
|
|
314
|
|
|
315 incf divesecs,F ; increase divetime registers
|
|
|
316 movlw d'59'
|
|
|
317 cpfsgt divesecs
|
|
|
318 bra RTCisr1a
|
|
|
319 clrf divesecs
|
|
|
320 bsf realdive ; this bit is always set (again) if the dive is longer then one minute
|
|
|
321
|
|
|
322 incf divemins+0,F ; increase divemins
|
|
|
323 btfsc STATUS,Z
|
|
|
324 incf divemins+1,F ; and now do the realtime clock routine anyway
|
|
|
325
|
|
|
326 RTCisr1a:
|
|
|
327 btfss FLAG_apnoe_mode ; Are we in Apnoe mode?
|
|
|
328 bra RTCisr2 ; No, skip the following
|
|
|
329
|
|
|
330 incf apnoe_secs,F ; increase descent registers
|
|
|
331 movlw d'59'
|
|
|
332 cpfsgt apnoe_secs
|
|
|
333 bra RTCisr2
|
|
|
334 clrf apnoe_secs
|
|
|
335
|
|
|
336 incf apnoe_mins,F ; increase descent mins
|
|
|
337 ; Now, do the RTC routine....
|
|
|
338 RTCisr2:
|
|
|
339 incf secs,F ; adjusts seconds, minutes, hours, day, month and year. Checks for a leap year and works until 2099!
|
|
|
340 movlw d'59'
|
|
|
341 cpfsgt secs
|
|
|
342 return
|
|
|
343 clrf secs
|
|
|
344 bsf oneminupdate
|
|
|
345 incf mins,F
|
|
|
346 movlw d'59'
|
|
|
347 cpfsgt mins
|
|
|
348 return
|
|
|
349 clrf mins
|
|
|
350 incf hours,F
|
|
|
351 movlw d'23'
|
|
|
352 cpfsgt hours
|
|
|
353 return
|
|
|
354 clrf hours
|
|
13
|
355 incf day,F
|
|
43
|
356 movff time_correction_value,secs ; Correct too slow clock
|
|
13
|
357
|
|
0
|
358 check_date:
|
|
|
359 movff month,isr_divB ; new month?
|
|
|
360 dcfsnz isr_divB,F
|
|
|
361 movlw .31
|
|
|
362 dcfsnz isr_divB,F
|
|
|
363 movlw .28
|
|
|
364 dcfsnz isr_divB,F
|
|
|
365 movlw .31
|
|
|
366 dcfsnz isr_divB,F
|
|
|
367 movlw .30
|
|
|
368 dcfsnz isr_divB,F
|
|
|
369 movlw .31
|
|
|
370 dcfsnz isr_divB,F
|
|
|
371 movlw .30
|
|
|
372 dcfsnz isr_divB,F
|
|
|
373 movlw .31
|
|
|
374 dcfsnz isr_divB,F
|
|
|
375 movlw .31
|
|
|
376 dcfsnz isr_divB,F
|
|
|
377 movlw .30
|
|
|
378 dcfsnz isr_divB,F
|
|
|
379 movlw .31
|
|
|
380 dcfsnz isr_divB,F
|
|
|
381 movlw .30
|
|
|
382 dcfsnz isr_divB,F
|
|
|
383 movlw .31
|
|
|
384 cpfsgt day,1
|
|
|
385 return
|
|
|
386 movlw .1
|
|
|
387 movwf day
|
|
|
388 incf month,F
|
|
|
389 movlw .12
|
|
|
390 cpfsgt month,1
|
|
|
391 return
|
|
|
392 movlw .1
|
|
|
393 movwf month
|
|
|
394 incf year,F
|
|
|
395 return |
