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