Mercurial > public > mk2
annotate code_part1/OSTC_code_asm_part1/ms5535.asm @ 134:48f12271eb18
divingmode graphs
small fix in altimeter menu
author | heinrichsweikamp |
---|---|
date | Wed, 05 Jan 2011 12:40:06 +0100 |
parents | 3e351e25f5d1 |
children | 8d6aca08f66b |
rev | line source |
---|---|
0 | 1 ; OSTC - diving computer code |
2 ; Copyright (C) 2008 HeinrichsWeikamp GbR | |
3 | |
4 ; This program is free software: you can redistribute it and/or modify | |
5 ; it under the terms of the GNU General Public License as published by | |
6 ; the Free Software Foundation, either version 3 of the License, or | |
7 ; (at your option) any later version. | |
8 | |
9 ; This program is distributed in the hope that it will be useful, | |
10 ; but WITHOUT ANY WARRANTY; without even the implied warranty of | |
11 ; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
12 ; GNU General Public License for more details. | |
13 | |
14 ; You should have received a copy of the GNU General Public License | |
15 ; along with this program. If not, see <http://www.gnu.org/licenses/>. | |
16 | |
17 | |
18 ; routines for Intersema MS5535A, MS5541B and MS5541C | |
19 ; written by: Matthias Heinrichs, info@heinrichsweikamp.com | |
20 ; written: 9/26/05 | |
21 ; last updated: 08/08/31 | |
22 ; known bugs: | |
23 ; ToDo: | |
24 | |
25 ; with second order temperature compensation | |
26 | |
27 calculate_compensation: | |
28 ; calculate xdT | |
29 clrf isr_xA+1 | |
30 movlw d'8' | |
31 movwf isr_xA+0 | |
32 movff C5+0,isr_xB+0 | |
33 movff C5+1,isr_xB+1 | |
34 call isr_mult16x16 ;isr_xA*isr_xB=isr_xC | |
35 movlw LOW d'10000' | |
36 addwf isr_xC+0, f | |
37 movlw HIGH d'10000' | |
38 addwfc isr_xC+1, f ;isr_xC= 8*C5 + 10000 | |
39 movff D2+0,isr_sub_a+0 | |
40 movff D2+1,isr_sub_a+1 | |
41 movff isr_xC+0,isr_sub_b+0 | |
42 movff isr_xC+1,isr_sub_b+1 | |
43 call isr_sub16 ; isr_sub_c = isr_sub_a - isr_sub_b | |
44 movff isr_sub_c+0,xdT+0 | |
45 movff isr_sub_c+1,xdT+1 | |
46 | |
47 ; Second order temperature calculation | |
48 btfsc neg_flag_isr | |
49 bra dTzero_yes | |
50 ; dT>0 | |
51 bcf neg_flag_xdT | |
52 movff xdT+0,isr_xA+0 | |
53 movff xdT+1,isr_xA+1 | |
54 movff xdT+0,isr_xB+0 | |
55 movff xdT+1,isr_xB+1 | |
56 call isr_mult16x16 ;isr_xA*isr_xB=isr_xC | |
57 movlw d'17' ; 2^17=(128*128)*8 | |
58 movwf isr_divB | |
59 call isr_div32 ; isr_xC=isr_xC(32Bit)/2^isr_divB (isr_divB: 8Bit only!) | |
60 movff xdT+0,isr_sub_a+0 | |
61 movff xdT+1,isr_sub_a+1 | |
62 movff isr_xC+0,isr_sub_b+0 | |
63 movff isr_xC+1,isr_sub_b+1 | |
64 call isr_sub16 ; isr_sub_c = isr_sub_a - isr_sub_b | |
65 movff isr_sub_c+0,xdT2+0 | |
66 movff isr_sub_c+1,xdT2+1 | |
67 bra OFF_calc ; Done | |
68 | |
69 dTzero_yes: | |
70 ; dT<0 | |
71 bsf neg_flag_xdT | |
72 movff xdT+0,isr_xA+0 | |
73 movff xdT+1,isr_xA+1 | |
74 movff xdT+0,isr_xB+0 | |
75 movff xdT+1,isr_xB+1 | |
76 call isr_mult16x16 ;isr_xA*isr_xB=isr_xC | |
77 movlw d'15' ; 2^15=(128*128)*2 | |
78 movwf isr_divB | |
79 call isr_div32 ; isr_xC=isr_xC(32Bit)/2^isr_divB (isr_divB: 8Bit only!) | |
80 | |
81 movf xdT+0,W | |
82 addwf isr_xC+0,F | |
83 movf xdT+1,W | |
84 addwfc isr_xC+1,F | |
85 movff isr_xC+0,xdT2+0 | |
86 movff isr_xC+1,xdT2+1 | |
87 | |
88 OFF_calc: | |
89 ; calculate OFF | |
90 movff C4+0,isr_sub_a | |
91 movff C4+1,isr_sub_a+1 | |
92 movlw d'250' | |
93 movwf isr_sub_b | |
94 clrf isr_sub_b+1 | |
95 call isr_sub16 ; (C4-250) - Sets neg_flag_isr! | |
96 movff isr_sub_c,isr_xA | |
97 movff isr_sub_c+1,isr_xA+1 | |
98 movff xdT+0,isr_xB | |
99 movff xdT+0+1,isr_xB+1 | |
100 call isr_mult16x16 ; (C4-250)*dT | |
101 movff isr_xC+0,isr_divA | |
102 movff isr_xC+1,isr_divA+1 | |
103 movlw d'12' | |
104 movwf isr_divB | |
105 call isr_div16 ; [(C4-250)*dT]/2^12 | |
106 movff isr_divA+0,isr_xC+0 | |
107 movff isr_divA+1,isr_xC+1 ; isr_xC= {[(C4-250)*dT]/2^12} | |
108 btfss neg_flag_isr ; neg_flag_isr=1? | |
109 bra OFF_calc2 ; Yes, do C2 - isr_xC | |
110 ; no, so do C2 + isr_xC | |
111 movf C2+0,W | |
112 addwf isr_xC+0, f | |
113 movf C2+1,W | |
114 addwfc isr_xC+1, f ; isr_xC= C2 + {[(C4-250)*dT/2^12]} | |
115 OFF_calc3: | |
116 movlw LOW d'10000' | |
117 addwf isr_xC+0, f | |
118 movlw HIGH d'10000' | |
119 addwfc isr_xC+1, f ; isr_xC=[(C4-250)*dT/2^12] + 10000 | |
120 movff isr_xC+0,OFF+0 | |
121 movff isr_xC+1,OFF+1 | |
122 bra calculate_SENS ; Done with OFF | |
123 | |
124 OFF_calc2: | |
125 movff C2+0,isr_sub_a+0 | |
126 movff C2+1,isr_sub_a+1 | |
127 movff isr_xC+0,isr_sub_b+0 | |
128 movff isr_xC+1,isr_sub_b+1 | |
129 call isr_sub16 ; isr_sub_c = isr_sub_a - isr_sub_b | |
130 ; isr_xC= C2 - {[(C4-250)*dT/2^12]} | |
131 movff isr_sub_c+0,isr_xC+0 | |
132 movff isr_sub_c+1,isr_xC+1 ; Done with OFF | |
133 bra OFF_calc3 | |
134 | |
135 calculate_SENS: | |
136 movff C3+0, C3_temp+0 | |
137 movff C3+1, C3_temp+1 | |
138 movlw d'200' | |
139 addwf C3_temp+0, f | |
140 movlw d'0' | |
141 addwfc C3_temp+1, f ; C3 no longer valid! | |
142 movff C3_temp+0, isr_xA | |
143 movff C3_temp+1, isr_xA+1 | |
144 movff xdT+0, isr_xB | |
145 movff xdT+1, isr_xB+1 | |
146 call isr_mult16x16 | |
147 movff isr_xC+0,isr_divA | |
148 movff isr_xC+1,isr_divA+1 | |
149 movlw d'13' | |
150 movwf isr_divB | |
151 call isr_div16 | |
152 movff isr_divA,SENS+0 | |
153 movff isr_divA+1,SENS+1 | |
154 movff C1+0,isr_divA | |
155 movff C1+1,isr_divA+1 | |
156 movlw d'1' | |
157 movwf isr_divB | |
158 call isr_div16 | |
159 movf isr_divA,W | |
160 addwf SENS+0, f | |
161 movf isr_divA+1,W | |
162 addwfc SENS+1, f | |
163 movlw d'184' | |
164 addwf SENS+0, f | |
165 movlw d'11' | |
166 addwfc SENS+1, f | |
167 | |
168 ; calculate amb_pressure | |
169 movff D1+0,isr_sub_a | |
170 movff D1+1,isr_sub_a+1 | |
171 movff OFF+0,isr_sub_b | |
172 movff OFF+1,isr_sub_b+1 | |
173 call isr_sub16 | |
174 movff isr_sub_c,isr_xA | |
175 movff isr_sub_c+1,isr_xA+1 | |
176 movff SENS+0,isr_xB | |
177 movff SENS+1,isr_xB+1 | |
178 call isr_mult16x16 | |
179 movlw d'12' | |
180 movwf isr_divB | |
181 call isr_div32 | |
182 btfsc neg_flag_isr ; invert isr_xC+0 and isr_xC+1 | |
183 call isr_invert_xC | |
184 movlw LOW d'1000' | |
185 addwf isr_xC+0, f | |
186 movlw HIGH d'1000' | |
187 addwfc isr_xC+1, f | |
188 movff isr_xC+0,amb_pressure+0 | |
189 movff isr_xC+1,amb_pressure+1 | |
190 | |
191 btfss simulatormode_active ; are we in simulator mode? | |
192 bra calc_pressure_done ; no | |
193 | |
194 movff sim_pressure+0,amb_pressure+0 ; override readings with simulator values | |
195 movff sim_pressure+1,amb_pressure+1 | |
196 | |
197 calc_pressure_done: | |
198 | |
199 ; calculate temp | |
200 movff C6+0, C3_temp+0 | |
201 movff C6+1, C3_temp+1 | |
202 movlw d'100' | |
203 addwf C3_temp+0, f | |
204 movlw d'0' | |
205 addwfc C3_temp+1, f | |
206 movff C3_temp+0,isr_xA+0 | |
207 movff C3_temp+1,isr_xA+1 | |
208 movff xdT2+0,isr_xB+0 | |
209 movff xdT2+1,isr_xB+1 | |
210 call isr_mult16x16 | |
211 movlw d'11' | |
212 movwf isr_divB | |
213 call isr_div32 | |
214 bcf neg_temp ; Temperatur positive | |
215 | |
216 btfsc neg_flag_xdT ; was xdT negative? | |
217 bra neg_sub_temp ; yes, 200 - dT*(.... | |
218 ; No, 200 + dT*(.... | |
219 ; movf temperature_correction,W | |
220 ; addlw d'200' | |
221 ; btfsc STATUS,C | |
222 ; incf isr_xC+1,F | |
223 | |
224 movlw d'200' | |
225 addwf isr_xC+0, f | |
226 movlw d'0' | |
227 addwfc isr_xC+1, f | |
228 movff isr_xC+0,temperature+0 | |
229 movff isr_xC+1,temperature+1 | |
230 return ; done | |
231 | |
232 neg_sub_temp: ; 200 - dT*(.... | |
233 ; movf temperature_correction,W | |
234 ; addlw d'200' | |
235 ; btfsc STATUS,C | |
236 ; decf isr_xC+1,F | |
237 | |
238 movlw d'200' | |
239 neg_sub_temp3: | |
240 movwf isr_sub_a+0 | |
241 clrf isr_sub_a+1 | |
242 movff isr_xC+0, isr_sub_b+0 | |
243 movff isr_xC+1, isr_sub_b+1 | |
244 call isr_sub16 ; isr_sub_c = isr_sub_a - isr_sub_b | |
245 btfsc neg_flag_isr ; below zero? | |
246 bsf neg_temp ; temperature negative! | |
247 | |
248 movff isr_sub_c+0,temperature+0 | |
249 movff isr_sub_c+1,temperature+1 | |
250 return ; Fertig mit allem | |
251 | |
252 | |
253 get_pressure_start: | |
254 rcall reset_MS5535A | |
255 movlw b'10100000' ;+3*high as start and 1+low as stop! | |
256 get_pressure_start2: | |
257 movwf isr1_temp | |
258 movlw d'12' | |
259 movwf clock_count | |
260 rcall send_data_MS55535A | |
261 return | |
262 | |
263 get_pressure_value: | |
81
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
264 #ifndef TESTING |
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
265 ; Use register injection instead when in MPLab Sim emulation... |
0 | 266 rcall get_2bytes_MS5535A |
267 movff dMSB,D1+1 | |
268 movff dLSB,D1+0 | |
81
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
269 #endif |
0 | 270 return |
271 | |
272 get_temperature_start: | |
273 rcall reset_MS5535A | |
274 movlw b'10010000' ;+3*high as start and 1+low as stop! | |
275 bra get_pressure_start2 ; continue in "get_pressure" | |
276 | |
277 get_temperature_value: | |
81
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
278 #ifndef TESTING |
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
279 ; Use register injection instead... |
0 | 280 rcall get_2bytes_MS5535A |
281 movff dMSB,D2+1 | |
282 movff dLSB,D2+0 | |
81
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
283 #endif |
0 | 284 return |
285 | |
286 get_calibration_data: | |
4 | 287 ; ; read addional temperature correction from internal EEPROM 0x100 |
288 ; bsf no_sensor_int ; No sensor interupt! | |
289 ; clrf temperature_correction ; clear compensation value | |
290 ; movlw LOW 0x100 | |
291 ; movwf EEADR | |
292 ; movlw HIGH 0x100 | |
293 ; movwf EEADRH | |
294 ; call read_eeprom | |
295 ; clrf EEADRH ; Only 256Bytes used in normal program | |
296 ; movlw d'200' ; limit value | |
297 ; cpfsgt EEDATA ; EEDATA>200? | |
298 ; movff EEDATA, temperature_correction ; No, Store for compensation | |
299 ; | |
0 | 300 rcall reset_MS5535A |
301 movlw d'13' | |
302 movwf clock_count | |
303 movlw b'01010100' ;+3*high as start and 1+low as stop! | |
304 movwf isr1_temp | |
305 rcall send_data_MS55535A | |
306 rcall get_2bytes_MS5535A | |
307 movff dMSB,W1+1 | |
308 movff dLSB,W1+0 | |
309 | |
310 movlw d'13' | |
311 movwf clock_count | |
312 movlw b'01011000' ;+3*high as start and 1+low as stop! | |
313 movwf isr1_temp | |
314 rcall send_data_MS55535A | |
315 rcall get_2bytes_MS5535A | |
316 movff dMSB,W2+1 | |
317 movff dLSB,W2+0 | |
318 | |
319 movlw d'13' | |
320 movwf clock_count | |
321 movlw b'01100100' ;+3*high as start and 1+low as stop! | |
322 movwf isr1_temp | |
323 rcall send_data_MS55535A | |
324 rcall get_2bytes_MS5535A | |
325 movff dMSB,W3+1 | |
326 movff dLSB,W3+0 | |
327 | |
328 movlw d'13' | |
329 movwf clock_count | |
330 movlw b'01101000' ;+3*high as start and 1+low as stop! | |
331 movwf isr1_temp | |
332 rcall send_data_MS55535A | |
333 rcall get_2bytes_MS5535A | |
334 movff dMSB,W4+1 | |
335 movff dLSB,W4+0 | |
336 | |
337 ; calculate C1 (16Bit) | |
338 movff W1+1, C1+1 | |
339 bcf STATUS,C | |
340 rrcf C1+1 | |
341 bcf STATUS,C | |
342 rrcf C1+1 | |
343 bcf STATUS,C | |
344 rrcf C1+1 | |
345 movff W1+0, C1+0 | |
346 bsf STATUS,C | |
347 btfss W1+1,0 | |
348 bcf STATUS,C | |
349 rrcf C1+0 | |
350 bsf STATUS,C | |
351 btfss W1+1,1 | |
352 bcf STATUS,C | |
353 rrcf C1+0 | |
354 bsf STATUS,C | |
355 btfss W1+1,2 | |
356 bcf STATUS,C | |
357 rrcf C1+0 | |
358 | |
359 ; calculate C2 (16Bit) | |
360 movff W2+0, C2+0 | |
361 bsf STATUS,C | |
362 btfss W2+1,0 | |
363 bcf STATUS,C | |
364 rrcf C2+0 | |
365 bsf STATUS,C | |
366 btfss W2+1,1 | |
367 bcf STATUS,C | |
368 rrcf C2+0 | |
369 bsf STATUS,C | |
370 btfss W2+1,2 | |
371 bcf STATUS,C | |
372 rrcf C2+0 | |
373 bsf STATUS,C | |
374 btfss W2+1,3 | |
375 bcf STATUS,C | |
376 rrcf C2+0 | |
377 bsf STATUS,C | |
378 btfss W2+1,4 | |
379 bcf STATUS,C | |
380 rrcf C2+0 | |
381 bsf STATUS,C | |
382 btfss W2+1,5 | |
383 bcf STATUS,C | |
384 rrcf C2+0 | |
385 | |
386 movff W2+1, C2+1 | |
387 bsf STATUS,C | |
388 btfss W1+0,0 | |
389 bcf STATUS,C | |
390 rrcf C2+1 | |
391 bsf STATUS,C | |
392 btfss W1+0,1 | |
393 bcf STATUS,C | |
394 rrcf C2+1 | |
395 bsf STATUS,C | |
396 btfss W1+0,2 | |
397 bcf STATUS,C | |
398 rrcf C2+1 | |
399 bcf STATUS,C | |
400 rrcf C2+1 | |
401 bcf STATUS,C | |
402 rrcf C2+1 | |
403 bcf STATUS,C | |
404 rrcf C2+1 | |
405 | |
406 ; calculate C3 (16Bit) | |
407 movff W3+1,C3+0 | |
408 bsf STATUS,C | |
409 btfss W3+0,7 | |
410 bcf STATUS,C | |
411 rlcf C3+0 | |
412 bsf STATUS,C | |
413 btfss W3+0,6 | |
414 bcf STATUS,C | |
415 rlcf C3+0 | |
416 clrf C3+1 | |
417 btfsc W3+1,7 | |
418 bsf C3+1,1 | |
419 btfsc W3+1,6 | |
420 bsf C3+1,0 | |
421 | |
422 ; calculate C4 (16Bit) | |
423 movff W4+1,C4+0 | |
424 bsf STATUS,C | |
425 btfss W4+0,7 | |
426 bcf STATUS,C | |
427 rlcf C4+0 | |
428 clrf C4+1 | |
429 btfsc W4+1,7 | |
430 bsf C4+1,0 | |
431 | |
432 ; calculate C5 (16Bit) | |
433 movff W3+0,C5+0 | |
434 bcf C5+0,6 | |
435 btfsc W2+0,0 | |
436 bsf C5+0,6 | |
437 bcf C5+0,7 | |
438 btfsc W2+0,1 | |
439 bsf C5+0,7 | |
440 clrf C5+1 | |
441 btfsc W2+0,2 | |
442 bsf C5+1,0 | |
443 btfsc W2+0,3 | |
444 bsf C5+1,1 | |
445 btfsc W2+0,4 | |
446 bsf C5+1,2 | |
447 btfsc W2+0,5 | |
448 bsf C5+1,3 | |
449 | |
450 ; calculate C6 (16Bit) | |
451 clrf C6+1 | |
452 movff W4+0,C6+0 | |
453 bcf C6+0,7 | |
454 | |
455 bcf no_sensor_int ; enable sensor interrupts | |
456 return | |
457 | |
458 reset_MS5535A_one: | |
459 bsf sensor_SDO | |
460 nop | |
461 bsf sensor_CLK | |
462 nop | |
463 nop | |
464 nop | |
465 nop | |
466 nop | |
467 nop | |
468 bcf sensor_CLK | |
469 return | |
470 | |
471 reset_MS5535A_zero: | |
472 bcf sensor_SDO | |
473 nop | |
474 bsf sensor_CLK | |
475 nop | |
476 nop | |
477 nop | |
478 nop | |
479 nop | |
480 nop | |
481 bcf sensor_CLK | |
482 return | |
483 | |
484 reset_MS5535A: | |
485 rcall reset_MS5535A_one ;0 | |
486 rcall reset_MS5535A_zero | |
487 rcall reset_MS5535A_one | |
488 rcall reset_MS5535A_zero | |
489 rcall reset_MS5535A_one | |
490 rcall reset_MS5535A_zero | |
491 rcall reset_MS5535A_one | |
492 rcall reset_MS5535A_zero | |
493 rcall reset_MS5535A_one | |
494 rcall reset_MS5535A_zero | |
495 rcall reset_MS5535A_one | |
496 rcall reset_MS5535A_zero | |
497 rcall reset_MS5535A_one | |
498 rcall reset_MS5535A_zero | |
499 rcall reset_MS5535A_one | |
500 rcall reset_MS5535A_zero ;15 | |
501 rcall reset_MS5535A_zero | |
502 rcall reset_MS5535A_zero | |
503 rcall reset_MS5535A_zero | |
504 rcall reset_MS5535A_zero | |
505 rcall reset_MS5535A_zero ;20 | |
506 return | |
507 | |
508 get_2bytes_MS5535A: | |
509 movlw d'8' | |
510 movwf clock_count | |
511 rcall recieve_loop | |
512 movff isr1_temp,dMSB | |
513 | |
514 movlw d'8' | |
515 movwf clock_count | |
516 rcall recieve_loop | |
517 movff isr1_temp,dLSB | |
518 bsf sensor_CLK | |
519 nop | |
520 nop | |
521 nop | |
522 nop | |
523 nop | |
524 nop | |
525 bcf sensor_CLK | |
526 return | |
527 | |
528 recieve_loop: | |
529 bsf sensor_CLK | |
530 nop | |
531 nop | |
532 nop | |
533 nop | |
534 nop | |
535 nop | |
536 bcf sensor_CLK | |
537 btfss sensor_SDI ;MSB first | |
538 bcf STATUS,C | |
539 btfsc sensor_SDI ;MSB first | |
540 bsf STATUS,C | |
541 rlcf isr1_temp,F | |
542 decfsz clock_count,F | |
543 bra recieve_loop | |
544 return | |
545 | |
546 | |
547 send_data_MS55535A: | |
548 ; send three startbits first | |
549 bcf sensor_CLK | |
550 bsf sensor_SDO | |
551 movlw d'3' | |
552 subwf clock_count,F ; total bit counter | |
553 bsf sensor_CLK | |
554 nop | |
555 nop | |
556 nop | |
557 nop | |
558 nop | |
559 nop | |
560 bcf sensor_CLK | |
561 nop | |
562 nop | |
563 nop | |
564 nop | |
565 nop | |
566 nop | |
567 bsf sensor_CLK | |
568 nop | |
569 nop | |
570 nop | |
571 nop | |
572 nop | |
573 nop | |
574 bcf sensor_CLK | |
575 nop | |
576 nop | |
577 nop | |
578 nop | |
579 nop | |
580 nop | |
581 bsf sensor_CLK | |
582 nop | |
583 nop | |
584 nop | |
585 nop | |
586 nop | |
587 nop | |
588 bcf sensor_CLK | |
589 ; now send 8 bytes from isr_temp1 and fill-up with zeros | |
590 datenbits: | |
591 btfss isr1_temp,7 ;MSB first | |
592 bcf sensor_SDO | |
593 btfsc isr1_temp,7 ;MSB first | |
594 bsf sensor_SDO | |
595 bcf STATUS,C | |
596 rlcf isr1_temp | |
597 | |
598 bsf sensor_CLK | |
599 nop | |
600 nop | |
601 nop | |
602 nop | |
603 nop | |
604 nop | |
605 bcf sensor_CLK | |
606 | |
607 decfsz clock_count,F | |
608 bra datenbits | |
609 return |