annotate src/ms5541.asm @ 2:ab8a7c3f1db0

battery warning levels, max. brightnes setting
author heinrichsweikamp
date Sun, 05 May 2013 15:37:24 +0200
parents 11d4fc797f74
children 50c3e2c7ba7a
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
0
heinrichsweikamp
parents:
diff changeset
1 ;=============================================================================
heinrichsweikamp
parents:
diff changeset
2 ;
heinrichsweikamp
parents:
diff changeset
3 ; File ms5541.asm
heinrichsweikamp
parents:
diff changeset
4 ;
heinrichsweikamp
parents:
diff changeset
5 ; Sensor subroutines
heinrichsweikamp
parents:
diff changeset
6 ;
heinrichsweikamp
parents:
diff changeset
7 ; Copyright (c) 2011, JD Gascuel, HeinrichsWeikamp, all right reserved.
heinrichsweikamp
parents:
diff changeset
8 ;=============================================================================
heinrichsweikamp
parents:
diff changeset
9 ; HISTORY
heinrichsweikamp
parents:
diff changeset
10 ; 2011-08-03 : [mH] moving from OSTC code
heinrichsweikamp
parents:
diff changeset
11
heinrichsweikamp
parents:
diff changeset
12 #include "ostc3.inc" ; Mandatory header
heinrichsweikamp
parents:
diff changeset
13 #include "math.inc" ; Math routines
heinrichsweikamp
parents:
diff changeset
14
heinrichsweikamp
parents:
diff changeset
15 sensors CODE
heinrichsweikamp
parents:
diff changeset
16
heinrichsweikamp
parents:
diff changeset
17 ;=============================================================================
heinrichsweikamp
parents:
diff changeset
18 ; Expose internal variables, to ease debug:
heinrichsweikamp
parents:
diff changeset
19 global D1, D2
heinrichsweikamp
parents:
diff changeset
20 global C1, C2, C3, C4, C5, C6
heinrichsweikamp
parents:
diff changeset
21 global xdT, xdT2, OFF, SENS, amb_pressure_avg, temperature_avg
heinrichsweikamp
parents:
diff changeset
22
heinrichsweikamp
parents:
diff changeset
23 ;=============================================================================
heinrichsweikamp
parents:
diff changeset
24 global calculate_compensation
heinrichsweikamp
parents:
diff changeset
25 calculate_compensation:
heinrichsweikamp
parents:
diff changeset
26 ; xdT = D2 - C5 (s16 range -11.400 .. +12.350)
heinrichsweikamp
parents:
diff changeset
27 movf C5+0,W ; Get Value to be subtracted
heinrichsweikamp
parents:
diff changeset
28 subwf D2+0,W ; Do the Low Byte
heinrichsweikamp
parents:
diff changeset
29 movwf xdT+0
heinrichsweikamp
parents:
diff changeset
30 movf C5+1,W ; Then the high byte.
heinrichsweikamp
parents:
diff changeset
31 subwfb D2+1,W
heinrichsweikamp
parents:
diff changeset
32 movwf xdT+1
heinrichsweikamp
parents:
diff changeset
33
heinrichsweikamp
parents:
diff changeset
34 ; Second order temperature calculation
heinrichsweikamp
parents:
diff changeset
35 ; xdT/128 is in range -89..+96, hence signed 8bit. dT/128 = (2*dT)/256
heinrichsweikamp
parents:
diff changeset
36 rlcf xdT+0,W ; put hit bit in carry.
heinrichsweikamp
parents:
diff changeset
37 rlcf xdT+1,W ; inject in high byte.
heinrichsweikamp
parents:
diff changeset
38 movwf isr_xA+0 ; and put result in low byte.
heinrichsweikamp
parents:
diff changeset
39 clrf isr_xA+1
heinrichsweikamp
parents:
diff changeset
40 btfsc xdT+1,7 ; If dT < 0
heinrichsweikamp
parents:
diff changeset
41 setf isr_xA+1 ; then signextend to -1
heinrichsweikamp
parents:
diff changeset
42 movff isr_xA+0,isr_xB+0 ; copy A to B
heinrichsweikamp
parents:
diff changeset
43 movff isr_xA+1,isr_xB+1
heinrichsweikamp
parents:
diff changeset
44 call isr_signed_mult16x16 ; dT*dT --> xC (32 bits)
heinrichsweikamp
parents:
diff changeset
45
heinrichsweikamp
parents:
diff changeset
46 ; dT >= 0: divide by 8, ie. 3 shifts rights.
heinrichsweikamp
parents:
diff changeset
47 ; dT < 0: divide by 2, ie. 1 shifts rights.
heinrichsweikamp
parents:
diff changeset
48 movlw .3
heinrichsweikamp
parents:
diff changeset
49 btfss xdT+1,7 ; Was dT negative ?
heinrichsweikamp
parents:
diff changeset
50 movlw .1
heinrichsweikamp
parents:
diff changeset
51 calc_loop_1:
heinrichsweikamp
parents:
diff changeset
52 bcf STATUS,C ;dT^2 is positive, so injected zeros.
heinrichsweikamp
parents:
diff changeset
53 rrcf isr_xC+1,F
heinrichsweikamp
parents:
diff changeset
54 rrcf isr_xC+0,F
heinrichsweikamp
parents:
diff changeset
55 decfsz WREG
heinrichsweikamp
parents:
diff changeset
56 bra calc_loop_1
heinrichsweikamp
parents:
diff changeset
57
heinrichsweikamp
parents:
diff changeset
58 movf isr_xC+0,W ; dT2 = dT - (dT/128)*(dT/128)/(2 ...or... 8)
heinrichsweikamp
parents:
diff changeset
59 subwf xdT+0,W
heinrichsweikamp
parents:
diff changeset
60 movwf xdT2+0
heinrichsweikamp
parents:
diff changeset
61 movf isr_xC+1,W
heinrichsweikamp
parents:
diff changeset
62 subwfb xdT+1,W
heinrichsweikamp
parents:
diff changeset
63 movwf xdT2+1
heinrichsweikamp
parents:
diff changeset
64
heinrichsweikamp
parents:
diff changeset
65 ; Calculate OFF = C2 + ((C4-250)*dT2)/2^12 + 10000
heinrichsweikamp
parents:
diff changeset
66 ; (range +9.246 .. +18.887)
heinrichsweikamp
parents:
diff changeset
67 movff C4+0,isr_xA+0
heinrichsweikamp
parents:
diff changeset
68 movff C4+1,isr_xA+1
heinrichsweikamp
parents:
diff changeset
69 ; movlw LOW(-.250) ; C4 - 250 --> A
heinrichsweikamp
parents:
diff changeset
70 ; addwf C4+0,W
heinrichsweikamp
parents:
diff changeset
71 ; movwf isr_xA+0
heinrichsweikamp
parents:
diff changeset
72 ; movlw -1 ; HIGH(- .250) is not understood...
heinrichsweikamp
parents:
diff changeset
73 ; addwfc C4+1,W
heinrichsweikamp
parents:
diff changeset
74 ; movwf isr_xA+1
heinrichsweikamp
parents:
diff changeset
75
heinrichsweikamp
parents:
diff changeset
76 movff xdT2+0,isr_xB+0 ; dT2 --> B
heinrichsweikamp
parents:
diff changeset
77 movff xdT2+1,isr_xB+1
heinrichsweikamp
parents:
diff changeset
78 call isr_signed_mult16x16
heinrichsweikamp
parents:
diff changeset
79 movlw .12-.8 ; A 12bit shift = 1 byte + 4 bits.
heinrichsweikamp
parents:
diff changeset
80 call isr_shift_C31
heinrichsweikamp
parents:
diff changeset
81
heinrichsweikamp
parents:
diff changeset
82 movlw LOW(.10000) ; Add 10000
heinrichsweikamp
parents:
diff changeset
83 addwf isr_xC+1,F
heinrichsweikamp
parents:
diff changeset
84 movlw HIGH(.10000)
heinrichsweikamp
parents:
diff changeset
85 addwfc isr_xC+2,F
heinrichsweikamp
parents:
diff changeset
86
heinrichsweikamp
parents:
diff changeset
87 movf C2+0,W ; Add C2, and save into OFF
heinrichsweikamp
parents:
diff changeset
88 addwf isr_xC+1,W
heinrichsweikamp
parents:
diff changeset
89 movwf OFF+0
heinrichsweikamp
parents:
diff changeset
90 movf C2+1,W
heinrichsweikamp
parents:
diff changeset
91 addwfc isr_xC+2,W
heinrichsweikamp
parents:
diff changeset
92 movwf OFF+1
heinrichsweikamp
parents:
diff changeset
93
heinrichsweikamp
parents:
diff changeset
94 ; Calculate SENS = C1/2 + ((C3+200)*dT)/2^13 + 3000
heinrichsweikamp
parents:
diff changeset
95 movlw LOW(.200) ; C3+200 --> A
heinrichsweikamp
parents:
diff changeset
96 addwf C3+0,W
heinrichsweikamp
parents:
diff changeset
97 movwf isr_xA+0
heinrichsweikamp
parents:
diff changeset
98 movlw HIGH(.200)
heinrichsweikamp
parents:
diff changeset
99 addwfc C3+1,W
heinrichsweikamp
parents:
diff changeset
100 movwf isr_xA+1
heinrichsweikamp
parents:
diff changeset
101 ; B still contains dT2
heinrichsweikamp
parents:
diff changeset
102 call isr_signed_mult16x16 ; A*B --> C
heinrichsweikamp
parents:
diff changeset
103 movlw .13-.8 ; A 13bit shift = 1 byte + 5 bits.
heinrichsweikamp
parents:
diff changeset
104 call isr_shift_C31
heinrichsweikamp
parents:
diff changeset
105
heinrichsweikamp
parents:
diff changeset
106 bcf STATUS,C ; SENS = C1 / 2
heinrichsweikamp
parents:
diff changeset
107 rrcf C1+1,W
heinrichsweikamp
parents:
diff changeset
108 movwf SENS+1
heinrichsweikamp
parents:
diff changeset
109 rrcf C1+0,W
heinrichsweikamp
parents:
diff changeset
110 movwf SENS+0
heinrichsweikamp
parents:
diff changeset
111
heinrichsweikamp
parents:
diff changeset
112 movlw LOW(.3000) ; Add 3000
heinrichsweikamp
parents:
diff changeset
113 addwf isr_xC+1,F
heinrichsweikamp
parents:
diff changeset
114 movlw HIGH(.3000)
heinrichsweikamp
parents:
diff changeset
115 addwfc isr_xC+2,F
heinrichsweikamp
parents:
diff changeset
116
heinrichsweikamp
parents:
diff changeset
117 movf isr_xC+1,W ; And sum into SENS
heinrichsweikamp
parents:
diff changeset
118 addwf SENS+0,F
heinrichsweikamp
parents:
diff changeset
119 movf isr_xC+2,W
heinrichsweikamp
parents:
diff changeset
120 addwfc SENS+1,F
heinrichsweikamp
parents:
diff changeset
121
heinrichsweikamp
parents:
diff changeset
122 ; calculate amb_pressure = (sens * (d1-off))/2^12 + 1000
heinrichsweikamp
parents:
diff changeset
123 movf OFF+0,W ; d1-off --> a
heinrichsweikamp
parents:
diff changeset
124 subwf D1+0,W
heinrichsweikamp
parents:
diff changeset
125 movwf isr_xA+0
heinrichsweikamp
parents:
diff changeset
126 movf OFF+1,W
heinrichsweikamp
parents:
diff changeset
127 subwfb D1+1,W
heinrichsweikamp
parents:
diff changeset
128 movwf isr_xA+1
heinrichsweikamp
parents:
diff changeset
129
heinrichsweikamp
parents:
diff changeset
130 movff SENS+0,isr_xB+0 ; sens --> b
heinrichsweikamp
parents:
diff changeset
131 movff SENS+1,isr_xB+1
heinrichsweikamp
parents:
diff changeset
132 call isr_signed_mult16x16
heinrichsweikamp
parents:
diff changeset
133 movlw .12-.8 ; a 12bit shift = 1 byte + 4 bits.
heinrichsweikamp
parents:
diff changeset
134 call isr_shift_C31
heinrichsweikamp
parents:
diff changeset
135
heinrichsweikamp
parents:
diff changeset
136 movlw LOW(.1000) ; add 1000
heinrichsweikamp
parents:
diff changeset
137 addwf isr_xC+1,F
heinrichsweikamp
parents:
diff changeset
138 movlw HIGH(.1000)
heinrichsweikamp
parents:
diff changeset
139 addwfc isr_xC+2,F
heinrichsweikamp
parents:
diff changeset
140
heinrichsweikamp
parents:
diff changeset
141 banksel common
heinrichsweikamp
parents:
diff changeset
142 btfss simulatormode_active ; are we in simulator mode?
heinrichsweikamp
parents:
diff changeset
143 bra calc_compensation_2 ; no
heinrichsweikamp
parents:
diff changeset
144 banksel isr_backup
heinrichsweikamp
parents:
diff changeset
145
heinrichsweikamp
parents:
diff changeset
146 movff sim_pressure+0,isr_xC+1 ; override readings with simulator values
heinrichsweikamp
parents:
diff changeset
147 movff sim_pressure+1,isr_xC+2
heinrichsweikamp
parents:
diff changeset
148
heinrichsweikamp
parents:
diff changeset
149 calc_compensation_2:
heinrichsweikamp
parents:
diff changeset
150 banksel isr_backup
heinrichsweikamp
parents:
diff changeset
151 movf isr_xC+1,W ; Then sum_up to pressure averaging buffer.
heinrichsweikamp
parents:
diff changeset
152 addwf amb_pressure_avg+0,F
heinrichsweikamp
parents:
diff changeset
153 movf isr_xC+2,W
heinrichsweikamp
parents:
diff changeset
154 addwfc amb_pressure_avg+1,F
heinrichsweikamp
parents:
diff changeset
155
heinrichsweikamp
parents:
diff changeset
156 ; calculate temp = 200 + dT*(C6+100)/2^11
heinrichsweikamp
parents:
diff changeset
157 movlw LOW(.100) ; C6 + 100 --> A
heinrichsweikamp
parents:
diff changeset
158 addwf C6+0,W
heinrichsweikamp
parents:
diff changeset
159 movwf isr_xA+0
heinrichsweikamp
parents:
diff changeset
160 movlw HIGH(.100)
heinrichsweikamp
parents:
diff changeset
161 addwfc C6+1,W
heinrichsweikamp
parents:
diff changeset
162 movwf isr_xA+1
heinrichsweikamp
parents:
diff changeset
163
heinrichsweikamp
parents:
diff changeset
164 movff xdT2+0,isr_xB+0 ; dT2 --> B
heinrichsweikamp
parents:
diff changeset
165 movff xdT2+1,isr_xB+1
heinrichsweikamp
parents:
diff changeset
166 call isr_signed_mult16x16 ; A*B
heinrichsweikamp
parents:
diff changeset
167 movlw .11-.8 ; A 12bit shift = 1 byte + 3 bits.
heinrichsweikamp
parents:
diff changeset
168 call isr_shift_C31
heinrichsweikamp
parents:
diff changeset
169
heinrichsweikamp
parents:
diff changeset
170 movlw LOW(.200) ; Add 200
heinrichsweikamp
parents:
diff changeset
171 addwf isr_xC+1,F
heinrichsweikamp
parents:
diff changeset
172 movlw HIGH(.200)
heinrichsweikamp
parents:
diff changeset
173 addwfc isr_xC+2,F
heinrichsweikamp
parents:
diff changeset
174
heinrichsweikamp
parents:
diff changeset
175 movf isr_xC+1,W
heinrichsweikamp
parents:
diff changeset
176 addwf temperature_avg+0,F
heinrichsweikamp
parents:
diff changeset
177 movf isr_xC+2,W
heinrichsweikamp
parents:
diff changeset
178 addwfc temperature_avg+1,F
heinrichsweikamp
parents:
diff changeset
179
heinrichsweikamp
parents:
diff changeset
180 return ; Done.
heinrichsweikamp
parents:
diff changeset
181
heinrichsweikamp
parents:
diff changeset
182 ;=============================================================================
heinrichsweikamp
parents:
diff changeset
183 global get_pressure_start
heinrichsweikamp
parents:
diff changeset
184 get_pressure_start:
heinrichsweikamp
parents:
diff changeset
185 rcall reset_MS5541
heinrichsweikamp
parents:
diff changeset
186 movlw b'10100000' ;+3*high as start and 1+low as stop!
heinrichsweikamp
parents:
diff changeset
187 get_pressure_start2:
heinrichsweikamp
parents:
diff changeset
188 movwf isr1_temp
heinrichsweikamp
parents:
diff changeset
189 movlw d'12'
heinrichsweikamp
parents:
diff changeset
190 rcall send_data_MS5541
heinrichsweikamp
parents:
diff changeset
191 return
heinrichsweikamp
parents:
diff changeset
192
heinrichsweikamp
parents:
diff changeset
193 global get_pressure_value
heinrichsweikamp
parents:
diff changeset
194 get_pressure_value:
heinrichsweikamp
parents:
diff changeset
195 btfsc MS5541_miso ; Conversion done?
heinrichsweikamp
parents:
diff changeset
196 return ; No, Return
heinrichsweikamp
parents:
diff changeset
197 rcall get_2bytes_MS5541
heinrichsweikamp
parents:
diff changeset
198 movff dMSB,D1+1
heinrichsweikamp
parents:
diff changeset
199 movff dLSB,D1+0
heinrichsweikamp
parents:
diff changeset
200 return
heinrichsweikamp
parents:
diff changeset
201
heinrichsweikamp
parents:
diff changeset
202 ;=============================================================================
heinrichsweikamp
parents:
diff changeset
203 global get_temperature_start
heinrichsweikamp
parents:
diff changeset
204 get_temperature_start:
heinrichsweikamp
parents:
diff changeset
205 rcall reset_MS5541
heinrichsweikamp
parents:
diff changeset
206 movlw b'10010000' ;+3*high as start and 1+low as stop!
heinrichsweikamp
parents:
diff changeset
207 bra get_pressure_start2 ; continue in "get_pressure"
heinrichsweikamp
parents:
diff changeset
208
heinrichsweikamp
parents:
diff changeset
209 global get_temperature_value
heinrichsweikamp
parents:
diff changeset
210 get_temperature_value:
heinrichsweikamp
parents:
diff changeset
211 btfsc MS5541_miso ; Conversion done?
heinrichsweikamp
parents:
diff changeset
212 return ; No, Return
heinrichsweikamp
parents:
diff changeset
213 rcall get_2bytes_MS5541
heinrichsweikamp
parents:
diff changeset
214 movff dMSB,D2+1
heinrichsweikamp
parents:
diff changeset
215 movff dLSB,D2+0
heinrichsweikamp
parents:
diff changeset
216 return
heinrichsweikamp
parents:
diff changeset
217
heinrichsweikamp
parents:
diff changeset
218 ;=============================================================================
heinrichsweikamp
parents:
diff changeset
219 global get_calibration_data
heinrichsweikamp
parents:
diff changeset
220 get_calibration_data:
heinrichsweikamp
parents:
diff changeset
221 banksel common
heinrichsweikamp
parents:
diff changeset
222 bsf no_sensor_int ; disable sensor interrupts
heinrichsweikamp
parents:
diff changeset
223 banksel isr_backup ; Back to Bank0 ISR data
heinrichsweikamp
parents:
diff changeset
224
heinrichsweikamp
parents:
diff changeset
225 rcall reset_MS5541
heinrichsweikamp
parents:
diff changeset
226 movlw b'01010100' ;+3*high as start and 1+low as stop!
heinrichsweikamp
parents:
diff changeset
227 movwf isr1_temp
heinrichsweikamp
parents:
diff changeset
228 movlw d'13'
heinrichsweikamp
parents:
diff changeset
229 rcall send_data_MS5541
heinrichsweikamp
parents:
diff changeset
230 rcall get_2bytes_MS5541
heinrichsweikamp
parents:
diff changeset
231 movff dMSB,W1+1
heinrichsweikamp
parents:
diff changeset
232 movff dLSB,W1+0
heinrichsweikamp
parents:
diff changeset
233
heinrichsweikamp
parents:
diff changeset
234 movlw b'01011000' ;+3*high as start and 1+low as stop!
heinrichsweikamp
parents:
diff changeset
235 movwf isr1_temp
heinrichsweikamp
parents:
diff changeset
236 movlw d'13'
heinrichsweikamp
parents:
diff changeset
237 rcall send_data_MS5541
heinrichsweikamp
parents:
diff changeset
238 rcall get_2bytes_MS5541
heinrichsweikamp
parents:
diff changeset
239 movff dMSB,W2+1
heinrichsweikamp
parents:
diff changeset
240 movff dLSB,W2+0
heinrichsweikamp
parents:
diff changeset
241
heinrichsweikamp
parents:
diff changeset
242 movlw b'01100100' ;+3*high as start and 1+low as stop!
heinrichsweikamp
parents:
diff changeset
243 movwf isr1_temp
heinrichsweikamp
parents:
diff changeset
244 movlw d'13'
heinrichsweikamp
parents:
diff changeset
245 rcall send_data_MS5541
heinrichsweikamp
parents:
diff changeset
246 rcall get_2bytes_MS5541
heinrichsweikamp
parents:
diff changeset
247 movff dMSB,W3+1
heinrichsweikamp
parents:
diff changeset
248 movff dLSB,W3+0
heinrichsweikamp
parents:
diff changeset
249
heinrichsweikamp
parents:
diff changeset
250 movlw b'01101000' ;+3*high as start and 1+low as stop!
heinrichsweikamp
parents:
diff changeset
251 movwf isr1_temp
heinrichsweikamp
parents:
diff changeset
252 movlw d'13'
heinrichsweikamp
parents:
diff changeset
253 rcall send_data_MS5541
heinrichsweikamp
parents:
diff changeset
254 rcall get_2bytes_MS5541
heinrichsweikamp
parents:
diff changeset
255 movff dMSB,W4+1
heinrichsweikamp
parents:
diff changeset
256 movff dLSB,W4+0
heinrichsweikamp
parents:
diff changeset
257
heinrichsweikamp
parents:
diff changeset
258 ; calculate C1 (16Bit)
heinrichsweikamp
parents:
diff changeset
259 movff W1+1, C1+1
heinrichsweikamp
parents:
diff changeset
260 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
261 rrcf C1+1
heinrichsweikamp
parents:
diff changeset
262 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
263 rrcf C1+1
heinrichsweikamp
parents:
diff changeset
264 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
265 rrcf C1+1
heinrichsweikamp
parents:
diff changeset
266 movff W1+0, C1+0
heinrichsweikamp
parents:
diff changeset
267 bsf STATUS,C
heinrichsweikamp
parents:
diff changeset
268 btfss W1+1,0
heinrichsweikamp
parents:
diff changeset
269 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
270 rrcf C1+0
heinrichsweikamp
parents:
diff changeset
271 bsf STATUS,C
heinrichsweikamp
parents:
diff changeset
272 btfss W1+1,1
heinrichsweikamp
parents:
diff changeset
273 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
274 rrcf C1+0
heinrichsweikamp
parents:
diff changeset
275 bsf STATUS,C
heinrichsweikamp
parents:
diff changeset
276 btfss W1+1,2
heinrichsweikamp
parents:
diff changeset
277 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
278 rrcf C1+0
heinrichsweikamp
parents:
diff changeset
279
heinrichsweikamp
parents:
diff changeset
280 ; calculate C2 (16Bit)
heinrichsweikamp
parents:
diff changeset
281 movff W2+0, C2+0
heinrichsweikamp
parents:
diff changeset
282 bsf STATUS,C
heinrichsweikamp
parents:
diff changeset
283 btfss W2+1,0
heinrichsweikamp
parents:
diff changeset
284 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
285 rrcf C2+0
heinrichsweikamp
parents:
diff changeset
286 bsf STATUS,C
heinrichsweikamp
parents:
diff changeset
287 btfss W2+1,1
heinrichsweikamp
parents:
diff changeset
288 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
289 rrcf C2+0
heinrichsweikamp
parents:
diff changeset
290 bsf STATUS,C
heinrichsweikamp
parents:
diff changeset
291 btfss W2+1,2
heinrichsweikamp
parents:
diff changeset
292 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
293 rrcf C2+0
heinrichsweikamp
parents:
diff changeset
294 bsf STATUS,C
heinrichsweikamp
parents:
diff changeset
295 btfss W2+1,3
heinrichsweikamp
parents:
diff changeset
296 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
297 rrcf C2+0
heinrichsweikamp
parents:
diff changeset
298 bsf STATUS,C
heinrichsweikamp
parents:
diff changeset
299 btfss W2+1,4
heinrichsweikamp
parents:
diff changeset
300 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
301 rrcf C2+0
heinrichsweikamp
parents:
diff changeset
302 bsf STATUS,C
heinrichsweikamp
parents:
diff changeset
303 btfss W2+1,5
heinrichsweikamp
parents:
diff changeset
304 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
305 rrcf C2+0
heinrichsweikamp
parents:
diff changeset
306
heinrichsweikamp
parents:
diff changeset
307 movff W2+1, C2+1
heinrichsweikamp
parents:
diff changeset
308 bsf STATUS,C
heinrichsweikamp
parents:
diff changeset
309 btfss W1+0,0
heinrichsweikamp
parents:
diff changeset
310 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
311 rrcf C2+1
heinrichsweikamp
parents:
diff changeset
312 bsf STATUS,C
heinrichsweikamp
parents:
diff changeset
313 btfss W1+0,1
heinrichsweikamp
parents:
diff changeset
314 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
315 rrcf C2+1
heinrichsweikamp
parents:
diff changeset
316 bsf STATUS,C
heinrichsweikamp
parents:
diff changeset
317 btfss W1+0,2
heinrichsweikamp
parents:
diff changeset
318 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
319 rrcf C2+1
heinrichsweikamp
parents:
diff changeset
320 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
321 rrcf C2+1
heinrichsweikamp
parents:
diff changeset
322 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
323 rrcf C2+1
heinrichsweikamp
parents:
diff changeset
324 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
325 rrcf C2+1
heinrichsweikamp
parents:
diff changeset
326
heinrichsweikamp
parents:
diff changeset
327 ; calculate C3 (16Bit)
heinrichsweikamp
parents:
diff changeset
328 movff W3+1,C3+0
heinrichsweikamp
parents:
diff changeset
329 bsf STATUS,C
heinrichsweikamp
parents:
diff changeset
330 btfss W3+0,7
heinrichsweikamp
parents:
diff changeset
331 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
332 rlcf C3+0
heinrichsweikamp
parents:
diff changeset
333 bsf STATUS,C
heinrichsweikamp
parents:
diff changeset
334 btfss W3+0,6
heinrichsweikamp
parents:
diff changeset
335 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
336 rlcf C3+0
heinrichsweikamp
parents:
diff changeset
337 clrf C3+1
heinrichsweikamp
parents:
diff changeset
338 btfsc W3+1,7
heinrichsweikamp
parents:
diff changeset
339 bsf C3+1,1
heinrichsweikamp
parents:
diff changeset
340 btfsc W3+1,6
heinrichsweikamp
parents:
diff changeset
341 bsf C3+1,0
heinrichsweikamp
parents:
diff changeset
342
heinrichsweikamp
parents:
diff changeset
343 ; calculate C4 (16Bit)
heinrichsweikamp
parents:
diff changeset
344 movff W4+1,C4+0
heinrichsweikamp
parents:
diff changeset
345 bsf STATUS,C
heinrichsweikamp
parents:
diff changeset
346 btfss W4+0,7
heinrichsweikamp
parents:
diff changeset
347 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
348 rlcf C4+0
heinrichsweikamp
parents:
diff changeset
349 clrf C4+1
heinrichsweikamp
parents:
diff changeset
350 btfsc W4+1,7
heinrichsweikamp
parents:
diff changeset
351 bsf C4+1,0
heinrichsweikamp
parents:
diff changeset
352
heinrichsweikamp
parents:
diff changeset
353 ; C4=C4-250
heinrichsweikamp
parents:
diff changeset
354 movlw LOW(-.250) ; C4 - 250 --> C4
heinrichsweikamp
parents:
diff changeset
355 addwf C4+0,W
heinrichsweikamp
parents:
diff changeset
356 movwf C4+0
heinrichsweikamp
parents:
diff changeset
357 movlw -1 ; HIGH(- .250) is not understood...
heinrichsweikamp
parents:
diff changeset
358 addwfc C4+1,W
heinrichsweikamp
parents:
diff changeset
359 movwf C4+1
heinrichsweikamp
parents:
diff changeset
360
heinrichsweikamp
parents:
diff changeset
361 ; calculate C5 (16Bit)
heinrichsweikamp
parents:
diff changeset
362 movff W3+0,C5+0
heinrichsweikamp
parents:
diff changeset
363 bcf C5+0,6
heinrichsweikamp
parents:
diff changeset
364 btfsc W2+0,0
heinrichsweikamp
parents:
diff changeset
365 bsf C5+0,6
heinrichsweikamp
parents:
diff changeset
366 bcf C5+0,7
heinrichsweikamp
parents:
diff changeset
367 btfsc W2+0,1
heinrichsweikamp
parents:
diff changeset
368 bsf C5+0,7
heinrichsweikamp
parents:
diff changeset
369 clrf C5+1
heinrichsweikamp
parents:
diff changeset
370 btfsc W2+0,2
heinrichsweikamp
parents:
diff changeset
371 bsf C5+1,0
heinrichsweikamp
parents:
diff changeset
372 btfsc W2+0,3
heinrichsweikamp
parents:
diff changeset
373 bsf C5+1,1
heinrichsweikamp
parents:
diff changeset
374 btfsc W2+0,4
heinrichsweikamp
parents:
diff changeset
375 bsf C5+1,2
heinrichsweikamp
parents:
diff changeset
376 btfsc W2+0,5
heinrichsweikamp
parents:
diff changeset
377 bsf C5+1,3
heinrichsweikamp
parents:
diff changeset
378
heinrichsweikamp
parents:
diff changeset
379 ; calculate C5 = UT1
heinrichsweikamp
parents:
diff changeset
380 ; C5 = 8*C5 + 10000 (u16 range 10.000 .. +42.760)
heinrichsweikamp
parents:
diff changeset
381 clrf isr_xA+1
heinrichsweikamp
parents:
diff changeset
382 movlw d'8'
heinrichsweikamp
parents:
diff changeset
383 movwf isr_xA+0
heinrichsweikamp
parents:
diff changeset
384 movff C5+0,isr_xB+0
heinrichsweikamp
parents:
diff changeset
385 movff C5+1,isr_xB+1
heinrichsweikamp
parents:
diff changeset
386 call isr_unsigned_mult16x16 ;isr_xA*isr_xB=isr_xC
heinrichsweikamp
parents:
diff changeset
387 movff isr_xC+0,C5+0
heinrichsweikamp
parents:
diff changeset
388 movff isr_xC+1,C5+1
heinrichsweikamp
parents:
diff changeset
389 movlw LOW d'10000'
heinrichsweikamp
parents:
diff changeset
390 addwf C5+0,F
heinrichsweikamp
parents:
diff changeset
391 movlw HIGH d'10000'
heinrichsweikamp
parents:
diff changeset
392 addwfc C5+1,F ; = 8*C5 + 10000
heinrichsweikamp
parents:
diff changeset
393
heinrichsweikamp
parents:
diff changeset
394 ; calculate C6 (16Bit)
heinrichsweikamp
parents:
diff changeset
395 clrf C6+1
heinrichsweikamp
parents:
diff changeset
396 movff W4+0,C6+0
heinrichsweikamp
parents:
diff changeset
397 bcf C6+0,7
heinrichsweikamp
parents:
diff changeset
398
heinrichsweikamp
parents:
diff changeset
399 banksel common
heinrichsweikamp
parents:
diff changeset
400 bcf no_sensor_int ; enable sensor interrupts
heinrichsweikamp
parents:
diff changeset
401 bcf pressure_refresh ; Clear flag
heinrichsweikamp
parents:
diff changeset
402 banksel isr_backup ; Back to Bank0 ISR data
heinrichsweikamp
parents:
diff changeset
403
heinrichsweikamp
parents:
diff changeset
404 clrf sensor_state_counter ; Then reset State counter
heinrichsweikamp
parents:
diff changeset
405
heinrichsweikamp
parents:
diff changeset
406 return
heinrichsweikamp
parents:
diff changeset
407
heinrichsweikamp
parents:
diff changeset
408 ;=============================================================================
heinrichsweikamp
parents:
diff changeset
409 reset_MS5541_one:
heinrichsweikamp
parents:
diff changeset
410 bsf MS5541_mosi
heinrichsweikamp
parents:
diff changeset
411 bra send_clk_pulse ; Send one high-low sequence on MS5541_clk -> and return
heinrichsweikamp
parents:
diff changeset
412
heinrichsweikamp
parents:
diff changeset
413 reset_MS5541_zero:
heinrichsweikamp
parents:
diff changeset
414 bcf MS5541_mosi
heinrichsweikamp
parents:
diff changeset
415 bra send_clk_pulse ; Send one high-low sequence on MS5541_clk -> and return
heinrichsweikamp
parents:
diff changeset
416
heinrichsweikamp
parents:
diff changeset
417 reset_MS5541:
heinrichsweikamp
parents:
diff changeset
418 rcall reset_MS5541_one ;0
heinrichsweikamp
parents:
diff changeset
419 rcall reset_MS5541_zero
heinrichsweikamp
parents:
diff changeset
420 rcall reset_MS5541_one
heinrichsweikamp
parents:
diff changeset
421 rcall reset_MS5541_zero
heinrichsweikamp
parents:
diff changeset
422 rcall reset_MS5541_one
heinrichsweikamp
parents:
diff changeset
423 rcall reset_MS5541_zero
heinrichsweikamp
parents:
diff changeset
424 rcall reset_MS5541_one
heinrichsweikamp
parents:
diff changeset
425 rcall reset_MS5541_zero
heinrichsweikamp
parents:
diff changeset
426 rcall reset_MS5541_one
heinrichsweikamp
parents:
diff changeset
427 rcall reset_MS5541_zero
heinrichsweikamp
parents:
diff changeset
428 rcall reset_MS5541_one
heinrichsweikamp
parents:
diff changeset
429 rcall reset_MS5541_zero
heinrichsweikamp
parents:
diff changeset
430 rcall reset_MS5541_one
heinrichsweikamp
parents:
diff changeset
431 rcall reset_MS5541_zero
heinrichsweikamp
parents:
diff changeset
432 rcall reset_MS5541_one
heinrichsweikamp
parents:
diff changeset
433 rcall reset_MS5541_zero ;15
heinrichsweikamp
parents:
diff changeset
434 rcall reset_MS5541_zero
heinrichsweikamp
parents:
diff changeset
435 rcall reset_MS5541_zero
heinrichsweikamp
parents:
diff changeset
436 rcall reset_MS5541_zero
heinrichsweikamp
parents:
diff changeset
437 rcall reset_MS5541_zero
heinrichsweikamp
parents:
diff changeset
438 rcall reset_MS5541_zero ;20
heinrichsweikamp
parents:
diff changeset
439 return
heinrichsweikamp
parents:
diff changeset
440
heinrichsweikamp
parents:
diff changeset
441 get_2bytes_MS5541:
heinrichsweikamp
parents:
diff changeset
442 movlw d'8'
heinrichsweikamp
parents:
diff changeset
443 movwf clock_count
heinrichsweikamp
parents:
diff changeset
444 rcall recieve_loop
heinrichsweikamp
parents:
diff changeset
445 movff isr1_temp,dMSB
heinrichsweikamp
parents:
diff changeset
446
heinrichsweikamp
parents:
diff changeset
447 movlw d'8'
heinrichsweikamp
parents:
diff changeset
448 movwf clock_count
heinrichsweikamp
parents:
diff changeset
449 rcall recieve_loop
heinrichsweikamp
parents:
diff changeset
450 movff isr1_temp,dLSB
heinrichsweikamp
parents:
diff changeset
451 bra send_clk_pulse ; Send one high-low sequence on MS5541_clk -> and return
heinrichsweikamp
parents:
diff changeset
452 ;return
heinrichsweikamp
parents:
diff changeset
453
heinrichsweikamp
parents:
diff changeset
454 recieve_loop:
heinrichsweikamp
parents:
diff changeset
455 rcall send_clk_pulse ; Send one high-low sequence on MS5541_clk
heinrichsweikamp
parents:
diff changeset
456 btfss MS5541_miso ;MSB first
heinrichsweikamp
parents:
diff changeset
457 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
458 btfsc MS5541_miso ;MSB first
heinrichsweikamp
parents:
diff changeset
459 bsf STATUS,C
heinrichsweikamp
parents:
diff changeset
460 rlcf isr1_temp,F
heinrichsweikamp
parents:
diff changeset
461 decfsz clock_count,F
heinrichsweikamp
parents:
diff changeset
462 bra recieve_loop
heinrichsweikamp
parents:
diff changeset
463 return
heinrichsweikamp
parents:
diff changeset
464
heinrichsweikamp
parents:
diff changeset
465 send_clk_pulse:
heinrichsweikamp
parents:
diff changeset
466 bsf MS5541_clk
heinrichsweikamp
parents:
diff changeset
467 nop
heinrichsweikamp
parents:
diff changeset
468 nop
heinrichsweikamp
parents:
diff changeset
469 nop
heinrichsweikamp
parents:
diff changeset
470 nop
heinrichsweikamp
parents:
diff changeset
471 bcf MS5541_clk
heinrichsweikamp
parents:
diff changeset
472 nop
heinrichsweikamp
parents:
diff changeset
473 nop
heinrichsweikamp
parents:
diff changeset
474 return
heinrichsweikamp
parents:
diff changeset
475
heinrichsweikamp
parents:
diff changeset
476 send_data_MS5541:
heinrichsweikamp
parents:
diff changeset
477 movwf clock_count ; From WREG
heinrichsweikamp
parents:
diff changeset
478 ; send three startbits first
heinrichsweikamp
parents:
diff changeset
479 bcf MS5541_clk
heinrichsweikamp
parents:
diff changeset
480 bsf MS5541_mosi
heinrichsweikamp
parents:
diff changeset
481 movlw d'3'
heinrichsweikamp
parents:
diff changeset
482 subwf clock_count,F ; total bit counter
heinrichsweikamp
parents:
diff changeset
483 rcall send_clk_pulse ; Send one high-low sequence on MS5541_clk
heinrichsweikamp
parents:
diff changeset
484 rcall send_clk_pulse ; Send one high-low sequence on MS5541_clk
heinrichsweikamp
parents:
diff changeset
485 rcall send_clk_pulse ; Send one high-low sequence on MS5541_clk
heinrichsweikamp
parents:
diff changeset
486 ; now send 8 bytes from isr_temp1 and fill-up with zeros
heinrichsweikamp
parents:
diff changeset
487 send_data_MS5541_2:
heinrichsweikamp
parents:
diff changeset
488 bcf MS5541_clk
heinrichsweikamp
parents:
diff changeset
489
heinrichsweikamp
parents:
diff changeset
490 btfss isr1_temp,7 ;MSB first
heinrichsweikamp
parents:
diff changeset
491 bcf MS5541_mosi
heinrichsweikamp
parents:
diff changeset
492 btfsc isr1_temp,7 ;MSB first
heinrichsweikamp
parents:
diff changeset
493 bsf MS5541_mosi
heinrichsweikamp
parents:
diff changeset
494
heinrichsweikamp
parents:
diff changeset
495 bsf MS5541_clk
heinrichsweikamp
parents:
diff changeset
496
heinrichsweikamp
parents:
diff changeset
497 bcf STATUS,C
heinrichsweikamp
parents:
diff changeset
498 rlcf isr1_temp,F
heinrichsweikamp
parents:
diff changeset
499 ; nop
heinrichsweikamp
parents:
diff changeset
500 ; nop
heinrichsweikamp
parents:
diff changeset
501 ; nop
heinrichsweikamp
parents:
diff changeset
502 ; nop
heinrichsweikamp
parents:
diff changeset
503 ; nop
heinrichsweikamp
parents:
diff changeset
504 ; nop
heinrichsweikamp
parents:
diff changeset
505 ; bcf MS5541_clk
heinrichsweikamp
parents:
diff changeset
506
heinrichsweikamp
parents:
diff changeset
507 decfsz clock_count,F
heinrichsweikamp
parents:
diff changeset
508 bra send_data_MS5541_2
heinrichsweikamp
parents:
diff changeset
509 bcf MS5541_clk
heinrichsweikamp
parents:
diff changeset
510 return
heinrichsweikamp
parents:
diff changeset
511
heinrichsweikamp
parents:
diff changeset
512 END