Mercurial > public > hwos_code
annotate src/ms5541.asm @ 611:cd7991986ace
undo BOR bit
| author | heinrichsweikamp |
|---|---|
| date | Wed, 09 Jan 2019 21:28:53 +0100 |
| 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 |