Mercurial > public > mk2
annotate code_part1/OSTC_code_asm_part1/ms5535.asm @ 81:31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
| author | JeanDo |
|---|---|
| date | Mon, 06 Dec 2010 18:05:39 +0100 |
| parents | 2b5c52ae3923 |
| children | 3e351e25f5d1 |
| 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 ; | |
|
81
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
300 ifdef TESTING |
|
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
301 ; Get example calibration values (Intersema 5535B datasheet, p12). |
|
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
302 movlw LOW .18556 |
|
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
303 movwf W1+0 |
|
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
304 movlw HIGH .18556 |
|
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
305 movwf W1+1 |
|
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
306 |
|
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
307 movlw LOW .49183 |
|
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
308 movwf W1+0 |
|
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
309 movlw HIGH .49183 |
|
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
310 movwf W1+1 |
|
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
311 |
|
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
312 movlw LOW .22354 |
|
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
313 movwf W1+0 |
|
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
314 movlw HIGH .22354 |
|
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
315 movwf W1+1 |
|
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
316 |
|
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
317 movlw LOW .28083 |
|
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
318 movwf W1+0 |
|
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
319 movlw HIGH .28083 |
|
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
320 movwf W1+1 |
|
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
321 else |
| 0 | 322 rcall reset_MS5535A |
| 323 movlw d'13' | |
| 324 movwf clock_count | |
| 325 movlw b'01010100' ;+3*high as start and 1+low as stop! | |
| 326 movwf isr1_temp | |
| 327 rcall send_data_MS55535A | |
| 328 rcall get_2bytes_MS5535A | |
| 329 movff dMSB,W1+1 | |
| 330 movff dLSB,W1+0 | |
| 331 | |
| 332 movlw d'13' | |
| 333 movwf clock_count | |
| 334 movlw b'01011000' ;+3*high as start and 1+low as stop! | |
| 335 movwf isr1_temp | |
| 336 rcall send_data_MS55535A | |
| 337 rcall get_2bytes_MS5535A | |
| 338 movff dMSB,W2+1 | |
| 339 movff dLSB,W2+0 | |
| 340 | |
| 341 movlw d'13' | |
| 342 movwf clock_count | |
| 343 movlw b'01100100' ;+3*high as start and 1+low as stop! | |
| 344 movwf isr1_temp | |
| 345 rcall send_data_MS55535A | |
| 346 rcall get_2bytes_MS5535A | |
| 347 movff dMSB,W3+1 | |
| 348 movff dLSB,W3+0 | |
| 349 | |
| 350 movlw d'13' | |
| 351 movwf clock_count | |
| 352 movlw b'01101000' ;+3*high as start and 1+low as stop! | |
| 353 movwf isr1_temp | |
| 354 rcall send_data_MS55535A | |
| 355 rcall get_2bytes_MS5535A | |
| 356 movff dMSB,W4+1 | |
| 357 movff dLSB,W4+0 | |
|
81
31fa973a70fd
Kludges to emulate inexisting devices when debugged with the MPLAB software SIMulator.
JeanDo
parents:
4
diff
changeset
|
358 endif |
| 0 | 359 |
| 360 ; calculate C1 (16Bit) | |
| 361 movff W1+1, C1+1 | |
| 362 bcf STATUS,C | |
| 363 rrcf C1+1 | |
| 364 bcf STATUS,C | |
| 365 rrcf C1+1 | |
| 366 bcf STATUS,C | |
| 367 rrcf C1+1 | |
| 368 movff W1+0, C1+0 | |
| 369 bsf STATUS,C | |
| 370 btfss W1+1,0 | |
| 371 bcf STATUS,C | |
| 372 rrcf C1+0 | |
| 373 bsf STATUS,C | |
| 374 btfss W1+1,1 | |
| 375 bcf STATUS,C | |
| 376 rrcf C1+0 | |
| 377 bsf STATUS,C | |
| 378 btfss W1+1,2 | |
| 379 bcf STATUS,C | |
| 380 rrcf C1+0 | |
| 381 | |
| 382 ; calculate C2 (16Bit) | |
| 383 movff W2+0, C2+0 | |
| 384 bsf STATUS,C | |
| 385 btfss W2+1,0 | |
| 386 bcf STATUS,C | |
| 387 rrcf C2+0 | |
| 388 bsf STATUS,C | |
| 389 btfss W2+1,1 | |
| 390 bcf STATUS,C | |
| 391 rrcf C2+0 | |
| 392 bsf STATUS,C | |
| 393 btfss W2+1,2 | |
| 394 bcf STATUS,C | |
| 395 rrcf C2+0 | |
| 396 bsf STATUS,C | |
| 397 btfss W2+1,3 | |
| 398 bcf STATUS,C | |
| 399 rrcf C2+0 | |
| 400 bsf STATUS,C | |
| 401 btfss W2+1,4 | |
| 402 bcf STATUS,C | |
| 403 rrcf C2+0 | |
| 404 bsf STATUS,C | |
| 405 btfss W2+1,5 | |
| 406 bcf STATUS,C | |
| 407 rrcf C2+0 | |
| 408 | |
| 409 movff W2+1, C2+1 | |
| 410 bsf STATUS,C | |
| 411 btfss W1+0,0 | |
| 412 bcf STATUS,C | |
| 413 rrcf C2+1 | |
| 414 bsf STATUS,C | |
| 415 btfss W1+0,1 | |
| 416 bcf STATUS,C | |
| 417 rrcf C2+1 | |
| 418 bsf STATUS,C | |
| 419 btfss W1+0,2 | |
| 420 bcf STATUS,C | |
| 421 rrcf C2+1 | |
| 422 bcf STATUS,C | |
| 423 rrcf C2+1 | |
| 424 bcf STATUS,C | |
| 425 rrcf C2+1 | |
| 426 bcf STATUS,C | |
| 427 rrcf C2+1 | |
| 428 | |
| 429 ; calculate C3 (16Bit) | |
| 430 movff W3+1,C3+0 | |
| 431 bsf STATUS,C | |
| 432 btfss W3+0,7 | |
| 433 bcf STATUS,C | |
| 434 rlcf C3+0 | |
| 435 bsf STATUS,C | |
| 436 btfss W3+0,6 | |
| 437 bcf STATUS,C | |
| 438 rlcf C3+0 | |
| 439 clrf C3+1 | |
| 440 btfsc W3+1,7 | |
| 441 bsf C3+1,1 | |
| 442 btfsc W3+1,6 | |
| 443 bsf C3+1,0 | |
| 444 | |
| 445 ; calculate C4 (16Bit) | |
| 446 movff W4+1,C4+0 | |
| 447 bsf STATUS,C | |
| 448 btfss W4+0,7 | |
| 449 bcf STATUS,C | |
| 450 rlcf C4+0 | |
| 451 clrf C4+1 | |
| 452 btfsc W4+1,7 | |
| 453 bsf C4+1,0 | |
| 454 | |
| 455 ; calculate C5 (16Bit) | |
| 456 movff W3+0,C5+0 | |
| 457 bcf C5+0,6 | |
| 458 btfsc W2+0,0 | |
| 459 bsf C5+0,6 | |
| 460 bcf C5+0,7 | |
| 461 btfsc W2+0,1 | |
| 462 bsf C5+0,7 | |
| 463 clrf C5+1 | |
| 464 btfsc W2+0,2 | |
| 465 bsf C5+1,0 | |
| 466 btfsc W2+0,3 | |
| 467 bsf C5+1,1 | |
| 468 btfsc W2+0,4 | |
| 469 bsf C5+1,2 | |
| 470 btfsc W2+0,5 | |
| 471 bsf C5+1,3 | |
| 472 | |
| 473 ; calculate C6 (16Bit) | |
| 474 clrf C6+1 | |
| 475 movff W4+0,C6+0 | |
| 476 bcf C6+0,7 | |
| 477 | |
| 478 bcf no_sensor_int ; enable sensor interrupts | |
| 479 return | |
| 480 | |
| 481 reset_MS5535A_one: | |
| 482 bsf sensor_SDO | |
| 483 nop | |
| 484 bsf sensor_CLK | |
| 485 nop | |
| 486 nop | |
| 487 nop | |
| 488 nop | |
| 489 nop | |
| 490 nop | |
| 491 bcf sensor_CLK | |
| 492 return | |
| 493 | |
| 494 reset_MS5535A_zero: | |
| 495 bcf sensor_SDO | |
| 496 nop | |
| 497 bsf sensor_CLK | |
| 498 nop | |
| 499 nop | |
| 500 nop | |
| 501 nop | |
| 502 nop | |
| 503 nop | |
| 504 bcf sensor_CLK | |
| 505 return | |
| 506 | |
| 507 reset_MS5535A: | |
| 508 rcall reset_MS5535A_one ;0 | |
| 509 rcall reset_MS5535A_zero | |
| 510 rcall reset_MS5535A_one | |
| 511 rcall reset_MS5535A_zero | |
| 512 rcall reset_MS5535A_one | |
| 513 rcall reset_MS5535A_zero | |
| 514 rcall reset_MS5535A_one | |
| 515 rcall reset_MS5535A_zero | |
| 516 rcall reset_MS5535A_one | |
| 517 rcall reset_MS5535A_zero | |
| 518 rcall reset_MS5535A_one | |
| 519 rcall reset_MS5535A_zero | |
| 520 rcall reset_MS5535A_one | |
| 521 rcall reset_MS5535A_zero | |
| 522 rcall reset_MS5535A_one | |
| 523 rcall reset_MS5535A_zero ;15 | |
| 524 rcall reset_MS5535A_zero | |
| 525 rcall reset_MS5535A_zero | |
| 526 rcall reset_MS5535A_zero | |
| 527 rcall reset_MS5535A_zero | |
| 528 rcall reset_MS5535A_zero ;20 | |
| 529 return | |
| 530 | |
| 531 get_2bytes_MS5535A: | |
| 532 movlw d'8' | |
| 533 movwf clock_count | |
| 534 rcall recieve_loop | |
| 535 movff isr1_temp,dMSB | |
| 536 | |
| 537 movlw d'8' | |
| 538 movwf clock_count | |
| 539 rcall recieve_loop | |
| 540 movff isr1_temp,dLSB | |
| 541 bsf sensor_CLK | |
| 542 nop | |
| 543 nop | |
| 544 nop | |
| 545 nop | |
| 546 nop | |
| 547 nop | |
| 548 bcf sensor_CLK | |
| 549 return | |
| 550 | |
| 551 recieve_loop: | |
| 552 bsf sensor_CLK | |
| 553 nop | |
| 554 nop | |
| 555 nop | |
| 556 nop | |
| 557 nop | |
| 558 nop | |
| 559 bcf sensor_CLK | |
| 560 btfss sensor_SDI ;MSB first | |
| 561 bcf STATUS,C | |
| 562 btfsc sensor_SDI ;MSB first | |
| 563 bsf STATUS,C | |
| 564 rlcf isr1_temp,F | |
| 565 decfsz clock_count,F | |
| 566 bra recieve_loop | |
| 567 return | |
| 568 | |
| 569 | |
| 570 send_data_MS55535A: | |
| 571 ; send three startbits first | |
| 572 bcf sensor_CLK | |
| 573 bsf sensor_SDO | |
| 574 movlw d'3' | |
| 575 subwf clock_count,F ; total bit counter | |
| 576 bsf sensor_CLK | |
| 577 nop | |
| 578 nop | |
| 579 nop | |
| 580 nop | |
| 581 nop | |
| 582 nop | |
| 583 bcf sensor_CLK | |
| 584 nop | |
| 585 nop | |
| 586 nop | |
| 587 nop | |
| 588 nop | |
| 589 nop | |
| 590 bsf sensor_CLK | |
| 591 nop | |
| 592 nop | |
| 593 nop | |
| 594 nop | |
| 595 nop | |
| 596 nop | |
| 597 bcf sensor_CLK | |
| 598 nop | |
| 599 nop | |
| 600 nop | |
| 601 nop | |
| 602 nop | |
| 603 nop | |
| 604 bsf sensor_CLK | |
| 605 nop | |
| 606 nop | |
| 607 nop | |
| 608 nop | |
| 609 nop | |
| 610 nop | |
| 611 bcf sensor_CLK | |
| 612 ; now send 8 bytes from isr_temp1 and fill-up with zeros | |
| 613 datenbits: | |
| 614 btfss isr1_temp,7 ;MSB first | |
| 615 bcf sensor_SDO | |
| 616 btfsc isr1_temp,7 ;MSB first | |
| 617 bsf sensor_SDO | |
| 618 bcf STATUS,C | |
| 619 rlcf isr1_temp | |
| 620 | |
| 621 bsf sensor_CLK | |
| 622 nop | |
| 623 nop | |
| 624 nop | |
| 625 nop | |
| 626 nop | |
| 627 nop | |
| 628 bcf sensor_CLK | |
| 629 | |
| 630 decfsz clock_count,F | |
| 631 bra datenbits | |
| 632 return |