Mercurial > public > hwos_code
annotate src/i2c.asm @ 627:bf5fee575701
minor cleanup, reset rx circuity
| author | heinrichsweikamp |
|---|---|
| date | Sun, 30 Jun 2019 23:22:32 +0200 |
| parents | 7bdcc591196c |
| children | cd58f7fc86db |
| rev | line source |
|---|---|
| 0 | 1 ;============================================================================= |
| 2 ; | |
| 623 | 3 ; File i2c.asm combined next generation V3.03.2 |
| 0 | 4 ; |
| 560 | 5 ; I2C Interface |
| 6 ; | |
| 0 | 7 ; Copyright (c) 2012, JD Gascuel, HeinrichsWeikamp, all right reserved. |
| 8 ;============================================================================= | |
| 582 | 9 ; |
| 10 ; Compass0 | |
| 11 ; -------- | |
| 12 ; HMC5883L's read address (8-Bit): 0x3D | |
| 13 ; HMC5883L's write address (8-Bit): 0x3C | |
| 14 ; MMA8452Q's read address (8-Bit): 0x39 | |
| 15 ; MMA8452Q's write address (8-Bit): 0x38 | |
| 16 ; | |
| 17 ; Compass1 | |
| 18 ; -------- | |
| 19 ; LSM303D's read address (8-Bit): 0x3D | |
| 20 ; LSM303D's write address (8-Bit): 0x3C | |
| 21 ; | |
| 22 ; Compass2 | |
| 23 ; -------- | |
| 24 ; LSM303AGR's Compass read address (8-Bit): 0x3D | |
| 25 ; LSM303AGR's Compass write address (8-Bit): 0x3C | |
| 26 ; LSM303AGR's Acceleration read address (8-Bit): 0x33 | |
| 27 ; LSM303AGR's Acceleration write address (8-Bit): 0x32 | |
| 624 | 28 ; |
| 29 ; Compass3 | |
| 30 ; -------- | |
| 31 ; LSM303C's Compass read address (8-Bit): 0x3D | |
| 32 ; LSM303C's Compass write address (8-Bit): 0x3C | |
| 33 ; LSM303C's Acceleration read address (8-Bit): 0x3B | |
| 34 ; LSM303C's Acceleration write address (8-Bit): 0x3A | |
| 582 | 35 ; |
| 36 ; RX Circuity | |
| 37 ; ----------- | |
| 38 ; RX Circuity read address (8-Bit): 0x51 | |
| 39 ; RX Circuity write address (8-Bit): 0x50 | |
| 40 ; | |
| 41 ; | |
| 42 | |
| 0 | 43 ; HISTORY |
| 44 ; 2012-08-22 : [mH] Creation | |
| 565 | 45 ; 2018-02-18 : [mH] Sync with hwOS Sport release |
| 0 | 46 |
| 47 | |
| 582 | 48 #include "hwos.inc" ; Mandatory header |
| 0 | 49 #include "wait.inc" |
| 113 | 50 #include "math.inc" |
| 560 | 51 #include "external_flash.inc" |
| 113 | 52 |
| 582 | 53 |
| 623 | 54 i2c CODE |
| 582 | 55 |
| 56 ;============================================================================= | |
| 0 | 57 |
| 58 I2C_TX: | |
| 582 | 59 movwf SSP1BUF |
| 60 rcall WaitMSSP | |
| 604 | 61 bra I2C_WaitforACK ; returns... |
| 0 | 62 |
| 604 | 63 I2C_TwoBytesRX_div16: ; get two bytes and divide lo:hi/16 (signed) |
| 64 rcall I2C_OneByteRX ; get one byte | |
| 65 movff SSP1BUF,hi ; data byte | |
| 66 rcall I2C_OneByteRX ; get one byte | |
| 67 movff SSP1BUF,lo ; data byte | |
| 582 | 68 I2C_TwoBytesRX_div16_2: ; divide lo:hi/16 (signed) only |
| 69 bcf STATUS,C | |
| 604 | 70 btfsc hi,7 ; copy sign bit to carry |
| 582 | 71 bsf STATUS,C |
| 72 rrcf hi ; /2 | |
| 73 rrcf lo | |
| 74 I2C_TwoBytesRX_div8_2: ; divide lo:hi/8 (signed) only | |
| 75 bcf STATUS,C | |
| 604 | 76 btfsc hi,7 ; copy sign bit to carry |
| 582 | 77 bsf STATUS,C |
| 78 rrcf hi ; /4 | |
| 79 rrcf lo | |
| 80 bcf STATUS,C | |
| 604 | 81 btfsc hi,7 ; copy sign bit to carry |
| 582 | 82 bsf STATUS,C |
| 83 rrcf hi ; /8 | |
| 84 rrcf lo | |
| 85 bcf STATUS,C | |
| 604 | 86 btfsc hi,7 ; copy sign bit to carry |
| 582 | 87 bsf STATUS,C |
| 88 rrcf hi ; /16 | |
| 89 rrcf lo | |
| 90 return | |
| 0 | 91 |
| 582 | 92 global I2C_RX_accelerometer |
| 0 | 93 I2C_RX_accelerometer: |
| 624 | 94 btfsc compass_type3 ; compass3 |
| 95 bra I2C_RX_accelerometer_compass3 ; yes | |
| 604 | 96 btfsc compass_type2 ; compass2 ? |
| 97 bra I2C_RX_accelerometer_compass2 ; YES | |
| 98 btfsc compass_type ; compass1 ? | |
| 99 bra I2C_RX_accelerometer_compass1 ; YES | |
| 560 | 100 I2C_RX_accelerometer_compass0: |
| 604 | 101 bsf SSP1CON2,SEN ; start condition |
| 582 | 102 rcall WaitMSSP |
| 103 movlw 0x38 ; address | |
| 104 rcall I2C_TX | |
| 105 movlw 0x00 | |
| 106 rcall I2C_TX | |
| 604 | 107 bsf SSP1CON2,RSEN ; repeated start condition |
| 582 | 108 rcall WaitMSSP |
| 109 movlw 0x39 ; address | |
| 110 rcall I2C_TX | |
| 0 | 111 |
| 604 | 112 rcall I2C_OneByteRX ; get status byte |
| 582 | 113 movf SSP1BUF,W |
| 158 | 114 |
| 582 | 115 ; Non-flipped screen: |
| 116 ; Chip orientation on the PCB requires | |
| 604 | 117 ; Original = corrected |
| 582 | 118 ; x = -x |
| 119 ; y = -y | |
| 120 ; z = -z | |
| 0 | 121 |
| 582 | 122 ; Flipped screen: |
| 123 ; Chip orientation on the PCB requires | |
| 604 | 124 ; Original = corrected |
| 582 | 125 ; x = x |
| 126 ; y = y | |
| 127 ; z = -z | |
|
166
30ebaf72170d
BUGFIX: Flip compass with flipped screen, too
heinrichsweikamp
parents:
158
diff
changeset
|
128 |
| 604 | 129 rcall I2C_TwoBytesRX_div16 ; get two bytes and divide /16 (signed) |
| 623 | 130 btfsc flip_screen ; 180° rotation? |
| 604 | 131 bra I2C_RX_accelerometer2 ; YES |
| 132 comf hi ; 16 bit sign change | |
| 582 | 133 negf lo |
| 623 | 134 btfsc STATUS,C ; carry to propagate? |
| 604 | 135 incf hi,F ; YES - do it |
|
166
30ebaf72170d
BUGFIX: Flip compass with flipped screen, too
heinrichsweikamp
parents:
158
diff
changeset
|
136 I2C_RX_accelerometer2: |
| 623 | 137 MOVII mpr,accel_DX ; copy result |
| 138 rcall I2C_TwoBytesRX_div16 ; get two bytes and divide /16 (signed) | |
| 139 btfsc flip_screen ; 180° rotation? | |
| 140 bra I2C_RX_accelerometer3 ; YES | |
| 141 comf hi ; 16 bit sign change | |
| 582 | 142 negf lo |
| 623 | 143 btfsc STATUS,C ; carry to propagate? |
| 144 incf hi,F ; YES - do it | |
|
166
30ebaf72170d
BUGFIX: Flip compass with flipped screen, too
heinrichsweikamp
parents:
158
diff
changeset
|
145 I2C_RX_accelerometer3: |
| 623 | 146 MOVII mpr,accel_DY ; copy result |
| 147 rcall I2C_OneByteRX ; get one byte | |
| 148 movff SSP1BUF,hi ; data byte | |
| 582 | 149 bsf SSP1CON2, RCEN ; Enable receive mode |
| 150 rcall WaitMSSP | |
| 623 | 151 ; According to data sheet there should be no master Acknowledge for the last byte (accel_DZ+0)... |
| 152 movff SSP1BUF,lo ; data byte | |
| 0 | 153 |
| 582 | 154 rcall I2C_TwoBytesRX_div16_2 ; divide lo:hi/16 (signed) only |
| 623 | 155 comf hi ; 16 bit sign change |
| 582 | 156 negf lo |
| 623 | 157 btfsc STATUS,C ; carry to propagate? |
| 158 incf hi,F ; YES - do it | |
| 159 MOVII mpr,accel_DZ ; copy result | |
| 160 bsf SSP1CON2,PEN ; stop condition | |
| 161 bra WaitMSSP ; ... and return | |
| 0 | 162 |
| 427 | 163 I2C_RX_accelerometer_compass1: |
| 623 | 164 bsf SSP1CON2,SEN ; start condition |
| 582 | 165 rcall WaitMSSP |
| 166 movlw 0x3C ; address | |
| 167 rcall I2C_TX | |
| 168 movlw b'10101000' ; 0x28 with auto-increment (MSB=1) | |
| 169 rcall I2C_TX | |
| 623 | 170 bsf SSP1CON2,RSEN ; repeated start condition (!) |
| 582 | 171 rcall WaitMSSP |
| 172 movlw 0x3D ; address | |
| 624 | 173 I2C_RX_accelerometer_compass1_xx: ; compass2 and 3 continue here... |
| 582 | 174 rcall I2C_TX |
| 175 | |
| 176 ; Non-flipped screen: | |
| 177 ; Chip orientation on the PCB requires | |
| 178 ; Original = Corrected | |
| 179 ; x = -x (Compass 1) | |
| 180 ; x = x (Compass 2) | |
| 181 ; y = -y | |
| 182 ; z = -z | |
| 183 | |
| 184 ; Flipped screen: | |
| 185 ; Chip orientation on the PCB requires | |
| 186 ; Original = Corrected | |
| 187 ; x = x (Compass 1) | |
| 188 ; x = -x (Compass 2) | |
| 189 ; y = y | |
| 190 ; z = -z | |
| 427 | 191 |
| 582 | 192 ; Dump the accelerator data |
| 193 rcall I2C_OneByteRX | |
| 194 movff SSP1BUF,lo ; accel_DX+0 | |
| 195 rcall I2C_OneByteRX | |
| 623 | 196 movff SSP1BUF,hi ; accel_DX+1 |
| 582 | 197 rcall I2C_TwoBytesRX_div16_2 ; divide lo:hi/16 (signed) only |
| 198 btfss compass_type2 ; compass 2? | |
| 623 | 199 bra I2C_RX_accelerometer1_c1 ; NO - compass 1 |
| 582 | 200 ; compass 2 |
| 623 | 201 btfss flip_screen ; 180° rotation? |
| 202 bra I2C_RX_accelerometer2_c1 ; NO - continue with normal compass1 routines for Y and Z | |
| 582 | 203 ; flipped compass 2, negate x |
| 623 | 204 comf hi ; 16 bit sign change |
| 582 | 205 negf lo |
| 623 | 206 btfsc STATUS,C ; carry to propagate? |
| 207 incf hi,F ; YES - do it | |
| 582 | 208 bra I2C_RX_accelerometer2_c1 ; continue with normal compass1 routines for Y and Z |
| 209 | |
| 210 I2C_RX_accelerometer1_c1: | |
| 623 | 211 btfsc flip_screen ; 180° rotation? |
| 212 bra I2C_RX_accelerometer2_c1 ; YES | |
| 582 | 213 ; non-flipped compass 1, negate x |
| 623 | 214 comf hi ; 16 bit sign change |
| 582 | 215 negf lo |
| 623 | 216 btfsc STATUS,C ; carry to propagate? |
| 217 incf hi,F ; YES - do it | |
| 427 | 218 I2C_RX_accelerometer2_c1: |
| 582 | 219 ; flipped compass 1, non-flipped compass 2 |
| 623 | 220 MOVII mpr,accel_DX ; copy result |
| 582 | 221 rcall I2C_OneByteRX |
| 222 movff SSP1BUF,lo ; accel_DY+0 | |
| 223 rcall I2C_OneByteRX | |
| 224 movff SSP1BUF,hi ; accel_DY+1 | |
| 225 | |
| 226 rcall I2C_TwoBytesRX_div16_2 ; divide lo:hi/16 (signed) only | |
| 623 | 227 btfsc flip_screen ; 180° rotation? |
| 228 bra I2C_RX_accelerometer3_c1 ; YES | |
| 229 comf hi ; 16 bit sign change | |
| 582 | 230 negf lo |
| 623 | 231 btfsc STATUS,C ; carry to propagate? |
| 232 incf hi,F ; YES - do it | |
| 427 | 233 I2C_RX_accelerometer3_c1: |
| 623 | 234 MOVII mpr,accel_DY ; copy result |
| 582 | 235 rcall I2C_OneByteRX |
| 623 | 236 movff SSP1BUF,lo ; accel_DZ+0 |
| 582 | 237 bsf SSP1CON2, RCEN ; Enable receive mode |
| 238 rcall WaitMSSP | |
| 623 | 239 ; According to data sheet there should be no master Acknowledge for the last byte (accel_DZ+1)... |
| 240 movff SSP1BUF,hi ; accel_DZ+1 | |
| 241 bsf SSP1CON2,PEN ; stop condition | |
| 582 | 242 rcall WaitMSSP |
| 243 rcall I2C_TwoBytesRX_div16_2 ; divide lo:hi/16 (signed) only | |
| 623 | 244 comf hi ; 16 bit sign change for Z |
| 582 | 245 negf lo |
| 623 | 246 btfsc STATUS,C ; carry to propagate? |
| 247 incf hi,F ; YES - do it | |
| 248 MOVII mpr,accel_DZ ; copy result | |
| 582 | 249 return |
| 250 | |
| 560 | 251 I2C_RX_accelerometer_compass2: |
| 623 | 252 bsf SSP1CON2,SEN ; start condition |
| 582 | 253 rcall WaitMSSP |
| 254 movlw 0x32 ; address | |
| 255 rcall I2C_TX | |
| 256 movlw b'10101000' ; 0x28 with auto-increment (MSB=1) | |
| 257 rcall I2C_TX | |
| 623 | 258 bsf SSP1CON2,RSEN ; repeated start condition (!) |
| 582 | 259 rcall WaitMSSP |
| 260 movlw 0x33 ; address | |
| 624 | 261 bra I2C_RX_accelerometer_compass1_xx |
| 262 | |
| 263 I2C_RX_accelerometer_compass3: | |
| 264 bsf SSP1CON2,SEN ; Start condition | |
| 265 rcall WaitMSSP | |
| 266 movlw 0x3A ; address | |
| 267 rcall I2C_TX | |
| 268 movlw 0x28 ; 0x28 (OUT_X_L_A) | |
| 269 rcall I2C_TX | |
| 270 bsf SSP1CON2,RSEN ; Repeated start condition (!) | |
| 271 rcall WaitMSSP | |
| 272 movlw 0x3B ; address | |
| 273 bra I2C_RX_accelerometer_compass1_xx | |
| 582 | 274 |
| 0 | 275 I2C_OneByteRX: |
| 623 | 276 bsf SSP1CON2,RCEN ; enable receive mode |
| 582 | 277 rcall WaitMSSP |
| 623 | 278 bsf SSP1CON2,ACKEN ; master acknowledge |
| 279 bra WaitMSSP ; ... and return | |
| 280 | |
| 281 | |
| 282 ;----------------------------------------------------------------------------- | |
| 283 IFDEF _compass | |
| 0 | 284 |
| 582 | 285 global I2C_RX_compass |
| 0 | 286 I2C_RX_compass: |
| 624 | 287 btfsc compass_type3 ; compass3 |
| 288 bra I2C_RX_compass3 ; YES | |
| 623 | 289 btfsc compass_type2 ; compass2 ? |
| 290 bra I2C_RX_compass2 ; YES | |
| 291 btfsc compass_type ; compass1 ? | |
| 292 bra I2C_RX_compass1 ; YES | |
| 560 | 293 I2C_RX_compass0: |
| 623 | 294 bsf SSP1CON2,SEN ; start condition |
| 582 | 295 rcall WaitMSSP |
| 296 movlw 0x3C ; address | |
| 297 rcall I2C_TX | |
| 298 movlw 0x03 | |
| 299 rcall I2C_TX | |
| 623 | 300 bsf SSP1CON2,PEN ; stop condition |
| 582 | 301 rcall WaitMSSP |
| 0 | 302 |
| 582 | 303 bcf PIR1,SSP1IF |
| 623 | 304 bsf SSP1CON2,SEN ; start condition |
| 582 | 305 rcall WaitMSSP |
| 306 movlw 0x3D ; address | |
| 307 rcall I2C_TX | |
| 0 | 308 |
| 582 | 309 ; Compass IC sends data in following order: |
| 310 ; x MSB | |
| 311 ; x LSB | |
| 312 ; z MSB | |
| 313 ; z LSB | |
| 314 ; y MSB | |
| 315 ; y LSB | |
| 0 | 316 |
| 582 | 317 ; Non-flipped screen |
| 318 ; Chip orientation on the PCB requires | |
| 319 ; Original = Corrected | |
| 320 ; x = -y | |
| 321 ; z = z | |
| 322 ; y = x | |
| 0 | 323 |
| 582 | 324 ; Flipped screen |
| 325 ; Chip orientation on the PCB requires | |
| 326 ; Original = Corrected | |
| 327 ; x = y | |
| 328 ; z = z | |
| 329 ; y = -x | |
|
166
30ebaf72170d
BUGFIX: Flip compass with flipped screen, too
heinrichsweikamp
parents:
158
diff
changeset
|
330 |
| 623 | 331 rcall I2C_OneByteRX ; get one byte |
| 332 movff SSP1BUF,compass_DY+1 ; data byte | |
| 333 rcall I2C_OneByteRX ; get one byte | |
| 334 movff SSP1BUF,compass_DY+0 ; data byte | |
| 335 btfsc flip_screen ; 180° rotation? | |
| 336 bra I2C_RX_compass0_2 ; NO | |
| 337 banksel compass_DY ; YES - flip Y | |
| 338 comf compass_DY+1 ; - 16 bit sign change | |
| 582 | 339 negf compass_DY+0 |
| 623 | 340 btfsc STATUS,C ; - carry to propagate? |
| 341 incf compass_DY+1,F ; YES - do it | |
| 582 | 342 banksel common |
| 623 | 343 I2C_RX_compass0_2: |
| 344 rcall I2C_OneByteRX ; get one byte | |
| 345 movff SSP1BUF,compass_DZ+1 ; data byte | |
| 346 rcall I2C_OneByteRX ; get one byte | |
| 347 movff SSP1BUF,compass_DZ+0 ; data byte | |
| 348 rcall I2C_OneByteRX ; get one byte | |
| 349 movff SSP1BUF,compass_DX+1 ; data byte | |
| 582 | 350 bsf SSP1CON2, RCEN ; Enable receive mode |
| 351 rcall WaitMSSP | |
| 623 | 352 movff SSP1BUF,compass_DX+0 ; data byte |
| 353 bsf SSP1CON2,PEN ; stop condition | |
| 582 | 354 rcall WaitMSSP |
| 623 | 355 btfss flip_screen ; 180° rotation? |
| 356 return ; NO - done | |
| 357 banksel compass_DX ; YES - flip X | |
| 358 comf compass_DX+1 ; - 16 bit sign change | |
| 582 | 359 negf compass_DX+0 |
| 623 | 360 btfsc STATUS,C ; - carry to propagate? |
| 361 incf compass_DX+1,F ; YES - do it | |
| 582 | 362 banksel common |
| 363 return | |
| 364 | |
| 623 | 365 I2C_RX_compass1: ; new compass |
| 366 bsf SSP1CON2,SEN ; start condition | |
| 582 | 367 rcall WaitMSSP |
| 368 movlw 0x3C ; address | |
| 369 rcall I2C_TX | |
| 370 movlw b'10001000' ; 0x08 with auto-increment (MSB=1) | |
| 371 rcall I2C_TX | |
| 623 | 372 bsf SSP1CON2,RSEN ; repeated start condition (!) |
| 582 | 373 rcall WaitMSSP |
| 374 movlw 0x3D ; address | |
| 375 rcall I2C_TX | |
| 623 | 376 ;rcall WaitMSSP ; TODO needed? (mH) |
| 377 rcall I2C_OneByteRX ; get one byte | |
| 378 movff SSP1BUF,lo ; data byte | |
| 379 rcall I2C_OneByteRX ; get one byte | |
| 380 movff SSP1BUF,hi ; data byte | |
| 582 | 381 rcall I2C_TwoBytesRX_div8_2 |
| 623 | 382 MOVII mpr,compass_DX |
| 383 btfss flip_screen ; 180° rotation? | |
| 384 bra I2C_RX_compass1_1 ; NO | |
| 385 banksel compass_DX ; YES - flip X | |
| 386 comf compass_DX+1 ; - 16 bit sign change | |
| 582 | 387 negf compass_DX+0 |
| 623 | 388 btfsc STATUS,C ; - carry to propagate? |
| 389 incf compass_DX+1,F ; YES - do it | |
| 582 | 390 banksel common |
| 427 | 391 I2C_RX_compass1_1: |
| 623 | 392 rcall I2C_OneByteRX ; get one byte |
| 393 movff SSP1BUF,lo ; data byte | |
| 394 rcall I2C_OneByteRX ; get one byte | |
| 395 movff SSP1BUF,hi ; data byte | |
| 582 | 396 rcall I2C_TwoBytesRX_div8_2 |
| 623 | 397 MOVII mpr,compass_DY |
| 398 btfss flip_screen ; 180° rotation? | |
| 399 bra I2C_RX_compass1_2 ; NO | |
| 400 banksel compass_DY ; YES - flip Y | |
| 401 comf compass_DY+1 ; - 16 bit sign change | |
| 582 | 402 negf compass_DY+0 |
| 623 | 403 btfsc STATUS,C ; - carry to propagate? |
| 404 incf compass_DY+1,F ; YES - do it | |
| 405 banksel common | |
| 427 | 406 I2C_RX_compass1_2: |
| 623 | 407 rcall I2C_OneByteRX ; get one byte |
| 408 movff SSP1BUF,lo ; data byte | |
| 582 | 409 bsf SSP1CON2, RCEN ; Enable receive mode |
| 410 rcall WaitMSSP | |
| 623 | 411 movff SSP1BUF,hi ; data byte |
| 582 | 412 rcall I2C_TwoBytesRX_div8_2 |
| 623 | 413 MOVII mpr,compass_DZ |
| 414 bsf SSP1CON2,PEN ; stop condition | |
| 415 bra WaitMSSP ; ... and return | |
| 560 | 416 |
| 582 | 417 I2C_RX_compass2: ; newest compass |
| 623 | 418 bsf SSP1CON2,SEN ; start condition |
| 582 | 419 rcall WaitMSSP |
| 420 movlw 0x3C ; address | |
| 421 rcall I2C_TX | |
| 422 movlw 0xE8 ; 0x68 with auto-increment (MSB=1) | |
| 423 rcall I2C_TX | |
| 623 | 424 bsf SSP1CON2,RSEN ; repeated start condition (!) |
| 582 | 425 rcall WaitMSSP |
| 426 movlw 0x3D ; address | |
| 427 rcall I2C_TX | |
| 624 | 428 I2C_RX_compass2_xx: ; compass 3 enters here |
| 582 | 429 ; rcall WaitMSSP |
| 623 | 430 rcall I2C_OneByteRX ; get one byte |
| 431 movff SSP1BUF,lo ; data byte | |
| 432 rcall I2C_OneByteRX ; get one byte | |
| 433 movff SSP1BUF,hi ; data byte | |
| 582 | 434 ; rcall I2C_TwoBytesRX_div8_2 |
| 623 | 435 btfsc flip_screen ; 180° rotation? |
| 436 bra I2C_RX_compass2_1 ; YES - do nothing with X | |
| 437 ; NO - flip X | |
| 438 comf hi ; - 16 bit sign change | |
| 582 | 439 negf lo |
| 623 | 440 btfsc STATUS,C ; - carry to propagate? |
| 441 incf hi,F ; YES - do it | |
| 582 | 442 I2C_RX_compass2_1: |
| 623 | 443 MOVII mpr,compass_DX |
| 444 rcall I2C_OneByteRX ; get one byte | |
| 445 movff SSP1BUF,lo ; data byte | |
| 446 rcall I2C_OneByteRX ; get one byte | |
| 447 movff SSP1BUF,hi ; data byte | |
| 582 | 448 ; rcall I2C_TwoBytesRX_div8_2 |
| 623 | 449 btfss flip_screen ; 180° rotation? |
| 450 bra I2C_RX_compass2_2 ; NO - do nothing with Y | |
| 451 ; YES - flip Y | |
| 452 comf hi ; - 16 bit sign change | |
| 582 | 453 negf lo |
| 623 | 454 btfsc STATUS,C ; - carry to propagate? |
| 455 incf hi,F ; YES - do it | |
| 456 I2C_RX_compass2_2: | |
| 457 MOVII mpr,compass_DY | |
| 458 rcall I2C_OneByteRX ; get one byte | |
| 459 movff SSP1BUF,lo ; data byte | |
| 460 rcall I2C_OneByteRX ; get one byte | |
| 461 movff SSP1BUF,hi ; data byte | |
| 582 | 462 ; rcall I2C_TwoBytesRX_div8_2 |
| 623 | 463 MOVII mpr,compass_DZ |
| 464 bsf SSP1CON2,PEN ; stop condition | |
| 582 | 465 bra WaitMSSP ;(And return) |
| 466 | |
| 624 | 467 I2C_RX_compass3: |
| 468 bsf SSP1CON2,SEN ; Start condition | |
| 469 rcall WaitMSSP | |
| 470 movlw 0x3C ; address | |
| 471 rcall I2C_TX | |
| 472 movlw 0xA8 ; 0x28 with auto-increment (MSB=1) | |
| 473 rcall I2C_TX | |
| 474 bsf SSP1CON2,RSEN ; Repeated start condition (!) | |
| 475 rcall WaitMSSP | |
| 476 movlw 0x3D ; address | |
| 477 rcall I2C_TX | |
| 478 bra I2C_RX_compass2_xx | |
| 479 | |
| 623 | 480 ENDIF ; _compass |
| 481 | |
| 482 ;----------------------------------------------------------------------------- | |
| 582 | 483 |
| 484 global I2C_init_compass | |
| 0 | 485 I2C_init_compass: |
| 582 | 486 bsf compass_enabled |
| 487 bcf compass_type2 | |
| 624 | 488 bcf compass_type3 |
| 489 | |
| 490 ; probe compass 3 | |
| 491 bsf SSP1CON2,SEN ; Start condition | |
| 492 rcall WaitMSSP | |
| 493 movlw 0x3A ; Address byte + Write bit | |
| 494 movwf SSP1BUF ; control byte | |
| 495 rcall WaitMSSP | |
| 496 btfss SSP1CON2,ACKSTAT ; ACK? | |
| 497 bsf compass_type3 ; ACK send. compass2 present | |
| 498 bsf SSP1CON2,PEN ; Stop condition | |
| 499 rcall WaitMSSP | |
| 500 | |
| 501 btfsc compass_type3 | |
| 502 bra I2C_init_compass3 ; Compass3 | |
| 623 | 503 |
| 504 ; check for compass2 | |
| 505 bsf SSP1CON2,SEN ; start condition | |
| 582 | 506 rcall WaitMSSP |
| 623 | 507 movlw 0x32 ; address byte + Write bit |
| 582 | 508 movwf SSP1BUF ; control byte |
| 509 rcall WaitMSSP | |
| 510 btfss SSP1CON2,ACKSTAT ; ACK? | |
| 623 | 511 bsf compass_type2 ; YES - ACK send, compass2 present |
| 512 bsf SSP1CON2,PEN ; NO - stop condition | |
| 582 | 513 rcall WaitMSSP |
| 514 btfsc compass_type2 | |
| 623 | 515 bra I2C_init_compass2 ; compass2 |
| 516 | |
| 517 ; check for compass0 or compass1... | |
| 582 | 518 bsf compass_type ; set flag |
| 623 | 519 bsf SSP1CON2,SEN ; start condition |
| 582 | 520 rcall WaitMSSP |
| 521 movlw 0x3C ; address | |
| 522 rcall I2C_TX | |
| 523 movlw 0x0F | |
| 524 rcall I2C_TX | |
| 623 | 525 bsf SSP1CON2,PEN ; stop condition |
| 526 rcall WaitMSSP | |
| 582 | 527 bcf PIR1,SSP1IF |
| 623 | 528 bsf SSP1CON2,SEN ; start condition |
| 582 | 529 rcall WaitMSSP |
| 530 movlw 0x3D ; address | |
| 531 rcall I2C_TX | |
| 623 | 532 rcall I2C_OneByteRX ; get one byte |
| 582 | 533 movlw 0x49 ; 0x49 = Compass1 |
| 534 cpfseq SSP1BUF | |
| 535 bcf compass_type ; clear flag | |
| 623 | 536 bsf SSP1CON2,PEN ; stop condition |
| 582 | 537 rcall WaitMSSP |
| 623 | 538 btfsc compass_type ; compass1 ? |
| 539 bra I2C_init_compass1 ; YES | |
| 582 | 540 |
| 623 | 541 ; init compass0 |
| 542 bsf SSP1CON2,SEN ; start condition | |
| 582 | 543 rcall WaitMSSP |
| 544 movlw 0x3C ; address | |
| 545 rcall I2C_TX | |
| 546 movlw 0x00 | |
| 547 rcall I2C_TX | |
| 623 | 548 ; movlw b'01101001' ; ConfigA: 3 Hz, 8 samples averaged, test mode (positive bias) |
| 549 movlw b'01101000' ; ConfigA: 3 Hz, 8 samples averaged | |
| 582 | 550 rcall I2C_TX |
| 20 | 551 I2C_init_compass_common: |
| 623 | 552 movff opt_compass_gain,i2c_temp1 ; 0-7 (230 LSB/Gauss to 1370 LSB/Gauss) |
| 582 | 553 swapf i2c_temp1,F |
| 554 comf i2c_temp1,F | |
| 555 bcf STATUS,C | |
| 556 rlcf i2c_temp1 | |
| 557 movf i2c_temp1,W | |
| 558 clrf i2c_temp1 | |
| 559 rcall I2C_TX | |
| 623 | 560 movlw b'00000000' ; continuous mode |
| 582 | 561 rcall I2C_TX |
| 623 | 562 bsf SSP1CON2,PEN ; stop condition |
| 563 bra WaitMSSP ; ... and return | |
| 0 | 564 |
| 427 | 565 I2C_init_compass1: |
| 623 | 566 bsf SSP1CON2,SEN ; start condition |
| 582 | 567 rcall WaitMSSP |
| 568 movlw 0x3C ; address | |
| 569 rcall I2C_TX | |
| 570 movlw 0x9F ; 1F with auto-increment (MSB=1) | |
| 571 rcall I2C_TX | |
| 572 movlw b'00000000' ; CTRL0 | |
| 573 rcall I2C_TX | |
| 623 | 574 movlw b'00101111' ; CTRL1 (6.25 Hz, BDU=0, x,y,z = ON) |
| 582 | 575 rcall I2C_TX |
| 623 | 576 movlw b'11000000' ; CTRL2 (50 Hz, +/- 2g) |
| 582 | 577 rcall I2C_TX |
| 578 movlw b'00000000' ; CTRL3 | |
| 579 rcall I2C_TX | |
| 580 movlw b'00000000' ; CTRL4 | |
| 581 rcall I2C_TX | |
| 623 | 582 movlw b'01100100' ; CTRL5 HIGH res, 6.25 Hz |
| 582 | 583 rcall I2C_TX |
| 429 | 584 init_compass1_common: |
| 623 | 585 movff opt_compass_gain,i2c_temp1 ; 0-7 (230 LSB/Gauss to 1370 LSB/Gauss) |
| 586 movlw b'01100000' ; CTRL6 Full scale (+/-12 Gauss -> 2730 LSB/Gauss) | |
| 582 | 587 dcfsnz i2c_temp1,F ; = 1? |
| 623 | 588 movlw b'01100000' ; YES - CTRL6 Full scale (+/-12 Gauss -> 2730 LSB/Gauss) |
| 582 | 589 dcfsnz i2c_temp1,F ; = 2? |
| 623 | 590 movlw b'01000000' ; YES - CTRL6 (+/-8 Gauss) |
| 582 | 591 dcfsnz i2c_temp1,F ; = 3? |
| 623 | 592 movlw b'01000000' ; YES - CTRL6 (+/-8 Gauss) |
| 582 | 593 dcfsnz i2c_temp1,F ; = 4? |
| 623 | 594 movlw b'00100000' ; YES - CTRL6 (+/-4 Gauss) |
| 582 | 595 dcfsnz i2c_temp1,F ; = 5? |
| 623 | 596 movlw b'00100000' ; YES - CTRL6 (+/-4 Gauss) |
| 582 | 597 dcfsnz i2c_temp1,F ; = 6? |
| 623 | 598 movlw b'00000000' ; YES - CTRL6 (+/-2 Gauss) |
| 582 | 599 dcfsnz i2c_temp1,F ; = 7? |
| 623 | 600 movlw b'00000000' ; YES - CTRL6 (+/-2 Gauss) |
| 582 | 601 rcall I2C_TX |
| 602 movlw b'00000000' ; CTRL7 Continuous Mode | |
| 603 rcall I2C_TX | |
| 623 | 604 bsf SSP1CON2,PEN ; stop condition |
| 605 bra WaitMSSP ; ... and return | |
| 582 | 606 |
| 560 | 607 I2C_init_compass2: |
| 623 | 608 bsf SSP1CON2,SEN ; start condition |
| 609 rcall WaitMSSP | |
| 610 movlw 0x3C ; address | |
| 611 rcall I2C_TX | |
| 612 movlw 0xE0 ; 0x60 with auto-increment (MSB=1) | |
| 613 rcall I2C_TX | |
| 614 movlw b'00000000' ; CFG_REG_A_M 0x60 (10 Hz, continuous) | |
| 615 rcall I2C_TX | |
| 616 movlw b'00000000' ; CFG_REG_B_M 0x61 (low-pass filter off, set pulse is released every 63 ODR) | |
| 617 rcall I2C_TX | |
| 618 movlw b'00000000' ; CFG_REG_C_M BDU=0 0x62 | |
| 619 rcall I2C_TX | |
| 620 bsf SSP1CON2,PEN ; stop condition | |
| 621 bra WaitMSSP ; ... and return | |
| 582 | 622 |
| 624 | 623 I2C_init_compass3: |
| 624 bsf SSP1CON2,SEN ; Start condition | |
| 625 rcall WaitMSSP | |
| 626 movlw 0x3C ; address | |
| 627 rcall I2C_TX | |
| 628 movlw 0xA0 ; 0x20 with auto-increment (MSB=1) | |
| 629 rcall I2C_TX | |
| 630 movlw b'00010000' ; CTRL_REG1_M (10Hz) 0x20 | |
| 631 rcall I2C_TX | |
| 632 movlw b'01100000' ; CTRL_REG2_M (Full-scale: +/- 16gauss) 0x21 | |
| 633 rcall I2C_TX | |
| 634 movlw b'01000000' ; CTRL_REG3_M (Continuous) 0x22 | |
| 635 rcall I2C_TX | |
| 636 movlw b'00000000' ; CTRL_REG4_M (Z in Low-power mode) 0x23 | |
| 637 rcall I2C_TX | |
| 638 movlw b'00000000' ; CTRL_REG5_M 0x24 | |
| 639 rcall I2C_TX | |
| 640 movlw b'00000000' ; CTRL_REG5_M 0x24 | |
| 641 rcall I2C_TX | |
| 642 bsf SSP1CON2,PEN ; Stop condition | |
| 643 bra WaitMSSP ;(And return) | |
| 644 | |
| 582 | 645 |
| 646 global I2C_sleep_compass | |
| 0 | 647 I2C_sleep_compass: |
| 623 | 648 bcf compass_enabled |
| 624 | 649 btfsc compass_type3 ; compass3? |
| 650 bra I2C_sleep_compass3 ; YES | |
| 623 | 651 btfsc compass_type2 ; compass2 ? |
| 652 bra I2C_sleep_compass2 ; YES | |
| 653 btfsc compass_type ; compass1 ? | |
| 654 bra I2C_sleep_compass1 ; YES | |
| 560 | 655 I2C_sleep_compass0: |
| 623 | 656 bsf SSP1CON2,SEN ; start condition |
| 582 | 657 rcall WaitMSSP |
| 658 movlw 0x3C ; address | |
| 659 rcall I2C_TX | |
| 660 movlw 0x00 | |
| 661 rcall I2C_TX | |
| 662 movlw b'01101000' ; ConfigA | |
| 663 rcall I2C_TX | |
| 664 movlw b'00100000' ; ConfigB | |
| 665 rcall I2C_TX | |
| 623 | 666 movlw b'00000010' ; idle mode |
| 582 | 667 rcall I2C_TX |
| 623 | 668 bsf SSP1CON2,PEN ; stop condition |
| 669 bra WaitMSSP ; ... and return | |
| 0 | 670 |
| 427 | 671 I2C_sleep_compass1: |
| 623 | 672 bsf SSP1CON2,SEN ; start condition |
| 582 | 673 rcall WaitMSSP |
| 674 movlw 0x3C ; address | |
| 675 rcall I2C_TX | |
| 676 movlw 0x20 ; CTRL_REG1 | |
| 677 rcall I2C_TX | |
| 623 | 678 movlw b'00000000' ; data for CTRL_REG1: acceleration sensor power-down mode |
| 582 | 679 rcall I2C_TX |
| 623 | 680 bsf SSP1CON2,PEN ; stop condition |
| 582 | 681 rcall WaitMSSP |
| 623 | 682 bsf SSP1CON2,SEN ; start condition |
| 582 | 683 rcall WaitMSSP |
| 684 movlw 0x3C ; address | |
| 685 rcall I2C_TX | |
| 686 movlw 0x26 ; CTRL_REG7 | |
| 687 rcall I2C_TX | |
| 623 | 688 movlw b'00000010' ; data for CTRL_REG7: magnetic sensor power-down mode |
| 582 | 689 rcall I2C_TX |
| 623 | 690 bsf SSP1CON2,PEN ; stop condition |
| 691 bra WaitMSSP ; and return | |
| 560 | 692 |
| 693 I2C_sleep_compass2: | |
| 623 | 694 ; magnetic |
| 695 bsf SSP1CON2,SEN ; start condition | |
| 696 rcall WaitMSSP | |
| 697 movlw 0x3C ; address | |
| 698 rcall I2C_TX | |
| 699 movlw 0xE0 ; 0x60 with auto-increment (MSB=1) | |
| 700 rcall I2C_TX | |
| 701 movlw b'00000011' ; CFG_REG_A_M 0x60 (idle mode)) | |
| 702 rcall I2C_TX | |
| 703 movlw b'00000100' ; CFG_REG_B_M 0x61 (set pulse is released only at power-on after PD condition) | |
| 704 rcall I2C_TX | |
| 705 movlw b'01010001' ; CFG_REG_C_M 0x62 | |
| 706 rcall I2C_TX | |
| 707 movlw b'00000000' ; INT_CTRL_REG_M 0x63 | |
| 708 rcall I2C_TX | |
| 709 bsf SSP1CON2,PEN ; stop condition | |
| 710 bra WaitMSSP ; ... and return | |
| 582 | 711 |
| 624 | 712 I2C_sleep_compass3: |
| 713 ; magnetic | |
| 714 bsf SSP1CON2,SEN ; Start condition | |
| 715 rcall WaitMSSP | |
| 716 movlw 0x3C ; address | |
| 717 rcall I2C_TX | |
| 718 movlw 0xA2 ; 0x22 with auto-increment (MSB=1) | |
| 719 movlw b'01000010' ; CTRL_REG3_M (Power-down) 0x22 | |
| 720 rcall I2C_TX | |
| 721 bsf SSP1CON2,PEN ; Stop condition | |
| 722 bra WaitMSSP ;(And return) | |
| 723 | |
| 560 | 724 I2C_sleep_accelerometer2: |
| 623 | 725 ; accelerometer |
| 726 bsf SSP1CON2,SEN ; start condition | |
| 727 rcall WaitMSSP | |
| 728 movlw 0x32 ; address | |
| 729 rcall I2C_TX | |
| 730 movlw 0x9F ; 1F with auto-increment (MSB=1) | |
| 731 rcall I2C_TX | |
| 732 movlw b'00000000' ; TEMP_CFG_REG_A 0x1F (temp sensor off) | |
| 733 rcall I2C_TX | |
| 734 movlw b'00000000' ; CTRL_REG1_A 0x20 (all off) | |
| 735 rcall I2C_TX | |
| 736 bsf SSP1CON2,PEN ; stop condition | |
| 737 bra WaitMSSP ; ... and return | |
| 738 | |
| 624 | 739 I2C_sleep_accelerometer3: |
| 740 ; accelerometer | |
| 741 bsf SSP1CON2,SEN ; Start condition | |
| 742 rcall WaitMSSP | |
| 743 movlw 0x3A ; address | |
| 744 rcall I2C_TX | |
| 745 movlw 0x20 | |
| 746 rcall I2C_TX | |
| 747 movlw b'00000000' ; CTRL_REG1_A (100Hz, x,y,z = ON) 0x20 | |
| 748 rcall I2C_TX | |
| 749 bsf SSP1CON2,PEN ; Stop condition | |
| 750 bra WaitMSSP ; (And return) | |
| 751 | |
| 0 | 752 |
| 615 | 753 WaitMSSP: |
| 754 decfsz i2c_temp1,F ; check for timeout during I2C action | |
| 755 bra WaitMSSP2 | |
| 756 bra I2CFail ; timeout occurred | |
| 757 WaitMSSP2: | |
| 758 btfss PIR1,SSP1IF | |
| 759 bra WaitMSSP | |
| 760 clrf i2c_temp1 | |
| 761 bcf PIR1,SSP1IF | |
| 762 return | |
| 763 | |
| 764 I2C_WaitforACK: | |
| 765 btfss SSP1CON2,ACKSTAT ; checks for ACK bit from slave | |
| 766 return | |
| 767 I2CFail: | |
| 627 | 768 bsf active_reset_ostc_rx ; RESET RX circuitry (Which may be the cause for the hang up) |
| 615 | 769 rcall I2CReset ; I2C Reset |
| 770 bcf PIR1,SSP1IF | |
| 771 clrf i2c_temp1 | |
| 772 bsf i2c_error_flag ; set error flag | |
| 627 | 773 bcf active_reset_ostc_rx ; release RESET from RX circuitry |
| 615 | 774 return |
| 775 | |
| 776 I2CReset: ; something went wrong (slave holds SDA low?) | |
| 777 clrf SSP1CON1 ; wake-up slave and reset entire module | |
| 778 clrf SSP1CON2 | |
| 779 clrf SSP1STAT | |
| 780 bcf TRISC,3 ; SCL OUTPUT | |
| 781 bsf TRISC,4 ; SDA input | |
| 782 bcf PORTC,3 | |
| 783 movlw d'9' | |
| 784 movwf i2c_temp1 ; clock-out 9 clock cycles manually | |
| 785 I2CReset_1: | |
| 786 bsf PORTC,3 ; SCL = 1 | |
| 787 nop | |
| 788 nop | |
| 789 nop | |
| 790 nop | |
| 791 btfsc PORTC,4 ; SDA = 1 ? | |
| 792 bra I2CReset_2 ; YES - =1, SDA has been released from slave | |
| 793 bcf PORTC,3 ; NO - set SCL = 0 | |
| 794 nop | |
| 795 nop | |
| 796 bcf PORTC,3 | |
| 797 nop | |
| 798 nop | |
| 799 decfsz i2c_temp1,F | |
| 800 bra I2CReset_1 ; check for nine clock cycles | |
| 801 I2CReset_2: | |
| 802 bsf TRISC,3 ; SCL Input | |
| 803 clrf SSP1CON1 ; setup I²C mode | |
| 804 WAITMS d'10' ; reset-timeout for I2C devices | |
| 805 movlw b'00000000' ; with slew rate control | |
| 806 movwf SSP1STAT | |
| 807 movlw b'00101000' | |
| 808 movwf SSP1CON1 | |
| 809 movlw b'00000000' | |
| 810 movwf SSP1CON2 | |
| 811 movlw 0x27 | |
| 812 movwf SSP1ADD | |
| 813 return | |
| 623 | 814 |
| 815 | |
| 582 | 816 global I2C_init_accelerometer |
| 0 | 817 I2C_init_accelerometer: |
| 624 | 818 btfsc compass_type3 ; compass3? |
| 819 bra I2C_init_accelerometer3 ; YES | |
| 820 | |
| 623 | 821 btfsc compass_type2 ; compass2 ? |
| 822 bra I2C_init_accelerometer2 ; YES | |
| 560 | 823 |
| 623 | 824 btfsc compass_type ; compass1 ? |
| 825 return ; YES - ignore | |
| 427 | 826 |
| 623 | 827 rcall I2C_sleep_accelerometer ; registers can only be changed in standby mode |
| 0 | 828 |
| 623 | 829 bsf SSP1CON2,SEN ; start condition |
| 582 | 830 rcall WaitMSSP |
| 831 movlw 0x38 ; address | |
| 832 rcall I2C_TX | |
| 833 movlw 0x0E ; XYZ_DATA_CFG | |
| 834 rcall I2C_TX | |
| 623 | 835 movlw b'00000000' ; high pass filter = 0, +/- 2g range |
| 582 | 836 rcall I2C_TX |
| 623 | 837 bsf SSP1CON2,PEN ; stop condition |
| 582 | 838 rcall WaitMSSP |
| 0 | 839 |
| 623 | 840 bsf SSP1CON2,SEN ; start condition |
| 582 | 841 rcall WaitMSSP |
| 842 movlw 0x38 ; address | |
| 843 rcall I2C_TX | |
| 844 movlw 0x2A ; CTRL_REG1 | |
| 845 rcall I2C_TX | |
| 623 | 846 ; movlw b'00110000' ; CTRL_REG1: 160 ms data rate, standby mode |
| 847 movlw b'00110100' ; CTRL_REG1: 160 ms data rate, standby mode, reduced noise mode | |
| 582 | 848 rcall I2C_TX |
| 623 | 849 movlw b'00000010' ; CTRL_REG2: high-res in active mode |
| 582 | 850 rcall I2C_TX |
| 623 | 851 bsf SSP1CON2,PEN ; stop condition |
| 582 | 852 rcall WaitMSSP |
| 0 | 853 |
| 623 | 854 bsf SSP1CON2,SEN ; start condition |
| 582 | 855 rcall WaitMSSP |
| 856 movlw 0x38 ; address | |
| 857 rcall I2C_TX | |
| 858 movlw 0x2A ; CTRL_REG1 | |
| 859 rcall I2C_TX | |
| 623 | 860 ; movlw b'00110001' ; CTRL_REG1: 160 ms data rate, active mode |
| 861 movlw b'00110101' ; CTRL_REG1: 160 ms data rate, standby mode, reduced noise mode, active Mode | |
| 582 | 862 rcall I2C_TX |
| 623 | 863 bsf SSP1CON2,PEN ; stop condition |
| 864 bra WaitMSSP ; ... and return | |
| 582 | 865 |
| 560 | 866 I2C_init_accelerometer2: |
| 623 | 867 bsf SSP1CON2,SEN ; start condition |
| 582 | 868 rcall WaitMSSP |
| 869 movlw 0x32 ; address | |
| 870 rcall I2C_TX | |
| 871 movlw 0x9F ; 1F with auto-increment (MSB=1) | |
| 872 rcall I2C_TX | |
| 873 movlw b'00000000' ; TEMP_CFG_REG_A (Temp sensor off) | |
| 874 rcall I2C_TX | |
| 875 movlw b'01010111' ; CTRL_REG1_A (100Hz, x,y,z = ON) | |
| 876 rcall I2C_TX | |
| 877 movlw b'00000000' ; CTRL_REG2_A | |
| 878 rcall I2C_TX | |
| 879 ; movlw b'00000000' ; CTRL_REG3_A | |
| 880 ; rcall I2C_TX | |
| 881 ; movlw b'00000000' ; CTRL_REG4_A (BDU=0, +/-2g, | |
| 882 ; rcall I2C_TX | |
| 883 ; movlw b'00000000' ; CTRL_REG5_A | |
| 884 ; rcall I2C_TX | |
| 623 | 885 bsf SSP1CON2,PEN ; stop condition |
| 886 bra WaitMSSP ; ... and return | |
| 887 | |
| 624 | 888 I2C_init_accelerometer3: |
| 889 bsf SSP1CON2,SEN ; Start condition | |
| 890 rcall WaitMSSP | |
| 891 movlw 0x3A ; address | |
| 892 rcall I2C_TX | |
| 893 movlw 0x20 | |
| 894 rcall I2C_TX | |
| 895 movlw b'00110111' ; CTRL_REG1_A (100Hz, x,y,z = ON) 0x20 | |
| 896 rcall I2C_TX | |
| 897 movlw b'00000000' ; CTRL_REG2_A 0x21 | |
| 898 rcall I2C_TX | |
| 899 movlw b'00000000' ; CTRL_REG3_A 0x22 | |
| 900 rcall I2C_TX | |
| 901 bsf SSP1CON2,PEN ; Stop condition | |
| 902 bra WaitMSSP ; (And return) | |
| 903 | |
| 0 | 904 |
| 582 | 905 global I2C_sleep_accelerometer |
| 0 | 906 I2C_sleep_accelerometer: |
| 624 | 907 btfsc compass_type3 ; Compass3 |
| 908 bra I2C_sleep_accelerometer3 ; YES | |
| 582 | 909 btfsc compass_type2 ; Compass2 |
| 623 | 910 bra I2C_sleep_accelerometer2 ; YES |
| 582 | 911 btfsc compass_type ; compass1? |
| 623 | 912 return ; YES - ignore |
| 427 | 913 |
| 623 | 914 bsf SSP1CON2,SEN ; start condition |
| 582 | 915 rcall WaitMSSP |
| 916 movlw 0x38 ; address | |
| 917 rcall I2C_TX | |
| 918 movlw 0x2A ; CTRL_REG1 | |
| 919 rcall I2C_TX | |
| 623 | 920 movlw b'00000000' ; standby mode |
| 582 | 921 rcall I2C_TX |
| 623 | 922 bsf SSP1CON2,PEN ; stop condition |
| 923 bra WaitMSSP ; ... and return | |
| 582 | 924 |
|
556
dd28d4efd4d2
fix a potential issue in the battery managment
heinrichsweikamp
parents:
498
diff
changeset
|
925 lt2942_init_again: |
| 582 | 926 clrf i2c_temp1 |
| 623 | 927 movlw 0x02 ; point to accumulated charge registers |
|
556
dd28d4efd4d2
fix a potential issue in the battery managment
heinrichsweikamp
parents:
498
diff
changeset
|
928 rcall I2C_TX_GAUGE |
| 623 | 929 movff battery_accumulated_charge+1,SSP1BUF ; data byte |
|
556
dd28d4efd4d2
fix a potential issue in the battery managment
heinrichsweikamp
parents:
498
diff
changeset
|
930 rcall WaitMSSP |
|
dd28d4efd4d2
fix a potential issue in the battery managment
heinrichsweikamp
parents:
498
diff
changeset
|
931 rcall I2C_WaitforACK |
| 623 | 932 movff battery_accumulated_charge+0,SSP1BUF ; data byte |
|
556
dd28d4efd4d2
fix a potential issue in the battery managment
heinrichsweikamp
parents:
498
diff
changeset
|
933 rcall WaitMSSP |
|
dd28d4efd4d2
fix a potential issue in the battery managment
heinrichsweikamp
parents:
498
diff
changeset
|
934 rcall I2C_WaitforACK |
| 623 | 935 bsf SSP1CON2,PEN ; stop condition |
| 560 | 936 rcall WaitMSSP |
| 623 | 937 MOVII battery_accumulated_charge,sub_a |
|
556
dd28d4efd4d2
fix a potential issue in the battery managment
heinrichsweikamp
parents:
498
diff
changeset
|
938 ; and init again... |
| 560 | 939 |
| 582 | 940 global lt2942_init |
| 623 | 941 lt2942_init: ; setup control register B |
| 582 | 942 clrf i2c_temp1 |
| 623 | 943 movlw 0x01 ; point to control reg B |
| 467 | 944 rcall I2C_TX_GAUGE |
| 623 | 945 movlw b'11111000' ; automatic conversion every two seconds |
| 946 movff WREG, SSP1BUF ; data byte | |
| 113 | 947 rcall WaitMSSP |
| 948 rcall I2C_WaitforACK | |
| 623 | 949 bsf SSP1CON2,PEN ; stop condition |
| 950 bra WaitMSSP ; ... and return | |
| 113 | 951 |
| 952 global lt2942_get_status | |
| 623 | 953 lt2942_get_status: ; read status register |
| 954 bcf battery_gauge_available ; clear flag | |
| 582 | 955 clrf i2c_temp1 |
| 623 | 956 movlw 0x00 ; point to status register |
| 467 | 957 rcall I2C_TX_GAUGE |
| 958 rcall I2C_RX_GAUGE | |
| 113 | 959 movff SSP1BUF,WREG |
| 582 | 960 btfss WREG,7 ; 2942 found? |
| 623 | 961 bsf battery_gauge_available ; YES - set flag |
| 962 bsf SSP1CON2,PEN ; stop condition | |
| 963 bra WaitMSSP ; ... and return | |
| 113 | 964 |
| 965 | |
| 966 global lt2942_get_voltage | |
| 623 | 967 lt2942_get_voltage: ; read battery voltage registers |
| 582 | 968 clrf i2c_temp1 |
| 623 | 969 movlw 0x08 ; point to voltage registers |
| 448 | 970 rcall I2C_TX_GAUGE |
| 971 rcall I2C_RX_GAUGE | |
| 623 | 972 bsf SSP1CON2,ACKEN ; master acknowledge |
| 615 | 973 rcall WaitMSSP |
| 974 movff SSP1BUF,xA+1 | |
| 623 | 975 bsf SSP1CON2, RCEN ; enable receive mode |
| 615 | 976 rcall WaitMSSP |
| 977 movff SSP1BUF,xA+0 | |
| 623 | 978 bsf SSP1CON2,PEN ; stop condition |
| 615 | 979 rcall WaitMSSP |
| 980 | |
| 623 | 981 ; convert voltage from raw value to Volt |
| 982 MOVLI .6000,xB ; load conversion multiplicand into xB | |
| 983 call mult16x16 ; xC = xA * xB -> multiply raw value in xA with conversion multiplicand | |
| 984 ; divide by 65536 instead of 65535, introducing an error of 65536/65535 = 0.002 % | |
| 985 movff xC+2,batt_voltage+0 ; divide by 65536 can easily be done by just taking the 3rd and 4th byte of the multiplication result | |
| 986 movff xC+3,batt_voltage+1 ; ... | |
| 615 | 987 |
| 623 | 988 tstfsz batt_voltage+1 ; < 256 mV ? |
| 989 return ; NO - done | |
| 990 bra lt2942_init ; YES - ... and return | |
| 991 | |
| 615 | 992 |
| 623 | 993 global lt2942_get_temperature |
| 994 lt2942_get_temperature: ; read battery temperature | |
| 995 clrf i2c_temp1 | |
| 996 movlw 0x0C ; point to temperature register | |
| 997 call I2C_TX_GAUGE | |
| 998 call I2C_RX_GAUGE | |
| 999 bsf SSP1CON2,ACKEN ; master acknowledge | |
| 1000 rcall WaitMSSP | |
| 1001 movff SSP1BUF,xA+1 ; store raw temperature, high byte | |
| 1002 bsf SSP1CON2, RCEN ; enable receive mode | |
| 1003 rcall WaitMSSP | |
| 1004 movff SSP1BUF,xA+0 ; store raw temperature, low byte | |
| 1005 bsf SSP1CON2,PEN ; stop condition | |
| 1006 rcall WaitMSSP | |
| 1007 | |
| 1008 ; convert temperature from raw value to Kelvin | |
| 1009 MOVLI .6000,xB ; load conversion multiplicand into xB | |
| 1010 call mult16x16 ; xC = xA * xB -> multiply raw value in xA with conversion multiplicand | |
| 1011 ; divide by 65536 instead of 65535, introducing an error of 65536/65535 = 0.002 % | |
| 1012 movff xC+2,battery_temperature+0 ; divide by 65536 can easily be done by just taking the 3rd and 4th byte of the multiplication result | |
| 1013 movff xC+3,battery_temperature+1 ; ... | |
| 1014 | |
| 1015 ; check if battery is charged right now | |
| 1016 btfss cc_active ; in CC charging mode? | |
| 1017 return ; NO - not charging, done | |
| 1018 | |
| 1019 ; check for over-temperature while charging | |
| 1020 MOVLI max_battery_charge_temp,sub_a | |
| 1021 MOVII battery_temperature, sub_b | |
| 1022 call cmpU16 ; sub_a - sub_b (with UNSIGNED values) | |
| 1023 btfss neg_flag ; result negative? | |
| 1024 return ; NO - temperature <= threshold, ok, done | |
| 1025 ; YES - too hot, disable charging circuitry | |
| 1026 bsf charge_disable ; - set charging-inhibit signal | |
| 1027 bcf charge_enable ; - activate charging-inhibit signal | |
| 1028 bsf battery_overtemp ; - flag that the battery charging over-temperature protection has tripped | |
| 1029 return | |
| 1030 | |
| 113 | 1031 |
| 1032 global lt2942_get_accumulated_charge | |
| 623 | 1033 lt2942_get_accumulated_charge: ; read accumulated charge and compute percent |
| 582 | 1034 clrf i2c_temp1 |
| 623 | 1035 movlw 0x00 ; point to status register |
| 467 | 1036 rcall I2C_TX_GAUGE |
| 1037 rcall I2C_RX_GAUGE | |
| 623 | 1038 bsf SSP1CON2,ACKEN ; master acknowledge |
| 113 | 1039 rcall WaitMSSP |
| 466 | 1040 movff SSP1BUF,gauge_status_byte |
| 1041 | |
| 623 | 1042 bsf SSP1CON2, RCEN ; enable receive mode |
| 1043 rcall WaitMSSP ; dummy read (control byte) | |
| 467 | 1044 movf SSP1BUF,W |
| 623 | 1045 bsf SSP1CON2,ACKEN ; master acknowledge |
| 467 | 1046 rcall WaitMSSP |
| 582 | 1047 |
| 623 | 1048 bsf SSP1CON2, RCEN ; enable receive mode |
| 466 | 1049 rcall WaitMSSP |
| 623 | 1050 movff SSP1BUF,sub_a+1 |
| 1051 bsf SSP1CON2,ACKEN ; master acknowledge | |
| 113 | 1052 rcall WaitMSSP |
| 582 | 1053 |
| 623 | 1054 bsf SSP1CON2, RCEN ; enable receive mode |
| 1055 rcall WaitMSSP | |
| 1056 movff SSP1BUF,sub_a+0 | |
| 1057 bsf SSP1CON2,PEN ; stop condition | |
| 1058 rcall WaitMSSP | |
| 113 | 1059 |
| 623 | 1060 btfsc gauge_status_byte,0 ; UVLO event ? |
| 1061 rcall lt2942_init_again ; YES | |
| 1062 | |
| 1063 MOVII sub_a,battery_accumulated_charge ; save raw value | |
| 582 | 1064 |
| 1065 ; Compute batt_percent | |
| 1066 ; (charge-battery_offset)/365 | |
| 623 | 1067 MOVII battery_offset,sub_b |
| 582 | 1068 call subU16 ; sub_c = sub_a - sub_b (with signed values) |
| 623 | 1069 clrf batt_percent ; set to zero |
| 582 | 1070 btfsc neg_flag ; result negative? |
| 623 | 1071 bra lt2942_set_to_zero_percent ; YES - keep LT2942 at zero percent and return |
| 113 | 1072 |
| 623 | 1073 ; > zero, set batt_percent properly |
| 1074 MOVII sub_c,xA | |
| 1075 MOVII battery_capacity,xB | |
| 604 | 1076 call div16x16 ; xC = xA / xB with xA as remainder |
| 582 | 1077 movff xC+0,batt_percent |
| 1078 return | |
| 113 | 1079 |
| 449 | 1080 lt2942_set_to_zero_percent: |
| 582 | 1081 clrf i2c_temp1 |
| 623 | 1082 movlw 0x02 ; point to accumulated charge registers |
| 449 | 1083 rcall I2C_TX_GAUGE |
| 1084 movff battery_offset+1,SSP1BUF | |
| 1085 rcall WaitMSSP | |
| 1086 rcall I2C_WaitforACK | |
| 1087 movff battery_offset+0,SSP1BUF | |
| 1088 rcall WaitMSSP | |
| 1089 rcall I2C_WaitforACK | |
| 623 | 1090 bsf SSP1CON2,PEN ; stop condition |
| 1091 bra WaitMSSP ; ... and return | |
| 449 | 1092 |
| 113 | 1093 global lt2942_charge_done |
| 623 | 1094 lt2942_charge_done: ; reset accumulating registers to 0xFFFF |
| 582 | 1095 clrf i2c_temp1 |
| 623 | 1096 movlw 0x02 ; point to accumulated charge registers |
| 448 | 1097 rcall I2C_TX_GAUGE |
| 623 | 1098 setf SSP1BUF ; data byte |
| 113 | 1099 rcall WaitMSSP |
| 1100 rcall I2C_WaitforACK | |
| 623 | 1101 setf SSP1BUF ; data byte |
| 113 | 1102 rcall WaitMSSP |
| 1103 rcall I2C_WaitforACK | |
| 623 | 1104 bsf SSP1CON2,PEN ; stop condition |
| 1105 bra WaitMSSP ; ... and return | |
| 113 | 1106 |
| 623 | 1107 I2C_TX_GAUGE: ; send a byte to the LT2942 gauge IC |
| 1108 movwf i2c_temp2 ; data byte | |
| 1109 bsf SSP1CON2,SEN ; start condition | |
| 113 | 1110 rcall WaitMSSP |
| 623 | 1111 movlw b'11001000' ; address byte + Write bit |
| 582 | 1112 movwf SSP1BUF ; control byte |
| 113 | 1113 rcall WaitMSSP |
| 1114 rcall I2C_WaitforACK | |
| 582 | 1115 movf i2c_temp2,W |
| 623 | 1116 bra I2C_TX ; ... and return |
| 582 | 1117 |
| 113 | 1118 I2C_RX_GAUGE: |
| 623 | 1119 bsf SSP1CON2,SEN ; start condition |
| 113 | 1120 rcall WaitMSSP |
| 623 | 1121 movlw b'11001001' ; address byte + Read bit |
| 582 | 1122 movwf SSP1BUF ; control byte |
| 113 | 1123 rcall WaitMSSP |
| 1124 rcall I2C_WaitforACK | |
| 623 | 1125 bsf SSP1CON2, RCEN ; enable receive mode |
| 1126 bra WaitMSSP ; ... and return | |
| 582 | 1127 |
| 1128 | |
| 623 | 1129 ;============================================================================= |
| 604 | 1130 ; Transmitter Functions |
| 623 | 1131 ; |
| 604 | 1132 IFDEF _rx_functions |
| 1133 | |
| 560 | 1134 global I2C_probe_OSTC_rx |
| 1135 I2C_probe_OSTC_rx: | |
| 623 | 1136 bcf ostc_rx_present ; no TR module by default |
| 1137 clrf WREG ; bank-safe set to zero of ... | |
| 1138 movff WREG,rx_firmware_cur_major ; ... current TR module firmware, major | |
| 1139 movff WREG,rx_firmware_cur_minor ; ... current TR module firmware, minor | |
| 1140 movlw .5 ; max number of tries for detecting a TR module | |
| 1141 movwf hy ; initialize counter for tries | |
| 604 | 1142 I2C_probe_OSTC_rx_1: |
| 623 | 1143 bsf SSP1CON2,SEN ; start condition |
| 560 | 1144 rcall WaitMSSP |
| 623 | 1145 movlw 0x50 ; address byte + write bit |
| 582 | 1146 movwf SSP1BUF ; control byte |
| 560 | 1147 rcall WaitMSSP |
| 623 | 1148 btfss SSP1CON2,ACKSTAT ; ACK received? |
| 1149 bsf ostc_rx_present ; YES - TR module detected | |
| 1150 bsf SSP1CON2,PEN ; stop condition | |
| 560 | 1151 rcall WaitMSSP |
| 623 | 1152 btfss ostc_rx_present ; was a TR module detected? |
| 1153 return ; NO - done | |
| 560 | 1154 WAITMS .1 |
| 623 | 1155 bsf SSP1CON2,SEN ; start condition |
| 560 | 1156 rcall WaitMSSP |
| 623 | 1157 movlw 0x50 ; address byte + write bit |
| 582 | 1158 movwf SSP1BUF ; control byte |
| 560 | 1159 rcall WaitMSSP |
| 1160 rcall I2C_WaitforACK | |
| 1161 movlw 0x1B | |
| 623 | 1162 movwf SSP1BUF ; data byte (get firmware) |
| 560 | 1163 rcall WaitMSSP |
| 1164 rcall I2C_WaitforACK | |
| 623 | 1165 bsf SSP1CON2,PEN ; stop condition |
| 560 | 1166 rcall WaitMSSP |
| 1167 WAITMS .1 | |
| 623 | 1168 bsf SSP1CON2,SEN ; start condition |
| 560 | 1169 rcall WaitMSSP |
| 623 | 1170 movlw 0x51 ; address byte + Read bit |
| 582 | 1171 movwf SSP1BUF ; control byte |
| 560 | 1172 rcall WaitMSSP |
| 623 | 1173 bsf SSP1CON2,RCEN ; enable receive mode |
| 560 | 1174 rcall WaitMSSP |
| 623 | 1175 movff SSP1BUF,rx_firmware_cur_major ; store as firmware version, major |
| 1176 bsf SSP1CON2,ACKEN ; master acknowledge | |
| 560 | 1177 rcall WaitMSSP |
| 582 | 1178 |
| 560 | 1179 ; last byte in read from RX circuity always with a NACK! |
| 623 | 1180 bsf SSP1CON2,RCEN ; enable receive mode |
| 560 | 1181 rcall WaitMSSP |
| 623 | 1182 movff SSP1BUF,rx_firmware_cur_minor ; store as firmware version, minor |
| 582 | 1183 bsf SSP1CON2,ACKDT |
| 623 | 1184 bsf SSP1CON2,ACKEN ; master NOT acknowledge |
| 560 | 1185 rcall WaitMSSP |
| 623 | 1186 bcf SSP1CON2,ACKDT ; reset ACKDT flag |
| 1187 bsf SSP1CON2,PEN ; stop condition | |
| 604 | 1188 rcall WaitMSSP |
| 1189 | |
| 623 | 1190 ; wait for TR module becoming ready |
| 1191 movff rx_firmware_cur_minor,i2c_temp1 ; copy firmware version to bank common, minor | |
| 1192 movlw .147 ; code for not ready, minor | |
| 1193 cpfseq i2c_temp1 ; equal? | |
| 1194 bra I2C_probe_OSTC_rx_2 ; NO - TR module ready | |
| 1195 movff rx_firmware_cur_major,i2c_temp1 ; YES - copy firmware version to bank common, major | |
| 1196 movlw .27 ; - code for not ready, major | |
| 1197 cpfseq i2c_temp1 ; - equal? | |
| 1198 bra I2C_probe_OSTC_rx_2 ; NO - TR module ready | |
| 1199 bsf active_reset_ostc_rx ; YES - apply reset to TR module | |
| 1200 WAITMS .5 ; - wait 5 ms | |
| 1201 bcf active_reset_ostc_rx ; - release reset | |
| 1202 WAITMS .250 ; - wait for 250 ms | |
| 1203 WAITMS .250 ; - wait another 250 ms | |
| 1204 clrf i2c_temp1 ; - clean-up i2c_temp1 | |
| 1205 decfsz hy,F ; - decrement counter for number of tries, became zero? | |
| 1206 bra I2C_probe_OSTC_rx_1 ; - NO - try again | |
| 1207 bcf ostc_rx_present ; - YES - something is wrong, flag TR module as not available | |
| 604 | 1208 I2C_probe_OSTC_rx_2: |
| 623 | 1209 clrf i2c_temp1 ; clean-up i2c_temp1 |
| 1210 return ; done | |
| 582 | 1211 |
| 560 | 1212 |
| 1213 global I2C_get_tankdata | |
| 1214 I2C_get_tankdata: | |
| 623 | 1215 bsf SSP1CON2,SEN ; start condition |
| 560 | 1216 rcall WaitMSSP |
| 623 | 1217 movlw 0x50 ; address byte + write bit |
| 582 | 1218 movwf SSP1BUF ; control byte |
| 560 | 1219 rcall WaitMSSP |
| 1220 rcall I2C_WaitforACK | |
| 623 | 1221 movlw 0x1E ; read buffer2 (48 bytes) |
| 1222 movwf SSP1BUF ; data byte | |
| 560 | 1223 rcall WaitMSSP |
| 1224 rcall I2C_WaitforACK | |
| 623 | 1225 bsf SSP1CON2,PEN ; stop condition |
| 560 | 1226 rcall WaitMSSP |
| 1227 WAITMS .1 | |
| 1228 ; read 48 bytes | |
| 623 | 1229 bsf SSP1CON2,SEN ; start condition |
| 560 | 1230 rcall WaitMSSP |
| 623 | 1231 movlw 0x51 ; address byte + read bit |
| 582 | 1232 movwf SSP1BUF ; control byte |
| 560 | 1233 rcall WaitMSSP |
| 1234 rcall I2C_WaitforACK | |
| 582 | 1235 movlw .47 ; 47 with ACK + 1 w/o ACK |
| 1236 movwf i2c_temp2 | |
| 623 | 1237 lfsr FSR2,rx_buffer |
| 560 | 1238 I2C_get_tankdata_loop_read: |
| 623 | 1239 bsf SSP1CON2, RCEN ; enable receive mode |
| 560 | 1240 rcall WaitMSSP |
| 1241 movff SSP1BUF,POSTINC2 | |
| 582 | 1242 bcf SSP1CON2,ACKDT |
| 623 | 1243 bsf SSP1CON2,ACKEN ; master acknowledge |
| 560 | 1244 rcall WaitMSSP |
| 582 | 1245 decfsz i2c_temp2,F |
| 1246 bra I2C_get_tankdata_loop_read | |
| 560 | 1247 ; 1 w/o ACK |
| 623 | 1248 bsf SSP1CON2, RCEN ; enable receive mode |
| 560 | 1249 rcall WaitMSSP |
| 1250 movff SSP1BUF,POSTINC2 | |
| 582 | 1251 bsf SSP1CON2,ACKDT |
| 623 | 1252 bsf SSP1CON2,ACKEN ; master NOT acknowledge |
| 560 | 1253 rcall WaitMSSP |
| 623 | 1254 bcf SSP1CON2,ACKDT ; reset ACKDT flag |
| 1255 bsf SSP1CON2,PEN ; stop condition | |
| 1256 bra WaitMSSP ; ... and return | |
| 582 | 1257 |
| 1258 | |
| 560 | 1259 global I2C_update_OSTC_rx |
| 623 | 1260 I2C_update_OSTC_rx: ; transfer 64 byte to RX co-processor |
| 1261 ; setup for write | |
| 582 | 1262 bcf i2c_error_flag ; clear error flag |
| 623 | 1263 lfsr FSR2,buffer ; initialize pointer to send buffer used for verify |
| 1264 movlw .64 ; initialize loop counter: 64 byte with ACK | |
| 1265 movwf i2c_temp2 ; ... | |
| 1266 ; address write | |
| 1267 bsf SSP1CON2,SEN ; start condition | |
| 560 | 1268 rcall WaitMSSP |
| 623 | 1269 movlw 0x50 ; address byte + write bit |
| 582 | 1270 movwf SSP1BUF ; control byte |
| 560 | 1271 rcall WaitMSSP |
| 1272 rcall I2C_WaitforACK | |
| 623 | 1273 ; write 64 bytes |
| 1274 I2C_update_OSTC_loop: | |
| 1275 TBLRD*+ ; read a byte from program memory | |
| 1276 movff TABLAT,POSTINC2 ; copy to send buffer | |
| 1277 movff TABLAT,SSP1BUF ; copy to I2C data buffer | |
| 560 | 1278 rcall WaitMSSP |
| 1279 rcall I2C_WaitforACK | |
| 623 | 1280 decfsz i2c_temp2,F ;decrement loop counter, became zero? |
| 1281 bra I2C_update_OSTC_loop ; NO - loop | |
| 1282 bsf SSP1CON2,PEN ; YES - stop condition | |
| 1283 rcall WaitMSSP ; - wait for stop condition done | |
| 1284 WAITMS .1 ; - wait another 1 ms | |
| 1285 ; setup for read-back | |
| 1286 lfsr FSR2,buffer ; reset pointer to begin of send buffer | |
| 1287 movlw .63 ; initialize loop counter: 63 byte with ACK + 1 w/o ACK | |
| 1288 movwf i2c_temp2 | |
| 1289 ; address read-back | |
| 1290 bsf SSP1CON2,SEN ; start condition | |
| 560 | 1291 rcall WaitMSSP |
| 623 | 1292 movlw 0x51 ; address byte + read bit |
| 582 | 1293 movwf SSP1BUF ; control byte |
| 560 | 1294 rcall WaitMSSP |
| 1295 rcall I2C_WaitforACK | |
| 623 | 1296 ; read-back 64 bytes |
| 560 | 1297 I2C_update_OSTC_loop_read: |
| 623 | 1298 bsf SSP1CON2,RCEN ; enable receive mode |
| 560 | 1299 rcall WaitMSSP |
| 1300 movf SSP1BUF,W | |
| 623 | 1301 cpfseq POSTINC2 ; compare read-back byte with sent byte, equal? |
| 1302 bsf i2c_error_flag ; NO - not equal, set error flag | |
| 582 | 1303 bcf SSP1CON2,ACKDT |
| 623 | 1304 bsf SSP1CON2,ACKEN ; master acknowledge |
| 560 | 1305 rcall WaitMSSP |
| 623 | 1306 decfsz i2c_temp2,F ; decrement loop counter, became zero? |
| 1307 bra I2C_update_OSTC_loop_read ; NO - loop | |
| 560 | 1308 ; 1 w/o ACK |
| 623 | 1309 bsf SSP1CON2, RCEN ; YES - enable receive mode |
| 1310 rcall WaitMSSP ; - | |
| 1311 movf SSP1BUF,W ; - get 64th byte | |
| 1312 cpfseq POSTINC2 ; - compare read-back byte with sent byte, equal? | |
| 1313 bsf i2c_error_flag ; NO - not equal, set error flag | |
| 1314 bsf SSP1CON2,ACKDT ; - | |
| 1315 bsf SSP1CON2,ACKEN ; - master NOT acknowledge | |
| 1316 rcall WaitMSSP ; - | |
| 1317 bcf SSP1CON2,ACKDT ; - reset ACKDT flag | |
| 1318 ; stop | |
| 1319 bsf SSP1CON2,PEN ; stop condition | |
| 560 | 1320 rcall WaitMSSP |
| 1321 WAITMS .1 | |
| 623 | 1322 ; address commit |
| 1323 bsf SSP1CON2,SEN ; start condition | |
| 560 | 1324 rcall WaitMSSP |
| 623 | 1325 movlw 0x50 ; address byte + write bit |
| 582 | 1326 movwf SSP1BUF ; control byte |
| 560 | 1327 rcall WaitMSSP |
| 1328 rcall I2C_WaitforACK | |
| 623 | 1329 movlw 0x1F ; write command |
| 1330 movwf SSP1BUF ; data byte | |
| 560 | 1331 rcall WaitMSSP |
| 1332 rcall I2C_WaitforACK | |
| 623 | 1333 bsf SSP1CON2,PEN ; stop condition |
| 560 | 1334 rcall WaitMSSP |
| 623 | 1335 WAITMS .5 ; required waiting time |
| 1336 ; error check | |
| 1337 btfss i2c_error_flag ; did an error occur? | |
| 1338 retlw .0 ; NO - data transfered successfully | |
| 1339 retlw .255 ; YES - error in data transfer occurred | |
| 582 | 1340 |
| 604 | 1341 ENDIF |
| 1342 | |
| 623 | 1343 ;============================================================================= |
| 1344 | |
| 582 | 1345 END |