Mercurial > public > hwos_code
annotate src/i2c.asm @ 657:c2e97f94c55f default tip
bump to 10.93 / 3.32
| author | heinrichsweikamp |
|---|---|
| date | Tue, 27 Jan 2026 11:01:04 +0100 |
| parents | 8af5aefbcdaf |
| children |
| rev | line source |
|---|---|
| 0 | 1 ;============================================================================= |
| 2 ; | |
| 634 | 3 ; File i2c.asm * combined next generation V3.09.4b |
| 0 | 4 ; |
| 560 | 5 ; I2C Interface |
| 6 ; | |
| 654 | 7 ; Copyright (c) 2012, JD Gascuel, heinrichs weikamp gmbh, all right reserved. |
| 0 | 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 ; -------- | |
| 628 | 31 ; LSM303C's Compass read address (8-Bit): 0x3D |
| 32 ; LSM303C's Compass write address (8-Bit): 0x3C | |
| 624 | 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 | |
| 643 | 40 ; |
| 41 ; Battery gauge | |
| 42 ; ------------- | |
| 43 ; LTC2942 read address (8-Bit): 0xC9 | |
| 44 ; LTC2942 write address (8-Bit): 0xC8 | |
| 656 | 45 ; |
| 46 ; Alternative Battery gauge | |
| 47 ; ------------- | |
| 48 ; LTC2959 read address (8-Bit): 0xC7 | |
| 49 ; LTC2959 write address (8-Bit): 0xC6 | |
| 643 | 50 ; |
| 51 ; Alternative pressure sensor | |
| 52 ; ----------- | |
| 53 ; MS5837 read address (8-Bit): 0xED | |
| 54 ; MS5837 write address (8-Bit): 0xEC | |
| 582 | 55 ; |
| 56 ; | |
| 57 | |
| 0 | 58 ; HISTORY |
| 59 ; 2012-08-22 : [mH] Creation | |
| 565 | 60 ; 2018-02-18 : [mH] Sync with hwOS Sport release |
| 0 | 61 |
| 62 | |
| 582 | 63 #include "hwos.inc" ; Mandatory header |
| 0 | 64 #include "wait.inc" |
| 113 | 65 #include "math.inc" |
| 631 | 66 #include "eeprom_rs232.inc" |
| 643 | 67 |
| 582 | 68 |
| 634 | 69 ;============================================================================= |
| 70 i2c CODE | |
| 582 | 71 ;============================================================================= |
| 0 | 72 |
| 634 | 73 |
| 0 | 74 |
| 634 | 75 ;----------------------------------------------------------------------------- |
| 76 ; Helper Function - get two Bytes and divide hi:lo/16 (signed) | |
| 77 ; | |
| 78 I2C_TwoBytesRX_div16: | |
| 79 rcall I2C_OneByteRX ; receive 1 byte with acknowledge | |
| 80 movff SSP1BUF,hi ; copy data byte to hi | |
| 81 rcall I2C_OneByteRX ; receive 1 byte with acknowledge | |
| 82 movff SSP1BUF,lo ; copy data byte to lo | |
| 83 I2C_TwoBytesRX_div16_2: ; divide hi:lo/16 (signed) only | |
| 582 | 84 bcf STATUS,C |
| 604 | 85 btfsc hi,7 ; copy sign bit to carry |
| 582 | 86 bsf STATUS,C |
| 87 rrcf hi ; /2 | |
| 88 rrcf lo | |
| 634 | 89 ;bra I2C_TwoBytesRX_div8 ; continue dividing hi:lo/8 (signed) |
| 90 | |
| 91 | |
| 92 ;----------------------------------------------------------------------------- | |
| 93 ; Helper Function - divide hi:lo/8 (signed) | |
| 94 ; | |
| 95 I2C_TwoBytesRX_div8: | |
| 582 | 96 bcf STATUS,C |
| 604 | 97 btfsc hi,7 ; copy sign bit to carry |
| 582 | 98 bsf STATUS,C |
| 99 rrcf hi ; /4 | |
| 100 rrcf lo | |
| 101 bcf STATUS,C | |
| 604 | 102 btfsc hi,7 ; copy sign bit to carry |
| 582 | 103 bsf STATUS,C |
| 104 rrcf hi ; /8 | |
| 105 rrcf lo | |
| 106 bcf STATUS,C | |
| 604 | 107 btfsc hi,7 ; copy sign bit to carry |
| 582 | 108 bsf STATUS,C |
| 109 rrcf hi ; /16 | |
| 110 rrcf lo | |
| 634 | 111 return ; done |
| 112 | |
| 0 | 113 |
| 634 | 114 ;----------------------------------------------------------------------------- |
| 115 ; Read Accelerometer | |
| 116 ; | |
| 582 | 117 global I2C_RX_accelerometer |
| 0 | 118 I2C_RX_accelerometer: |
| 628 | 119 btfsc compass_type3 ; compass3 ? |
| 120 bra I2C_RX_accelerometer_compass3 ; YES | |
| 604 | 121 btfsc compass_type2 ; compass2 ? |
| 122 bra I2C_RX_accelerometer_compass2 ; YES | |
| 628 | 123 btfsc compass_type1 ; compass1 ? |
| 604 | 124 bra I2C_RX_accelerometer_compass1 ; YES |
| 628 | 125 ;bra I2C_RX_accelerometer_compass0 ; NO - compass0 then |
| 126 | |
| 643 | 127 ;I2C_RX_accelerometer_compass0: |
| 656 | 128 rcall I2C_SEN ; start condition |
| 582 | 129 movlw 0x38 ; address |
| 634 | 130 rcall I2C_TX ; send byte |
| 131 movlw 0x00 ; ?? | |
| 132 rcall I2C_TX ; send byte | |
| 656 | 133 rcall I2C_RSEN ; repeated start condition |
| 582 | 134 movlw 0x39 ; address |
| 634 | 135 rcall I2C_TX ; send byte |
| 136 rcall I2C_OneByteRX ; get status byte | |
| 137 movf SSP1BUF,W ; copy status byte to WREG | |
| 158 | 138 |
| 582 | 139 ; Non-flipped screen: |
| 140 ; Chip orientation on the PCB requires | |
| 604 | 141 ; Original = corrected |
| 582 | 142 ; x = -x |
| 143 ; y = -y | |
| 144 ; z = -z | |
| 0 | 145 |
| 582 | 146 ; Flipped screen: |
| 147 ; Chip orientation on the PCB requires | |
| 604 | 148 ; Original = corrected |
| 582 | 149 ; x = x |
| 150 ; y = y | |
| 151 ; z = -z | |
|
166
30ebaf72170d
BUGFIX: Flip compass with flipped screen, too
heinrichsweikamp
parents:
158
diff
changeset
|
152 |
| 604 | 153 rcall I2C_TwoBytesRX_div16 ; get two bytes and divide /16 (signed) |
| 623 | 154 btfsc flip_screen ; 180° rotation? |
| 604 | 155 bra I2C_RX_accelerometer2 ; YES |
| 634 | 156 comf hi ; NO - 16 bit sign change |
| 157 negf lo ; - .... | |
| 158 btfsc STATUS,C ; - carry to propagate? | |
| 159 incf hi,F ; - YES - do it | |
|
166
30ebaf72170d
BUGFIX: Flip compass with flipped screen, too
heinrichsweikamp
parents:
158
diff
changeset
|
160 I2C_RX_accelerometer2: |
| 634 | 161 MOVII mpr,accel_DX ; copy result to accel_DX |
| 162 | |
| 623 | 163 rcall I2C_TwoBytesRX_div16 ; get two bytes and divide /16 (signed) |
| 164 btfsc flip_screen ; 180° rotation? | |
| 165 bra I2C_RX_accelerometer3 ; YES | |
| 634 | 166 comf hi ; NO - 16 bit sign change |
| 167 negf lo ; - ... | |
| 168 btfsc STATUS,C ; - carry to propagate? | |
| 169 incf hi,F ; YES - do it | |
| 170 I2C_RX_accelerometer3: | |
| 171 MOVII mpr,accel_DY ; copy result to accel_DY | |
| 172 | |
| 173 rcall I2C_OneByteRX ; receive 1 byte with acknowledge | |
| 174 movff SSP1BUF,hi ; copy data byte to hi | |
| 656 | 175 rcall I2C_OneByteRX_NACK ; receive last byte with not acknowledge |
| 634 | 176 movff SSP1BUF,lo ; copy data byte to lo |
| 177 rcall I2C_TwoBytesRX_div16_2 ; divide hi:lo/16 (signed) | |
| 623 | 178 comf hi ; 16 bit sign change |
| 634 | 179 negf lo ; ... |
| 623 | 180 btfsc STATUS,C ; carry to propagate? |
| 181 incf hi,F ; YES - do it | |
| 634 | 182 MOVII mpr,accel_DZ ; copy result to accel_DZ |
| 656 | 183 bra I2C_PEN ; stop condition |
| 0 | 184 |
| 185 | |
| 427 | 186 I2C_RX_accelerometer_compass1: |
| 656 | 187 rcall I2C_SEN ; start condition |
| 582 | 188 movlw 0x3C ; address |
| 634 | 189 rcall I2C_TX ; send byte |
| 582 | 190 movlw b'10101000' ; 0x28 with auto-increment (MSB=1) |
| 634 | 191 rcall I2C_TX ; send byte |
| 656 | 192 rcall I2C_RSEN ; repeated start condition |
| 582 | 193 movlw 0x3D ; address |
| 634 | 194 |
| 195 I2C_RX_accelerometer_common: ; common part for compass 1,2 and 3 | |
| 196 rcall I2C_TX ; send byte | |
| 582 | 197 |
| 198 ; Non-flipped screen: | |
| 199 ; Chip orientation on the PCB requires | |
| 200 ; Original = Corrected | |
| 201 ; x = -x (Compass 1) | |
| 202 ; x = x (Compass 2) | |
| 203 ; y = -y | |
| 204 ; z = -z | |
| 205 | |
| 206 ; Flipped screen: | |
| 207 ; Chip orientation on the PCB requires | |
| 208 ; Original = Corrected | |
| 209 ; x = x (Compass 1) | |
| 210 ; x = -x (Compass 2) | |
| 211 ; y = y | |
| 212 ; z = -z | |
| 427 | 213 |
| 582 | 214 ; Dump the accelerator data |
| 634 | 215 rcall I2C_OneByteRX ; receive 1 byte with acknowledge |
| 582 | 216 movff SSP1BUF,lo ; accel_DX+0 |
| 634 | 217 rcall I2C_OneByteRX ; receive 1 byte with acknowledge |
| 623 | 218 movff SSP1BUF,hi ; accel_DX+1 |
| 582 | 219 rcall I2C_TwoBytesRX_div16_2 ; divide lo:hi/16 (signed) only |
| 220 btfss compass_type2 ; compass 2? | |
| 623 | 221 bra I2C_RX_accelerometer1_c1 ; NO - compass 1 |
| 582 | 222 ; compass 2 |
| 623 | 223 btfss flip_screen ; 180° rotation? |
| 224 bra I2C_RX_accelerometer2_c1 ; NO - continue with normal compass1 routines for Y and Z | |
| 582 | 225 ; flipped compass 2, negate x |
| 634 | 226 comf hi ; YES - 16 bit sign change |
| 227 negf lo ; - ... | |
| 228 btfsc STATUS,C ; - carry to propagate? | |
| 229 incf hi,F ; YES - do it | |
| 230 bra I2C_RX_accelerometer2_c1 ; - continue with normal compass1 routines for Y and Z | |
| 582 | 231 |
| 232 I2C_RX_accelerometer1_c1: | |
| 623 | 233 btfsc flip_screen ; 180° rotation? |
| 234 bra I2C_RX_accelerometer2_c1 ; YES | |
| 582 | 235 ; non-flipped compass 1, negate x |
| 634 | 236 comf hi ; NO - 16 bit sign change |
| 237 negf lo ; - ... | |
| 238 btfsc STATUS,C ; - carry to propagate? | |
| 239 incf hi,F ; YES - do it | |
| 427 | 240 I2C_RX_accelerometer2_c1: |
| 582 | 241 ; flipped compass 1, non-flipped compass 2 |
| 623 | 242 MOVII mpr,accel_DX ; copy result |
| 634 | 243 rcall I2C_OneByteRX ; receive 1 byte with acknowledge |
| 244 movff SSP1BUF,lo ; copy accel_DY+0 to lo | |
| 245 rcall I2C_OneByteRX ; receive 1 byte with acknowledge | |
| 246 movff SSP1BUF,hi ; copy accel_DY+1 to hi | |
| 247 rcall I2C_TwoBytesRX_div16_2 ; divide hi:lo/16 (signed) only | |
| 623 | 248 btfsc flip_screen ; 180° rotation? |
| 249 bra I2C_RX_accelerometer3_c1 ; YES | |
| 634 | 250 comf hi ; NO - 16 bit sign change |
| 251 negf lo ; - ... | |
| 252 btfsc STATUS,C ; - carry to propagate? | |
| 253 incf hi,F ; YES - do it | |
| 427 | 254 I2C_RX_accelerometer3_c1: |
| 623 | 255 MOVII mpr,accel_DY ; copy result |
| 634 | 256 rcall I2C_OneByteRX ; receive 1 byte with acknowledge |
| 623 | 257 movff SSP1BUF,lo ; accel_DZ+0 |
| 656 | 258 rcall I2C_OneByteRX_NACK ; receive last byte with not acknowledge |
| 623 | 259 movff SSP1BUF,hi ; accel_DZ+1 |
| 656 | 260 rcall I2C_PEN ; stop condition |
| 582 | 261 rcall I2C_TwoBytesRX_div16_2 ; divide lo:hi/16 (signed) only |
| 623 | 262 comf hi ; 16 bit sign change for Z |
| 634 | 263 negf lo ; ... |
| 623 | 264 btfsc STATUS,C ; carry to propagate? |
| 265 incf hi,F ; YES - do it | |
| 266 MOVII mpr,accel_DZ ; copy result | |
| 634 | 267 return ; done |
| 268 | |
| 582 | 269 |
| 560 | 270 I2C_RX_accelerometer_compass2: |
| 656 | 271 rcall I2C_SEN ; start condition |
| 582 | 272 movlw 0x32 ; address |
| 634 | 273 rcall I2C_TX ; send byte |
| 582 | 274 movlw b'10101000' ; 0x28 with auto-increment (MSB=1) |
| 634 | 275 rcall I2C_TX ; send byte |
| 656 | 276 rcall I2C_RSEN ; repeated start condition |
| 582 | 277 movlw 0x33 ; address |
| 634 | 278 bra I2C_RX_accelerometer_common ; continue with common part |
| 624 | 279 |
| 280 I2C_RX_accelerometer_compass3: | |
| 656 | 281 rcall I2C_SEN ; start condition |
| 628 | 282 movlw 0x3A ; address |
| 634 | 283 rcall I2C_TX ; send byte |
| 628 | 284 movlw 0x28 ; 0x28 (OUT_X_L_A) |
| 634 | 285 rcall I2C_TX ; send byte |
| 656 | 286 rcall I2C_RSEN ; repeated start condition |
| 628 | 287 movlw 0x3B ; address |
| 634 | 288 bra I2C_RX_accelerometer_common ; continue with common part |
| 623 | 289 |
| 290 | |
| 634 | 291 |
| 292 ;----------------------------------------------------------------------------- | |
| 293 ; Read Compass | |
| 294 ; | |
| 623 | 295 IFDEF _compass |
| 0 | 296 |
| 582 | 297 global I2C_RX_compass |
| 0 | 298 I2C_RX_compass: |
| 628 | 299 btfsc compass_type3 ; compass 3 ? |
| 300 bra I2C_RX_compass3 ; YES | |
| 301 btfsc compass_type2 ; compass 2 ? | |
| 623 | 302 bra I2C_RX_compass2 ; YES |
| 628 | 303 btfsc compass_type1 ; compass 1 ? |
| 623 | 304 bra I2C_RX_compass1 ; YES |
| 628 | 305 ;bra I2C_RX_compass0 ; NO - compass 0 then |
| 306 | |
| 643 | 307 ;I2C_RX_compass0: |
| 656 | 308 rcall I2C_SEN ; start condition |
| 309 movlw 0x3C ; address + write bit | |
| 634 | 310 rcall I2C_TX ; send byte |
| 656 | 311 movlw 0x03 ; Point to Data Output X MSB Register (0x03) |
| 634 | 312 rcall I2C_TX ; send byte |
| 656 | 313 rcall I2C_PEN ; stop condition |
| 314 rcall I2C_SEN ; start condition | |
| 315 movlw 0x3D ; address + read bit | |
| 634 | 316 rcall I2C_TX ; send byte |
| 0 | 317 |
| 582 | 318 ; Compass IC sends data in following order: |
| 319 ; x MSB | |
| 320 ; x LSB | |
| 321 ; z MSB | |
| 322 ; z LSB | |
| 323 ; y MSB | |
| 324 ; y LSB | |
| 0 | 325 |
| 582 | 326 ; Non-flipped screen |
| 327 ; Chip orientation on the PCB requires | |
| 328 ; Original = Corrected | |
| 329 ; x = -y | |
| 330 ; z = z | |
| 331 ; y = x | |
| 0 | 332 |
| 582 | 333 ; Flipped screen |
| 334 ; Chip orientation on the PCB requires | |
| 335 ; Original = Corrected | |
| 336 ; x = y | |
| 337 ; z = z | |
| 338 ; y = -x | |
|
166
30ebaf72170d
BUGFIX: Flip compass with flipped screen, too
heinrichsweikamp
parents:
158
diff
changeset
|
339 |
| 634 | 340 rcall I2C_OneByteRX ; receive 1 byte with acknowledge |
| 623 | 341 movff SSP1BUF,compass_DY+1 ; data byte |
| 634 | 342 rcall I2C_OneByteRX ; receive 1 byte with acknowledge |
| 623 | 343 movff SSP1BUF,compass_DY+0 ; data byte |
| 344 btfsc flip_screen ; 180° rotation? | |
| 345 bra I2C_RX_compass0_2 ; NO | |
| 346 banksel compass_DY ; YES - flip Y | |
| 347 comf compass_DY+1 ; - 16 bit sign change | |
| 582 | 348 negf compass_DY+0 |
| 623 | 349 btfsc STATUS,C ; - carry to propagate? |
| 350 incf compass_DY+1,F ; YES - do it | |
| 582 | 351 banksel common |
| 623 | 352 I2C_RX_compass0_2: |
| 634 | 353 rcall I2C_OneByteRX ; receive 1 byte with acknowledge |
| 623 | 354 movff SSP1BUF,compass_DZ+1 ; data byte |
| 634 | 355 rcall I2C_OneByteRX ; receive 1 byte with acknowledge |
| 623 | 356 movff SSP1BUF,compass_DZ+0 ; data byte |
| 634 | 357 rcall I2C_OneByteRX ; receive 1 byte with acknowledge |
| 623 | 358 movff SSP1BUF,compass_DX+1 ; data byte |
| 656 | 359 rcall I2C_RCEN ; enable receive mode |
| 623 | 360 movff SSP1BUF,compass_DX+0 ; data byte |
| 656 | 361 rcall I2C_PEN ; stop condition |
| 623 | 362 btfss flip_screen ; 180° rotation? |
| 363 return ; NO - done | |
| 364 banksel compass_DX ; YES - flip X | |
| 365 comf compass_DX+1 ; - 16 bit sign change | |
| 582 | 366 negf compass_DX+0 |
| 623 | 367 btfsc STATUS,C ; - carry to propagate? |
| 368 incf compass_DX+1,F ; YES - do it | |
| 634 | 369 banksel common ; back to bank common |
| 370 return ; done | |
| 371 | |
| 582 | 372 |
| 628 | 373 I2C_RX_compass1: ; compass type 1 |
| 656 | 374 rcall I2C_SEN ; start condition |
| 582 | 375 movlw 0x3C ; address |
| 634 | 376 rcall I2C_TX ; send byte |
| 582 | 377 movlw b'10001000' ; 0x08 with auto-increment (MSB=1) |
| 634 | 378 rcall I2C_TX ; send byte |
| 656 | 379 rcall I2C_RSEN ; repeated start condition |
| 582 | 380 movlw 0x3D ; address |
| 634 | 381 rcall I2C_TX ; send byte |
| 623 | 382 ;rcall WaitMSSP ; TODO needed? (mH) |
| 634 | 383 rcall I2C_OneByteRX ; receive 1 byte with acknowledge |
| 623 | 384 movff SSP1BUF,lo ; data byte |
| 634 | 385 rcall I2C_OneByteRX ; receive 1 byte with acknowledge |
| 623 | 386 movff SSP1BUF,hi ; data byte |
| 634 | 387 rcall I2C_TwoBytesRX_div8 ; divide hi,lo by 8 (signed) |
| 388 MOVII mpr,compass_DX ; copy result | |
| 623 | 389 btfss flip_screen ; 180° rotation? |
| 390 bra I2C_RX_compass1_1 ; NO | |
| 391 banksel compass_DX ; YES - flip X | |
| 392 comf compass_DX+1 ; - 16 bit sign change | |
| 582 | 393 negf compass_DX+0 |
| 623 | 394 btfsc STATUS,C ; - carry to propagate? |
| 395 incf compass_DX+1,F ; YES - do it | |
| 582 | 396 banksel common |
| 427 | 397 I2C_RX_compass1_1: |
| 634 | 398 rcall I2C_OneByteRX ; receive 1 byte with acknowledge |
| 623 | 399 movff SSP1BUF,lo ; data byte |
| 634 | 400 rcall I2C_OneByteRX ; receive 1 byte with acknowledge |
| 623 | 401 movff SSP1BUF,hi ; data byte |
| 634 | 402 rcall I2C_TwoBytesRX_div8 ; divide hi, lo by 8 (signed) |
| 623 | 403 MOVII mpr,compass_DY |
| 404 btfss flip_screen ; 180° rotation? | |
| 405 bra I2C_RX_compass1_2 ; NO | |
| 406 banksel compass_DY ; YES - flip Y | |
| 407 comf compass_DY+1 ; - 16 bit sign change | |
| 634 | 408 negf compass_DY+0 ; - ... |
| 623 | 409 btfsc STATUS,C ; - carry to propagate? |
| 410 incf compass_DY+1,F ; YES - do it | |
| 411 banksel common | |
| 427 | 412 I2C_RX_compass1_2: |
| 634 | 413 rcall I2C_OneByteRX ; receive 1 byte with acknowledge |
| 623 | 414 movff SSP1BUF,lo ; data byte |
| 656 | 415 rcall I2C_OneByteRX_NACK ; receive last byte with not acknowledge |
| 623 | 416 movff SSP1BUF,hi ; data byte |
| 634 | 417 rcall I2C_TwoBytesRX_div8 ; divide hi, lo by 8 (signed) |
| 418 MOVII mpr,compass_DZ ; copy result | |
| 656 | 419 bra I2C_PEN ; stop condition |
| 643 | 420 |
| 560 | 421 |
| 634 | 422 |
| 628 | 423 I2C_RX_compass2: ; compass type 2 |
| 656 | 424 rcall I2C_SEN ; start condition |
| 582 | 425 movlw 0x3C ; address |
| 634 | 426 rcall I2C_TX ; send byte |
| 582 | 427 movlw 0xE8 ; 0x68 with auto-increment (MSB=1) |
| 634 | 428 rcall I2C_TX ; send byte |
| 656 | 429 rcall I2C_RSEN ; repeated start condition |
| 582 | 430 movlw 0x3D ; address |
| 634 | 431 rcall I2C_TX ; send byte |
| 628 | 432 I2C_RX_compass2_xx: ; compass 3 joins in here |
| 634 | 433 ; rcall WaitMSSP ; wait for TX to complete (not needed, as included in I2C_TX) |
| 434 rcall I2C_OneByteRX ; receive 1 byte with acknowledge | |
| 623 | 435 movff SSP1BUF,lo ; data byte |
| 634 | 436 rcall I2C_OneByteRX ; receive 1 byte with acknowledge |
| 623 | 437 movff SSP1BUF,hi ; data byte |
| 634 | 438 ; rcall I2C_TwoBytesRX_div8 ; divide hi, lo by 8 (signed) |
| 623 | 439 btfsc flip_screen ; 180° rotation? |
| 440 bra I2C_RX_compass2_1 ; YES - do nothing with X | |
| 441 ; NO - flip X | |
| 442 comf hi ; - 16 bit sign change | |
| 634 | 443 negf lo ; - ... |
| 623 | 444 btfsc STATUS,C ; - carry to propagate? |
| 445 incf hi,F ; YES - do it | |
| 582 | 446 I2C_RX_compass2_1: |
| 623 | 447 MOVII mpr,compass_DX |
| 634 | 448 rcall I2C_OneByteRX ; receive 1 byte with acknowledge |
| 623 | 449 movff SSP1BUF,lo ; data byte |
| 634 | 450 rcall I2C_OneByteRX ; receive 1 byte with acknowledge |
| 623 | 451 movff SSP1BUF,hi ; data byte |
| 634 | 452 ; rcall I2C_TwoBytesRX_div8 ; divide hi, lo by 8 (signed) |
| 623 | 453 btfss flip_screen ; 180° rotation? |
| 454 bra I2C_RX_compass2_2 ; NO - do nothing with Y | |
| 455 ; YES - flip Y | |
| 456 comf hi ; - 16 bit sign change | |
| 634 | 457 negf lo ; - ... |
| 623 | 458 btfsc STATUS,C ; - carry to propagate? |
| 459 incf hi,F ; YES - do it | |
| 460 I2C_RX_compass2_2: | |
| 461 MOVII mpr,compass_DY | |
| 634 | 462 rcall I2C_OneByteRX ; receive 1 byte with acknowledge |
| 623 | 463 movff SSP1BUF,lo ; data byte |
| 656 | 464 rcall I2C_OneByteRX_NACK ; receive last byte with not acknowledge |
| 623 | 465 movff SSP1BUF,hi ; data byte |
| 634 | 466 ; rcall I2C_TwoBytesRX_div8 ; divide hi, lo by 8 (signed) |
| 467 MOVII mpr,compass_DZ ; copy result | |
| 656 | 468 bra I2C_PEN ; stop condition |
| 643 | 469 |
| 582 | 470 |
| 634 | 471 |
| 628 | 472 I2C_RX_compass3: ; compass type 3 |
| 656 | 473 rcall I2C_SEN ; start condition |
| 628 | 474 movlw 0x3C ; address |
| 634 | 475 rcall I2C_TX ; send byte |
| 628 | 476 movlw 0xA8 ; 0x28 with auto-increment (MSB=1) |
| 634 | 477 rcall I2C_TX ; send byte |
| 656 | 478 rcall I2C_RSEN ; repeated start condition |
| 628 | 479 movlw 0x3D ; address |
| 634 | 480 rcall I2C_TX ; send byte |
| 628 | 481 bra I2C_RX_compass2_xx ; join with compass 2 code |
| 624 | 482 |
| 623 | 483 ENDIF ; _compass |
| 484 | |
| 634 | 485 |
| 623 | 486 ;----------------------------------------------------------------------------- |
| 634 | 487 ; Initialize Compass / Accelerometer Chip |
| 488 ; | |
| 582 | 489 global I2C_init_compass |
| 0 | 490 I2C_init_compass: |
| 656 | 491 bsf compass_present ; Set global compass flag |
| 634 | 492 bsf compass_enabled ; flag compass will be enabled |
| 493 bcf compass_type2 ; clear in preparation of chip detection | |
| 494 bcf compass_type3 ; ... | |
| 623 | 495 |
| 628 | 496 ; probe for compass 3 |
| 656 | 497 rcall I2C_SEN ; start condition |
| 628 | 498 movlw 0x3A ; address byte + write bit |
| 582 | 499 movwf SSP1BUF ; control byte |
| 634 | 500 rcall WaitMSSP ; wait for TX to complete |
| 656 | 501 ; we need the ACKSTAT bit! Do not use I2C_TX routine here which might reset this bit! |
| 634 | 502 btfss SSP1CON2,ACKSTAT ; ACK received? |
| 503 bsf compass_type3 ; YES - ACK was send, compass 3 found | |
| 656 | 504 rcall I2C_PEN ; stop condition |
| 628 | 505 |
| 506 btfsc compass_type3 ; compass 3 found? | |
| 507 bra I2C_init_compass3 ; YES - initialize compass 3 | |
| 508 | |
| 509 ; probe for compass 2 | |
| 656 | 510 rcall I2C_SEN ; start condition |
| 628 | 511 movlw 0x32 ; address byte + write bit |
| 512 movwf SSP1BUF ; control byte | |
| 634 | 513 rcall WaitMSSP ; wait for TX to complete |
| 656 | 514 ; we need the ACKSTAT bit! Do not use I2C_TX routine here which might reset this bit! |
| 515 btfss SSP1CON2,ACKSTAT ; ACK received? | |
| 634 | 516 bsf compass_type2 ; YES - ACK send, compass 2 found |
| 656 | 517 rcall I2C_PEN ; stop condition |
| 623 | 518 |
| 628 | 519 btfsc compass_type2 ; compass 2 found? |
| 520 bra I2C_init_compass2 ; YES - initialize compass 2 | |
| 521 | |
| 656 | 522 ; probe for compass 1 |
| 634 | 523 bsf compass_type1 ; assume compass 1 by default |
| 656 | 524 rcall I2C_SEN ; start condition |
| 582 | 525 movlw 0x3C ; address |
| 634 | 526 rcall I2C_TX ; send byte |
| 527 movlw 0x0F ; ?? | |
| 528 rcall I2C_TX ; send byte | |
| 656 | 529 rcall I2C_PEN ; stop condition |
| 530 rcall I2C_SEN ; start condition | |
| 582 | 531 movlw 0x3D ; address |
| 634 | 532 rcall I2C_TX ; send byte |
| 533 rcall I2C_OneByteRX ; receive 1 byte with acknowledge | |
| 628 | 534 movlw 0x49 ; 0x49 = compass 1 |
| 634 | 535 cpfseq SSP1BUF ; 0x49 received? |
| 536 bcf compass_type1 ; NO - clear flag for compass 1 | |
| 656 | 537 rcall I2C_PEN ; stop condition |
| 582 | 538 |
| 628 | 539 btfsc compass_type1 ; compass 1 found? |
| 540 bra I2C_init_compass1 ; YES - initialize compass 1 | |
| 656 | 541 |
| 542 ; probe for compass 0 | |
| 543 bsf compass_type0 ; assume compass 0 by default | |
| 544 rcall I2C_SEN ; start condition | |
| 545 movlw 0x3C ; address + write bit | |
| 546 rcall I2C_TX ; send byte | |
| 547 movlw 0x0A ; Point to Identification Register A | |
| 548 rcall I2C_TX ; send byte | |
| 549 rcall I2C_PEN ; stop condition | |
| 550 rcall I2C_SEN ; start condition | |
| 551 movlw 0x3D ; address + read bit | |
| 552 rcall I2C_TX ; send byte | |
| 553 rcall I2C_OneByteRX ; receive 1 byte with acknowledge | |
| 554 movlw b'01001000' ; Identification Register A must be "H" | |
| 555 cpfseq SSP1BUF ; Compare with received value | |
| 556 bcf compass_type0 ; Not equal -> Not compass 0 | |
| 557 rcall I2C_PEN ; stop condition | |
| 558 | |
| 559 btfsc compass_type0 ; compass 0 found? | |
| 560 bra I2C_init_compass0 ; YES - initialize compass 0 | |
| 561 ; ; no compass of any type found | |
| 562 bcf compass_present ; Delete global compass flag | |
| 563 return | |
| 628 | 564 |
| 634 | 565 |
| 628 | 566 I2C_init_compass0: |
| 567 ; magnetic | |
| 656 | 568 rcall I2C_SEN ; start condition |
| 582 | 569 movlw 0x3C ; address |
| 634 | 570 rcall I2C_TX ; send byte |
| 571 movlw 0x00 ; ?? | |
| 572 rcall I2C_TX ; send byte | |
| 623 | 573 movlw b'01101000' ; ConfigA: 3 Hz, 8 samples averaged |
| 634 | 574 rcall I2C_TX ; send byte |
| 623 | 575 movff opt_compass_gain,i2c_temp1 ; 0-7 (230 LSB/Gauss to 1370 LSB/Gauss) |
| 634 | 576 swapf i2c_temp1,F ; |
| 577 comf i2c_temp1,F ; | |
| 578 bcf STATUS,C ; | |
| 579 rlcf i2c_temp1 ; | |
| 580 movf i2c_temp1,W ; | |
| 581 rcall I2C_TX ; send byte | |
| 582 movlw b'00000000' ; select continuous mode | |
| 583 rcall I2C_TX ; send byte | |
| 656 | 584 rcall I2C_PEN ; stop condition |
| 634 | 585 |
| 628 | 586 ; accelerometer |
| 631 | 587 rcall I2C_sleep_accelerometer0 ; registers can only be changed in standby mode |
| 628 | 588 |
| 656 | 589 rcall I2C_SEN ; start condition |
| 628 | 590 movlw 0x38 ; address |
| 634 | 591 rcall I2C_TX ; send byte |
| 628 | 592 movlw 0x0E ; XYZ_DATA_CFG |
| 634 | 593 rcall I2C_TX ; send byte |
| 628 | 594 movlw b'00000000' ; high pass filter = 0, +/- 2 g range |
| 634 | 595 rcall I2C_TX ; send byte |
| 656 | 596 rcall I2C_PEN ; stop condition |
| 597 rcall I2C_SEN ; start condition | |
| 628 | 598 movlw 0x38 ; address |
| 634 | 599 rcall I2C_TX ; send byte |
| 628 | 600 movlw 0x2A ; CTRL_REG1 |
| 634 | 601 rcall I2C_TX ; send byte |
| 628 | 602 ; movlw b'00110000' ; CTRL_REG1: 160 ms data rate, standby mode |
| 603 movlw b'00110100' ; CTRL_REG1: 160 ms data rate, standby mode, reduced noise mode | |
| 634 | 604 rcall I2C_TX ; send byte |
| 628 | 605 movlw b'00000010' ; CTRL_REG2: high-res in active mode |
| 634 | 606 rcall I2C_TX ; send byte |
| 656 | 607 rcall I2C_PEN ; stop condition |
| 628 | 608 |
| 656 | 609 rcall I2C_SEN ; start condition |
| 628 | 610 movlw 0x38 ; address |
| 634 | 611 rcall I2C_TX ; send byte |
| 628 | 612 movlw 0x2A ; CTRL_REG1 |
| 634 | 613 rcall I2C_TX ; send byte |
| 628 | 614 ; movlw b'00110001' ; CTRL_REG1: 160 ms data rate, active mode |
| 615 movlw b'00110101' ; CTRL_REG1: 160 ms data rate, standby mode, reduced noise mode, active Mode | |
| 634 | 616 rcall I2C_TX ; send byte |
| 656 | 617 bra I2C_PEN ; stop condition |
| 643 | 618 |
| 0 | 619 |
| 628 | 620 |
| 427 | 621 I2C_init_compass1: |
| 656 | 622 rcall I2C_SEN ; start condition |
| 582 | 623 movlw 0x3C ; address |
| 634 | 624 rcall I2C_TX ; send byte |
| 582 | 625 movlw 0x9F ; 1F with auto-increment (MSB=1) |
| 634 | 626 rcall I2C_TX ; send byte |
| 582 | 627 movlw b'00000000' ; CTRL0 |
| 634 | 628 rcall I2C_TX ; send byte |
| 623 | 629 movlw b'00101111' ; CTRL1 (6.25 Hz, BDU=0, x,y,z = ON) |
| 634 | 630 rcall I2C_TX ; send byte |
| 623 | 631 movlw b'11000000' ; CTRL2 (50 Hz, +/- 2g) |
| 634 | 632 rcall I2C_TX ; send byte |
| 582 | 633 movlw b'00000000' ; CTRL3 |
| 634 | 634 rcall I2C_TX ; send byte |
| 582 | 635 movlw b'00000000' ; CTRL4 |
| 634 | 636 rcall I2C_TX ; send byte |
| 623 | 637 movlw b'01100100' ; CTRL5 HIGH res, 6.25 Hz |
| 634 | 638 rcall I2C_TX ; send byte |
| 623 | 639 movff opt_compass_gain,i2c_temp1 ; 0-7 (230 LSB/Gauss to 1370 LSB/Gauss) |
| 640 movlw b'01100000' ; CTRL6 Full scale (+/-12 Gauss -> 2730 LSB/Gauss) | |
| 582 | 641 dcfsnz i2c_temp1,F ; = 1? |
| 623 | 642 movlw b'01100000' ; YES - CTRL6 Full scale (+/-12 Gauss -> 2730 LSB/Gauss) |
| 582 | 643 dcfsnz i2c_temp1,F ; = 2? |
| 623 | 644 movlw b'01000000' ; YES - CTRL6 (+/-8 Gauss) |
| 582 | 645 dcfsnz i2c_temp1,F ; = 3? |
| 623 | 646 movlw b'01000000' ; YES - CTRL6 (+/-8 Gauss) |
| 582 | 647 dcfsnz i2c_temp1,F ; = 4? |
| 623 | 648 movlw b'00100000' ; YES - CTRL6 (+/-4 Gauss) |
| 582 | 649 dcfsnz i2c_temp1,F ; = 5? |
| 623 | 650 movlw b'00100000' ; YES - CTRL6 (+/-4 Gauss) |
| 582 | 651 dcfsnz i2c_temp1,F ; = 6? |
| 623 | 652 movlw b'00000000' ; YES - CTRL6 (+/-2 Gauss) |
| 582 | 653 dcfsnz i2c_temp1,F ; = 7? |
| 623 | 654 movlw b'00000000' ; YES - CTRL6 (+/-2 Gauss) |
| 634 | 655 rcall I2C_TX ; send byte |
| 582 | 656 movlw b'00000000' ; CTRL7 Continuous Mode |
| 634 | 657 rcall I2C_TX ; send byte |
| 656 | 658 bra I2C_PEN ; stop condition |
| 634 | 659 |
| 660 ; accelerometer initializes along with magnetic sensor | |
| 661 | |
| 582 | 662 |
| 560 | 663 I2C_init_compass2: |
| 628 | 664 ; magnetic |
| 656 | 665 rcall I2C_SEN ; start condition |
| 634 | 666 movlw 0x3C ; address |
| 667 rcall I2C_TX ; send byte | |
| 668 movlw 0xE0 ; 0x60 with auto-increment (MSB=1) | |
| 669 rcall I2C_TX ; send byte | |
| 670 movlw b'10000000' ; CFG_REG_A_M (10Hz, Continuous) 0x60 0x00 | |
| 671 rcall I2C_TX ; send byte | |
| 672 movlw b'00000011' ; CFG_REG_B_M (low-pass filter enabled) 0x61 (set pulse is released every 63 ODR) | |
| 673 rcall I2C_TX ; send byte | |
| 674 movlw b'00010000' ; CFG_REG_C_M BDU=1 0x62 0x57 | |
| 675 rcall I2C_TX ; send byte | |
| 656 | 676 rcall I2C_PEN ; stop condition |
| 634 | 677 |
| 628 | 678 ; accelerometer |
| 656 | 679 rcall I2C_SEN ; start condition |
| 628 | 680 movlw 0x32 ; address |
| 634 | 681 rcall I2C_TX ; send byte |
| 628 | 682 movlw 0x9F ; 1F with auto-increment (MSB=1) |
| 634 | 683 rcall I2C_TX ; send byte |
| 628 | 684 movlw b'00000000' ; TEMP_CFG_REG_A (Temp sensor off) |
| 634 | 685 rcall I2C_TX ; send byte |
| 628 | 686 movlw b'00100111' ; CTRL_REG1_A (10Hz, x,y,z = ON) |
| 634 | 687 rcall I2C_TX ; send byte |
| 628 | 688 movlw b'00000000' ; CTRL_REG2_A |
| 634 | 689 rcall I2C_TX ; send byte |
| 628 | 690 movlw b'00000000' ; CTRL_REG3_A |
| 634 | 691 rcall I2C_TX ; send byte |
| 628 | 692 movlw b'00001000' ; CTRL_REG4_A (BDU=0, +/-2g, HR=1) |
| 634 | 693 rcall I2C_TX ; send byte |
| 628 | 694 ; movlw b'00000000' ; CTRL_REG5_A |
| 634 | 695 ; rcall I2C_TX ; send byte |
| 656 | 696 bra I2C_PEN ; stop condition |
| 582 | 697 |
| 628 | 698 |
| 624 | 699 I2C_init_compass3: |
| 628 | 700 ; magnetic |
| 656 | 701 rcall I2C_SEN ; start condition |
| 631 | 702 movlw 0x3C ; address |
| 634 | 703 rcall I2C_TX ; send byte |
| 631 | 704 movlw 0xA0 ; 0x20 with auto-increment (MSB=1) |
| 634 | 705 rcall I2C_TX ; send byte |
| 645 | 706 movlw b'01110000' ; CTRL_REG1_M (10Hz, X and Y in Ultra-high performance mode) 0x20 |
| 634 | 707 rcall I2C_TX ; send byte |
| 631 | 708 movlw b'01100000' ; CTRL_REG2_M (Full-scale: +/- 16gauss) 0x21 |
| 634 | 709 rcall I2C_TX ; send byte |
| 631 | 710 movlw b'01000000' ; CTRL_REG3_M (Continuous) 0x22 |
| 634 | 711 rcall I2C_TX ; send byte |
| 645 | 712 movlw b'00001100' ; CTRL_REG4_M (Z in Ultra-high performance mode) 0x23 |
| 634 | 713 rcall I2C_TX ; send byte |
| 631 | 714 movlw b'00000000' ; CTRL_REG5_M 0x24 |
| 634 | 715 rcall I2C_TX ; send byte |
| 631 | 716 movlw b'00000000' ; CTRL_REG5_M 0x24 |
| 634 | 717 rcall I2C_TX ; send byte |
| 656 | 718 rcall I2C_PEN ; stop condition |
| 631 | 719 |
| 628 | 720 ;accelerometer |
| 656 | 721 rcall I2C_SEN ; start condition |
| 631 | 722 movlw 0x3A ; address |
| 634 | 723 rcall I2C_TX ; send byte |
| 628 | 724 movlw 0x20 |
| 634 | 725 rcall I2C_TX ; send byte |
| 631 | 726 movlw b'10010111' ; CTRL_REG1_A (100Hz, x,y,z = ON, BDU=OFF) 0x20 |
| 634 | 727 rcall I2C_TX ; send byte |
| 631 | 728 movlw b'00000000' ; CTRL_REG2_A 0x21 |
| 634 | 729 rcall I2C_TX ; send byte |
| 631 | 730 movlw b'00000000' ; CTRL_REG3_A 0x22 |
| 634 | 731 rcall I2C_TX ; send byte |
| 631 | 732 movlw b'11001100' ; CTRL_REG4_A 0x23 |
| 634 | 733 rcall I2C_TX ; send byte |
| 656 | 734 bra I2C_PEN ; stop condition |
| 735 | |
| 628 | 736 |
| 656 | 737 |
| 634 | 738 ;----------------------------------------------------------------------------- |
| 739 ; Deactivate Compass / Accelerometer | |
| 740 ; | |
| 582 | 741 global I2C_sleep_compass |
| 0 | 742 I2C_sleep_compass: |
| 628 | 743 btfss compass_enabled ; compass active? |
| 634 | 744 return ; NO - done |
| 623 | 745 bcf compass_enabled |
| 628 | 746 btfsc compass_type3 ; compass 3 ? |
| 624 | 747 bra I2C_sleep_compass3 ; YES |
| 628 | 748 btfsc compass_type2 ; compass 2 ? |
| 623 | 749 bra I2C_sleep_compass2 ; YES |
| 628 | 750 btfsc compass_type1 ; compass 1 ? |
| 623 | 751 bra I2C_sleep_compass1 ; YES |
| 628 | 752 ;bra I2C_sleep_compass0 ; NO - must be compass 0 then |
| 753 | |
| 634 | 754 |
| 560 | 755 I2C_sleep_compass0: |
| 628 | 756 ; magnetic |
| 656 | 757 rcall I2C_SEN ; start condition |
| 582 | 758 movlw 0x3C ; address |
| 634 | 759 rcall I2C_TX ; send byte |
| 760 movlw 0x00 ; ?? | |
| 761 rcall I2C_TX ; send byte | |
| 582 | 762 movlw b'01101000' ; ConfigA |
| 634 | 763 rcall I2C_TX ; send byte |
| 582 | 764 movlw b'00100000' ; ConfigB |
| 634 | 765 rcall I2C_TX ; send byte |
| 623 | 766 movlw b'00000010' ; idle mode |
| 634 | 767 rcall I2C_TX ; send byte |
| 656 | 768 rcall I2C_PEN ; stop condition |
| 631 | 769 |
| 634 | 770 I2C_sleep_accelerometer0: |
| 628 | 771 ; accelerometer |
| 656 | 772 rcall I2C_SEN ; start condition |
| 628 | 773 movlw 0x38 ; address |
| 634 | 774 rcall I2C_TX ; send byte |
| 628 | 775 movlw 0x2A ; CTRL_REG1 |
| 634 | 776 rcall I2C_TX ; send byte |
| 628 | 777 movlw b'00000000' ; standby mode |
| 634 | 778 rcall I2C_TX ; send byte |
| 656 | 779 bra I2C_PEN ; stop condition |
| 634 | 780 |
| 0 | 781 |
| 427 | 782 I2C_sleep_compass1: |
| 656 | 783 rcall I2C_SEN ; start condition |
| 582 | 784 movlw 0x3C ; address |
| 634 | 785 rcall I2C_TX ; send byte |
| 582 | 786 movlw 0x20 ; CTRL_REG1 |
| 634 | 787 rcall I2C_TX ; send byte |
| 623 | 788 movlw b'00000000' ; data for CTRL_REG1: acceleration sensor power-down mode |
| 634 | 789 rcall I2C_TX ; send byte |
| 656 | 790 rcall I2C_PEN ; stop condition |
| 791 rcall I2C_SEN ; start condition | |
| 582 | 792 movlw 0x3C ; address |
| 634 | 793 rcall I2C_TX ; send byte |
| 582 | 794 movlw 0x26 ; CTRL_REG7 |
| 634 | 795 rcall I2C_TX ; send byte |
| 623 | 796 movlw b'00000010' ; data for CTRL_REG7: magnetic sensor power-down mode |
| 634 | 797 rcall I2C_TX ; send byte |
| 656 | 798 bra I2C_PEN ; stop condition |
| 634 | 799 |
| 800 ; accelerometer sleeps with magnetic sensor | |
| 631 | 801 |
| 560 | 802 |
| 803 I2C_sleep_compass2: | |
| 623 | 804 ; magnetic |
| 656 | 805 rcall I2C_SEN ; start condition |
| 623 | 806 movlw 0x3C ; address |
| 634 | 807 rcall I2C_TX ; send byte |
| 623 | 808 movlw 0xE0 ; 0x60 with auto-increment (MSB=1) |
| 634 | 809 rcall I2C_TX ; send byte |
| 623 | 810 movlw b'00000011' ; CFG_REG_A_M 0x60 (idle mode)) |
| 634 | 811 rcall I2C_TX ; send byte |
| 623 | 812 movlw b'00000100' ; CFG_REG_B_M 0x61 (set pulse is released only at power-on after PD condition) |
| 634 | 813 rcall I2C_TX ; send byte |
| 623 | 814 movlw b'01010001' ; CFG_REG_C_M 0x62 |
| 634 | 815 rcall I2C_TX ; send byte |
| 623 | 816 movlw b'00000000' ; INT_CTRL_REG_M 0x63 |
| 634 | 817 rcall I2C_TX ; send byte |
| 656 | 818 rcall I2C_PEN ; stop condition |
| 582 | 819 |
| 623 | 820 ; accelerometer |
| 656 | 821 rcall I2C_SEN ; start condition |
| 623 | 822 movlw 0x32 ; address |
| 634 | 823 rcall I2C_TX ; send byte |
| 623 | 824 movlw 0x9F ; 1F with auto-increment (MSB=1) |
| 634 | 825 rcall I2C_TX ; send byte |
| 623 | 826 movlw b'00000000' ; TEMP_CFG_REG_A 0x1F (temp sensor off) |
| 634 | 827 rcall I2C_TX ; send byte |
| 623 | 828 movlw b'00000000' ; CTRL_REG1_A 0x20 (all off) |
| 634 | 829 rcall I2C_TX ; send byte |
| 656 | 830 bra I2C_PEN ; stop condition |
| 634 | 831 |
| 623 | 832 |
| 628 | 833 I2C_sleep_compass3: |
| 834 ; magnetic | |
| 656 | 835 rcall I2C_SEN ; start condition |
| 628 | 836 movlw 0x3C ; address |
| 634 | 837 rcall I2C_TX ; send byte |
| 628 | 838 movlw 0xA2 ; 0x22 with auto-increment (MSB=1) |
| 634 | 839 rcall I2C_TX ; send byte |
| 628 | 840 movlw b'01000010' ; CTRL_REG3_M (power-down) 0x22 |
| 634 | 841 rcall I2C_TX ; send byte |
| 656 | 842 rcall I2C_PEN ; stop condition |
| 628 | 843 |
| 844 ; accelerometer | |
| 656 | 845 rcall I2C_SEN ; start condition |
| 628 | 846 movlw 0x3A ; address |
| 634 | 847 rcall I2C_TX ; send byte |
| 624 | 848 movlw 0x20 |
| 634 | 849 rcall I2C_TX ; send byte |
| 628 | 850 movlw b'00000000' ; CTRL_REG1_A (100Hz, x,y,z = OFF) 0x20 |
| 634 | 851 rcall I2C_TX ; send byte |
| 656 | 852 bra I2C_PEN ; stop condition |
| 853 | |
| 854 | |
| 855 ;----------------------------------------------------------------------------- | |
| 856 ; Helper Function - receive 1 Byte with Not-Acknowledge | |
| 857 ; | |
| 858 I2C_OneByteRX_NACK: | |
| 859 rcall I2C_RCEN ; enable receive mode | |
| 860 bsf SSP1CON2,ACKDT ; set ACKDT flag | |
| 861 rcall I2C_ACKEN ; send master acknowledge | |
| 862 bcf SSP1CON2,ACKDT ; reset ACKDT flag | |
| 863 return | |
| 634 | 864 |
| 0 | 865 |
| 634 | 866 ;----------------------------------------------------------------------------- |
| 656 | 867 ; Helper Function - receive 1 Byte with Acknowledge |
| 868 ; | |
| 869 I2C_OneByteRX: | |
| 870 rcall I2C_RCEN ; enable receive mode | |
| 871 bra I2C_ACKEN ; send master acknowledge | |
| 872 | |
| 873 ;----------------------------------------------------------------------------- | |
| 874 ; Helper Function - send 1 Byte, wait for end of transmission and check ackn | |
| 875 ; add WREG to checksum byte first | |
| 876 I2C_TX_CHKSUM: | |
| 877 addwf sub_a+0,F ; add to checksum | |
| 878 ; bra I2C_TX | |
| 879 ;----------------------------------------------------------------------------- | |
| 880 ; Helper Function - send 1 Byte, wait for end of transmission and check ackn | |
| 881 ; | |
| 882 I2C_TX: | |
| 883 movwf SSP1BUF ; put byte to be sent into TX buffer | |
| 884 btfss i2c_error_flag_lock ; vault in use already? | |
| 885 movff WREG,i2c_error_vault+0 ; NO, Store address | |
| 886 rcall WaitMSSP ; wait for TX to complete | |
| 887 bra I2C_Check_ACK ; check for acknowledge by receiver and return | |
| 888 | |
| 889 | |
| 890 ;----------------------------------------------------------------------------- | |
| 891 ; Helper Function - I2C Start Condition | |
| 892 ; | |
| 893 I2C_SEN: | |
| 894 bsf SSP1CON2,SEN ; start condition | |
| 895 bra WaitMSSP ; wait for TX to complete (And return) | |
| 896 | |
| 897 ;----------------------------------------------------------------------------- | |
| 898 ; Helper Function - I2C Repeated Start Condition | |
| 899 ; | |
| 900 I2C_RSEN: | |
| 901 bsf SSP1CON2,RSEN ; repeated start condition | |
| 902 bra WaitMSSP ; wait for TX to complete (And return) | |
| 903 | |
| 904 | |
| 905 ;----------------------------------------------------------------------------- | |
| 906 ; Helper Function - I2C Stop Condition | |
| 907 ; | |
| 908 I2C_PEN: | |
| 909 bsf SSP1CON2,PEN ; stop condition | |
| 910 rcall WaitMSSP ; wait for TX to complete (And return) | |
| 911 I2C_WAIT_100US: | |
| 912 ; add ~100µs bus free time (min. 66µs recommended for LTC2959) | |
| 913 ; Remark: not exact: 122µs +/- 30.5 µs + worst case ISR latency | |
| 914 setf TMR5H ; initialize timer 5, high byte first | |
| 915 movlw .255-.4 ; 4 x 31.5 µs = 126µs, min: 94,5µs | |
| 916 movwf TMR5L ; initialize timer 5, low byte thereafter | |
| 917 bcf PIR5,TMR5IF ; clear timer 5 overrun flag | |
| 918 I2C_PEN_Loop: | |
| 919 btfss PIR5,TMR5IF ; did timer 5 overrun? | |
| 920 bra I2C_PEN_Loop ; NO - repeat inner loop | |
| 921 return | |
| 922 | |
| 923 ;----------------------------------------------------------------------------- | |
| 924 ; Helper Function - Master Acknowledge | |
| 925 ; | |
| 926 I2C_ACKEN: | |
| 927 bsf SSP1CON2,ACKEN ; master acknowledge | |
| 928 bra WaitMSSP ; wait for TX to complete (And return) | |
| 929 | |
| 930 ;----------------------------------------------------------------------------- | |
| 931 ; Helper Function - Enable reeive mode | |
| 932 ; | |
| 933 I2C_RCEN: | |
| 934 bsf SSP1CON2,RCEN ; enable receive mode | |
| 935 bra WaitMSSP ; wait for TX to complete (And return) | |
| 936 | |
| 937 ;----------------------------------------------------------------------------- | |
| 634 | 938 ; Helper Function - wait for TX to complete |
| 939 ; | |
| 615 | 940 WaitMSSP: |
| 656 | 941 btfss i2c_error_flag_lock ; vault in use already? |
| 942 movff SSP1BUF,i2c_error_vault+1 ; NO, store value | |
| 943 btfss i2c_error_flag_lock ; vault in use already? | |
| 944 movff SSP1CON2,i2c_error_vault+2 ; NO, store value | |
| 634 | 945 clrf i2c_temp1 ; wait for max 256 loops |
| 946 WaitMSSP_loop: | |
| 947 decfsz i2c_temp1,F ; decrement loop counter, timeout? | |
| 948 bra WaitMSSP2 ; NO | |
| 949 bra I2CFail ; YES | |
| 615 | 950 WaitMSSP2: |
| 634 | 951 btfss PIR1,SSP1IF ; TX completed? |
| 952 bra WaitMSSP_loop ; NO - loop | |
| 953 bcf PIR1,SSP1IF ; YES - clear TX completion flag | |
| 954 return ; - done | |
| 955 | |
| 615 | 956 |
| 634 | 957 ;----------------------------------------------------------------------------- |
| 650 | 958 ; Helper Function - Master NOT acknowledge and Stop |
| 959 ; | |
| 960 I2C_MasterNotAckStop: | |
| 961 bsf SSP1CON2,ACKDT ; set ACKDT flag | |
| 656 | 962 rcall I2C_ACKEN ; send master NOT acknowledge |
| 650 | 963 bcf SSP1CON2,ACKDT ; reset ACKDT flag |
| 964 | |
| 656 | 965 bra I2C_PEN ; stop condition |
| 650 | 966 |
| 967 ;----------------------------------------------------------------------------- | |
| 634 | 968 ; Helper Function - check for Acknowledge by Receiver |
| 969 ; | |
| 970 I2C_Check_ACK: | |
| 628 | 971 btfss SSP1CON2,ACKSTAT ; ACK received from slave? |
| 634 | 972 return ; YES - done |
| 973 ;bra I2CFail ; NO - do some clean up | |
| 974 | |
| 975 | |
| 976 ;----------------------------------------------------------------------------- | |
| 977 ; Helper Function - clean up I2C Interface after missing Acknowledge | |
| 978 ; | |
| 979 I2CFail: | |
| 980 bsf active_reset_ostc_rx ; reset RX circuitry (which may be the cause for the hang up) | |
| 981 rcall I2CReset ; reset I2C | |
| 982 bcf PIR1,SSP1IF ; clear TX completion flag | |
| 983 bsf i2c_error_flag ; set error flag | |
| 656 | 984 bsf i2c_error_flag_lock ; lock the error vault |
| 634 | 985 bcf active_reset_ostc_rx ; release reset from RX circuitry |
| 643 | 986 ; bcf i2c_busy_temperature |
| 987 ; bcf i2c_busy_pressure | |
| 634 | 988 return ; done |
| 615 | 989 |
| 634 | 990 |
| 991 ;----------------------------------------------------------------------------- | |
| 992 ; Helper Function - Reset I2C Module | |
| 993 ; | |
| 994 ; recover in case something went wrong, i.g. slave holds SDA low | |
| 995 ; | |
| 656 | 996 global I2CReset |
| 634 | 997 I2CReset: |
| 998 clrf SSP1CON1 ; reset entire module | |
| 999 clrf SSP1CON2 ; ... | |
| 1000 clrf SSP1STAT ; ... | |
| 657 | 1001 bcf TRISC,3 ; SCL as OUTPUT |
| 1002 bsf TRISC,4 ; SDA as input | |
| 1003 bcf PORTC,3 ; SCL = 0 | |
| 634 | 1004 movlw d'9' ; clock-out 9 clock cycles manually |
| 1005 movwf i2c_temp1 ; ... | |
| 615 | 1006 I2CReset_1: |
| 657 | 1007 bsf PORTC,3 ; SCL = 1 |
| 1008 nop ; pause for 4 CPU cycles | |
| 1009 nop ; ... | |
| 1010 nop ; ... | |
| 1011 nop ; ... | |
| 615 | 1012 btfsc PORTC,4 ; SDA = 1 ? |
| 657 | 1013 bra I2CReset_2 ; YES - SDA has been released from slave |
| 1014 bcf PORTC,3 ; NO - set SCL = 0 | |
| 1015 nop ; - pause for 2 CPU cycles | |
| 1016 nop ; - ... | |
| 1017 bcf PORTC,3 ; - SCL = 0 | |
| 1018 nop ; - pause for 2 CPU cycles | |
| 1019 nop ; - ... | |
| 634 | 1020 decfsz i2c_temp1,F ; - clock counter, all cycles done? |
| 657 | 1021 bra I2CReset_1 ; NO - loop |
| 615 | 1022 I2CReset_2: |
| 657 | 1023 bsf TRISC,3 ; SCL as input |
| 634 | 1024 clrf SSP1CON1 ; setup I2C mode |
| 656 | 1025 rcall I2C_WAIT_100US ; ISR-Safe 100µs wait |
| 634 | 1026 movlw b'00000000' ; enable slew rate control |
| 1027 movwf SSP1STAT ; ... | |
| 1028 movlw b'00101000' ; configure I2C module | |
| 1029 movwf SSP1CON1 ; ... | |
| 1030 movlw b'00000000' ; ... | |
| 1031 movwf SSP1CON2 ; ... | |
| 643 | 1032 movlw i2c_speed_value |
| 634 | 1033 movwf SSP1ADD ; ... |
| 656 | 1034 rcall I2C_WAIT_100US ; ISR-Safe 100µs wait |
| 657 | 1035 banksel i2c_error_counter |
| 656 | 1036 movlw .1 |
| 657 | 1037 addwf i2c_error_counter+0,F |
| 656 | 1038 movlw .0 |
| 657 | 1039 addwfc i2c_error_counter+1,F ; +1 on the error counter |
| 1040 banksel common | |
| 656 | 1041 btfss press_sensor_type ; =1: pressure sensor MS5837, =0: Pressure sensor MS5541 |
| 1042 return ; MS5541, Done. | |
| 657 | 1043 btfss i2c_reinit_sensor2 ; Sensor ok? |
| 1044 return ; Yes, Done. | |
| 656 | 1045 ; reset the sensor |
| 1046 rcall I2C_SEN ; start condition | |
| 1047 movlw 0xEC ; address byte + write bit | |
| 1048 rcall I2C_TX ; send byte | |
| 1049 movlw 0x1E | |
| 1050 rcall I2C_TX ; send byte | |
| 1051 rcall I2C_PEN ; stop condition | |
| 657 | 1052 movlw .50 |
| 1053 movwf i2c_temp1 | |
| 1054 I2CReset_3: | |
| 1055 rcall I2C_WAIT_100US ; ISR-Safe 100µs wait | |
| 1056 decfsz i2c_temp1,F | |
| 1057 bra I2CReset_3 ; ~5ms delay | |
| 1058 ; WAITMS .5 ; 2.8ms according to datasheet | |
| 656 | 1059 return ; done |
| 623 | 1060 |
| 1061 | |
| 634 | 1062 ;----------------------------------------------------------------------------- |
| 1063 ; Helper Function - Initialize Gauge IC again after an UVLO Event | |
| 1064 ; | |
| 656 | 1065 battery_gauge_init_again: |
| 1066 btfsc battery_gauge_type ; =1: Gauge IC LTC2959, =0: LT2942 | |
| 1067 return | |
| 655 | 1068 rcall I2CReset |
| 623 | 1069 movlw 0x02 ; point to accumulated charge registers |
| 634 | 1070 rcall I2C_TX_GAUGE ; send byte to the LT2942 gauge IC |
| 623 | 1071 movff battery_accumulated_charge+1,SSP1BUF ; data byte |
| 634 | 1072 rcall WaitMSSP ; wait for TX to complete |
| 1073 rcall I2C_Check_ACK ; check for acknowledge by receiver | |
| 623 | 1074 movff battery_accumulated_charge+0,SSP1BUF ; data byte |
| 634 | 1075 rcall WaitMSSP ; wait for TX to complete |
| 1076 rcall I2C_Check_ACK ; check for acknowledge by receiver | |
| 656 | 1077 rcall I2C_PEN ; stop condition |
| 634 | 1078 MOVII battery_accumulated_charge,sub_a ; copy result to sub_a |
| 656 | 1079 ;bra battery_gauge_init ; and initialize again... |
| 560 | 1080 |
| 628 | 1081 |
| 634 | 1082 ;----------------------------------------------------------------------------- |
| 1083 ; Initialize Gauge IC | |
| 1084 ; | |
| 656 | 1085 global battery_gauge_init |
| 1086 battery_gauge_init: | |
| 1087 movlw 0x01 ; point to control reg B / ADC Control | |
| 1088 rcall I2C_TX_GAUGE ; send byte to the gauge IC | |
| 1089 movlw b'11111000' ; automatic conversion every two seconds (LT2942) | |
| 1090 btfsc battery_gauge_type ; =1: Gauge IC LTC2959, =0: LT2942 | |
| 1091 movlw b'00111000' ; ADC Mode to "Smart Sleep" (converts V, I, T every 52 seconds (tolerance < ±5%)) (LTC2959) | |
| 1092 rcall I2C_TX ; send byte | |
| 1093 btfsc battery_gauge_type ; =1: Gauge IC LTC2959, =0: LT2942 | |
| 1094 movlw b'01010000' ; 20µV deadband | |
| 1095 btfsc battery_gauge_type ; =1: Gauge IC LTC2959, =0: LT2942 | |
| 1096 rcall I2C_TX ; send one byte more for the LTC2959 | |
| 1097 bra I2C_PEN ; stop condition | |
| 628 | 1098 |
| 634 | 1099 ;----------------------------------------------------------------------------- |
| 1100 ; Read Gauge IC - Status Register | |
| 1101 ; | |
| 113 | 1102 global lt2942_get_status |
| 634 | 1103 lt2942_get_status: |
| 656 | 1104 bcf battery_gauge_type ; =1: Gauge IC LTC2959, =0: LT2942 |
| 1105 bcf battery_gauge_available ; clear flag on default | |
| 643 | 1106 |
| 656 | 1107 ; try LTC2942 |
| 1108 rcall I2C_SEN ; start condition | |
| 1109 movlw 0xC8 ; address byte + Write bit | |
| 1110 movwf SSP1BUF ; put byte to be sent into TX buffer | |
| 643 | 1111 rcall WaitMSSP ; wait for TX to complete |
| 656 | 1112 ; we need the ACKSTAT bit! Do not use I2C_TX routine here which might reset this bit! |
| 1113 btfss SSP1CON2,ACKSTAT ; ACK received from slave? | |
| 1114 bsf battery_gauge_available ; YES - set flag | |
| 1115 rcall I2C_MasterNotAckStop ; Master NOT acknowledge and Stop | |
| 1116 btfsc battery_gauge_available ; found? | |
| 1117 return ; YES - done | |
| 1118 | |
| 1119 ; try LTC2959 | |
| 1120 rcall I2C_SEN ; start condition | |
| 1121 movlw 0xC6 ; address byte + Write bit | |
| 1122 movwf SSP1BUF ; put byte to be sent into TX buffer | |
| 643 | 1123 rcall WaitMSSP ; wait for TX to complete |
| 656 | 1124 ; we need the ACKSTAT bit! Do not use I2C_TX routine here which might reset this bit! |
| 1125 btfss SSP1CON2,ACKSTAT ; ACK received from slave? | |
| 1126 bsf battery_gauge_available ; YES - set flag | |
| 1127 rcall I2C_MasterNotAckStop ; Master NOT acknowledge and Stop | |
| 1128 btfsc battery_gauge_available ; found? | |
| 1129 bsf battery_gauge_type ; =1: Gauge IC LTC2959, =0: LT2942 | |
| 1130 return ; NO, return | |
| 113 | 1131 |
| 634 | 1132 ;----------------------------------------------------------------------------- |
| 1133 ; Read Gauge IC - Voltage | |
| 1134 ; | |
| 113 | 1135 global lt2942_get_voltage |
| 634 | 1136 lt2942_get_voltage: |
| 656 | 1137 |
| 1138 btfsc battery_gauge_type ; =1: Gauge IC LTC2959, =0: LT2942 | |
| 1139 bra LTC2959_get_voltage ; use new IC | |
| 1140 | |
| 623 | 1141 movlw 0x08 ; point to voltage registers |
| 634 | 1142 rcall I2C_TX_GAUGE ; send byte to the LT2942 gauge IC |
| 1143 rcall I2C_RX_GAUGE ; receive byte from the LT2942 Gauge IC | |
| 656 | 1144 rcall I2C_ACKEN ; send master acknowledge |
| 634 | 1145 movff SSP1BUF,xA+1 ; copy received byte to xA+1 |
| 656 | 1146 rcall I2C_RCEN ; enable receive mode |
| 634 | 1147 movff SSP1BUF,xA+0 ; copy received byte to xA+0 |
| 650 | 1148 |
| 1149 rcall I2C_MasterNotAckStop ; Master NOT acknowledge and Stop | |
| 643 | 1150 |
| 623 | 1151 ; convert voltage from raw value to Volt |
| 1152 MOVLI .6000,xB ; load conversion multiplicand into xB | |
| 1153 call mult16x16 ; xC = xA * xB -> multiply raw value in xA with conversion multiplicand | |
| 1154 ; divide by 65536 instead of 65535, introducing an error of 65536/65535 = 0.002 % | |
| 656 | 1155 movff xC+2,xC+0 ; divide by 65536 can easily be done by just taking the 3rd and 4th byte of the multiplication result |
| 1156 movff xC+3,xC+1 ; use xC+0 and xC+1 as temp | |
| 615 | 1157 |
| 656 | 1158 movlw .4 ; battery voltage < 4*256mV (1.024)? |
| 1159 cpfslt xC+1 ; < 1024 mV ? | |
| 1160 bra lt2942_get_voltage_check_high ; NO - Continue checking | |
| 1161 bra battery_gauge_init_again ; YES - initialize gauge and return (and leave batt_voltage:2 untouched) | |
| 1162 | |
| 1163 lt2942_get_voltage_check_high: | |
| 1164 movlw .17 ; battery voltage >= 17*256mV (4.352V)? | |
| 1165 cpfslt xC+1 ; - ... ? | |
| 1166 bra battery_gauge_init_again ; YES - initialize gauge and return (and leave batt_voltage:2 untouched) | |
| 1167 ; NO - done | |
| 1168 movff xC+0, batt_voltage+0 | |
| 1169 movff xC+1, batt_voltage+1 | |
| 1170 bra lt2942_get_accumulated_charge ; - read coulomb counter (And return) | |
| 1171 | |
| 1172 LTC2959_get_voltage: | |
| 1173 movlw 0x0F ; point to voltage registers | |
| 1174 rcall I2C_TX_GAUGE ; send byte to the gauge IC | |
| 1175 rcall I2C_RX_GAUGE ; receive byte from the Gauge IC | |
| 1176 rcall I2C_ACKEN ; send master acknowledge | |
| 1177 movff SSP1BUF,xA+1 ; copy received byte to xA+1 | |
| 1178 rcall I2C_RCEN ; enable receive mode | |
| 1179 movff SSP1BUF,xA+0 ; copy received byte to xA+0 | |
| 1180 | |
| 1181 rcall I2C_MasterNotAckStop ; Master NOT acknowledge and Stop | |
| 1182 | |
| 1183 ; convert voltage from raw value to mV | |
| 1184 MOVLI .62600,xB ; load conversion multiplicand into xB | |
| 1185 call mult16x16 ; xC = xA * xB -> multiply raw value in xA with conversion multiplicand | |
| 1186 ; divide by 65536 instead of 65535, introducing an error of 65536/65535 = 0.002 % | |
| 1187 ;movff xC+2,xC+0 ; divide by 65536 can easily be done by just taking the 3rd and 4th byte of the multiplication result | |
| 1188 ;movff xC+3,xC+1 ; use xC+0 and xC+1 as temp | |
| 1189 | |
| 1190 movff xC+2, batt_voltage+0 | |
| 1191 movff xC+3, batt_voltage+1 | |
| 1192 rcall lt2942_get_accumulated_charge ; - read coulomb counter (And return) | |
| 1193 | |
| 1194 return ; done | |
| 623 | 1195 |
| 615 | 1196 |
| 634 | 1197 ;----------------------------------------------------------------------------- |
| 1198 ; Read Gauge IC - Temperature | |
| 1199 ; | |
| 623 | 1200 global lt2942_get_temperature |
| 1201 lt2942_get_temperature: ; read battery temperature | |
| 656 | 1202 btfsc battery_gauge_type ; =1: Gauge IC LTC2959, =0: LT2942 |
| 1203 bra LTC2959_get_temperature | |
| 1204 | |
| 623 | 1205 movlw 0x0C ; point to temperature register |
| 643 | 1206 rcall I2C_TX_GAUGE ; send byte to the LT2942 gauge IC |
| 1207 rcall I2C_RX_GAUGE ; receive byte from the LT2942 Gauge IC | |
| 656 | 1208 rcall I2C_ACKEN ; send master acknowledge |
| 623 | 1209 movff SSP1BUF,xA+1 ; store raw temperature, high byte |
| 656 | 1210 rcall I2C_RCEN ; enable receive mode |
| 623 | 1211 movff SSP1BUF,xA+0 ; store raw temperature, low byte |
| 650 | 1212 rcall I2C_MasterNotAckStop ; Master NOT acknowledge and Stop |
| 623 | 1213 |
| 656 | 1214 ; convert temperature from raw value to Kelvin in 0.1K |
| 623 | 1215 MOVLI .6000,xB ; load conversion multiplicand into xB |
| 1216 call mult16x16 ; xC = xA * xB -> multiply raw value in xA with conversion multiplicand | |
| 1217 ; divide by 65536 instead of 65535, introducing an error of 65536/65535 = 0.002 % | |
| 1218 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 | |
| 1219 movff xC+3,battery_temperature+1 ; ... | |
| 1220 | |
| 656 | 1221 lt2942_get_temperature_common: |
| 634 | 1222 ; check if battery is being charged right now |
| 623 | 1223 btfss cc_active ; in CC charging mode? |
| 1224 return ; NO - not charging, done | |
| 1225 | |
| 640 | 1226 ; ignore false readings (>125°C) |
| 1227 movlw LOW .3307 | |
| 1228 movwf sub_a+0 | |
| 1229 movlw HIGH .3307 | |
| 1230 movwf sub_a+1 | |
| 1231 MOVII battery_temperature, sub_b | |
| 1232 call cmpU16 ; sub_a - sub_b (with UNSIGNED values) | |
| 1233 btfsc neg_flag ; result negative? | |
| 1234 return ; YES - temperature > 125°C, not possible here. Skip test. | |
| 1235 | |
| 623 | 1236 ; check for over-temperature while charging |
| 1237 MOVLI max_battery_charge_temp,sub_a | |
| 1238 MOVII battery_temperature, sub_b | |
| 1239 call cmpU16 ; sub_a - sub_b (with UNSIGNED values) | |
| 1240 btfss neg_flag ; result negative? | |
| 1241 return ; NO - temperature <= threshold, ok, done | |
| 640 | 1242 return |
| 623 | 1243 ; YES - too hot, disable charging circuitry |
| 1244 bsf charge_disable ; - set charging-inhibit signal | |
| 1245 bcf charge_enable ; - activate charging-inhibit signal | |
| 1246 bsf battery_overtemp ; - flag that the battery charging over-temperature protection has tripped | |
| 656 | 1247 return ; - done |
| 623 | 1248 |
| 656 | 1249 LTC2959_get_temperature: |
| 1250 return | |
| 1251 | |
| 113 | 1252 |
| 634 | 1253 ;----------------------------------------------------------------------------- |
| 1254 ; Read Gauge IC - Read State of Charge | |
| 1255 ; | |
| 623 | 1256 lt2942_get_accumulated_charge: ; read accumulated charge and compute percent |
| 656 | 1257 btfsc battery_gauge_type ; =1: Gauge IC LTC2959, =0: LTC2942 |
| 1258 bra LTC2959_get_accumulated_charge | |
| 1259 | |
| 1260 ; old LTC2942 | |
| 623 | 1261 movlw 0x00 ; point to status register |
| 634 | 1262 rcall I2C_TX_GAUGE ; send byte to the LT2942 gauge IC |
| 1263 rcall I2C_RX_GAUGE ; receive byte from the LT2942 Gauge IC | |
| 656 | 1264 rcall I2C_ACKEN ; send master acknowledge |
| 634 | 1265 movff SSP1BUF,gauge_status_byte ; copy received byte to gauge_status_byte |
| 466 | 1266 |
| 656 | 1267 rcall I2C_RCEN ; enable receive mode |
| 1268 movf SSP1BUF,W ; dump to WREG (Control) | |
| 1269 rcall I2C_ACKEN ; send master acknowledge | |
| 582 | 1270 |
| 656 | 1271 rcall I2C_RCEN ; enable receive mode |
| 634 | 1272 movff SSP1BUF,sub_a+1 ; copy received byte to sub_a+1 |
| 656 | 1273 rcall I2C_ACKEN ; send master acknowledge |
| 582 | 1274 |
| 656 | 1275 rcall I2C_RCEN ; enable receive mode |
| 634 | 1276 movff SSP1BUF,sub_a+0 ; copy received byte to sub_a+0 |
| 650 | 1277 rcall I2C_MasterNotAckStop ; Master NOT acknowledge and Stop |
| 113 | 1278 |
| 656 | 1279 lt2942_get_accumulated_charge2: |
| 623 | 1280 btfsc gauge_status_byte,0 ; UVLO event ? |
| 656 | 1281 rcall battery_gauge_init_again ; YES - do an re-initialization |
| 623 | 1282 MOVII sub_a,battery_accumulated_charge ; save raw value |
| 656 | 1283 ; Compute batt_percent = (charge - battery_offset) / capacity_xxxxxx |
| 634 | 1284 MOVII battery_offset,sub_b ; get battery offset |
| 582 | 1285 call subU16 ; sub_c = sub_a - sub_b (with signed values) |
| 634 | 1286 clrf batt_percent ; default batt_percent to zero |
| 582 | 1287 btfsc neg_flag ; result negative? |
| 623 | 1288 bra lt2942_set_to_zero_percent ; YES - keep LT2942 at zero percent and return |
| 113 | 1289 |
| 623 | 1290 ; > zero, set batt_percent properly |
| 634 | 1291 MOVII sub_c,xA ; copy net charge to xA |
| 1292 MOVII battery_capacity,xB ; get battery capacity into xB | |
| 604 | 1293 call div16x16 ; xC = xA / xB with xA as remainder |
| 634 | 1294 movff xC+0,batt_percent ; result is battery percentage |
| 628 | 1295 movlw .100 ; max. value is 100 % |
| 1296 cpfslt batt_percent ; batt_percent < 100 % ? | |
| 1297 movwf batt_percent ; NO - limit to 100 % | |
| 656 | 1298 movlw battery_cycle_counter_unlock |
| 1299 cpfsgt batt_percent ; < threshold ? | |
| 654 | 1300 bcf lock_cycle_counter ; Yes, unlock cycle counter |
| 631 | 1301 return ; done |
| 113 | 1302 |
| 656 | 1303 LTC2959_get_accumulated_charge: |
| 1304 movlw 0x00 ; point to status register | |
| 1305 rcall I2C_TX_GAUGE ; send byte to the LT2942 gauge IC | |
| 1306 rcall I2C_RX_GAUGE ; receive byte from the LT2942 Gauge IC | |
| 1307 rcall I2C_ACKEN ; send master acknowledge | |
| 1308 movff SSP1BUF,gauge_status_byte ; copy received byte to gauge_status_byte | |
| 1309 | |
| 1310 rcall I2C_RCEN ; enable receive mode | |
| 1311 movf SSP1BUF,W ; dump to WREG (ADC Control) | |
| 1312 rcall I2C_ACKEN ; send master acknowledge | |
| 1313 | |
| 1314 rcall I2C_RCEN ; enable receive mode | |
| 1315 movf SSP1BUF,W ; dump to WREG (Coulumb Counter Control) | |
| 1316 rcall I2C_ACKEN ; send master acknowledge | |
| 1317 | |
| 1318 rcall I2C_RCEN ; enable receive mode | |
| 1319 movff SSP1BUF,xC+3 ; copy received byte to xC+3 | |
| 1320 rcall I2C_ACKEN ; send master acknowledge | |
| 1321 | |
| 1322 rcall I2C_RCEN ; enable receive mode | |
| 1323 movff SSP1BUF,xC+2 ; copy received byte to xC+2 | |
| 1324 rcall I2C_ACKEN ; send master acknowledge | |
| 1325 | |
| 1326 rcall I2C_RCEN ; enable receive mode | |
| 1327 movff SSP1BUF,xC+1 ; copy received byte to xC+1 | |
| 1328 rcall I2C_ACKEN ; send master acknowledge | |
| 1329 | |
| 1330 rcall I2C_RCEN ; enable receive mode | |
| 1331 movff SSP1BUF,xC+0 ; copy received byte to xC+0 | |
| 1332 rcall I2C_MasterNotAckStop ; Master NOT acknowledge and Stop | |
| 1333 | |
| 1334 MOVLI .159,xB ; 159,4745717 (0,085mAh/533nAh) | |
| 1335 call div32x16 ; xC:4 = xC:4 / xB:2 with xA as remainder | |
| 1336 | |
| 1337 ; clamp to 100% here | |
| 1338 tstfsz xC+2 ; Devision result > 0xFFFF | |
| 1339 setf xC+0 ; Yes, make sure xC:2 is 0xFFFF | |
| 1340 tstfsz xC+2 ; Devision result > 0xFFFF | |
| 1341 setf xC+1 ; Yes, make sure xC:2 is 0xFFFF | |
| 1342 | |
| 1343 movff xC+1,sub_a+1 | |
| 1344 movff xC+0,sub_a+0 ; put result in sub_a:2 | |
| 1345 ; | |
| 1346 ; movff sub_a+1,gp_debug+1 | |
| 1347 ; movff sub_a+0,gp_debug+0 | |
| 1348 ; | |
| 1349 bra lt2942_get_accumulated_charge2 ; continue as with LT2942 | |
| 1350 | |
| 1351 | |
| 449 | 1352 lt2942_set_to_zero_percent: |
| 656 | 1353 btfsc battery_gauge_type ; =1: Gauge IC LTC2959, =0: LT2942 |
| 1354 bra LTC2959_set_to_zero_percent | |
| 1355 | |
| 623 | 1356 movlw 0x02 ; point to accumulated charge registers |
| 634 | 1357 rcall I2C_TX_GAUGE ; send byte to the LT2942 gauge IC |
| 1358 movff battery_offset+1,SSP1BUF ; send battery offset, high byte | |
| 1359 rcall WaitMSSP ; wait for TX to complete | |
| 1360 rcall I2C_Check_ACK ; check for acknowledge by receiver | |
| 1361 movff battery_offset+0,SSP1BUF ; send battery offset, low byte | |
| 1362 rcall WaitMSSP ; wait for TX to complete | |
| 1363 rcall I2C_Check_ACK ; check for acknowledge by receiver | |
| 656 | 1364 bra I2C_PEN ; stop condition (and return) |
| 1365 | |
| 1366 LTC2959_set_to_zero_percent: | |
| 1367 ; multiply battery_offset:2 with 159 and write result to LTC2959 | |
| 1368 | |
| 1369 MOVII battery_offset,xA | |
| 1370 MOVLI .159,xB ; 159,4745717 (0,085mAh/533nAh) | |
| 1371 call mult16x16 ; xC:4 = xA:2 * xB:2 | |
| 1372 | |
| 1373 movlw 0x03 ; point to accumulated charge registers | |
| 1374 rcall I2C_TX_GAUGE ; send byte to the LT2942 gauge IC | |
| 1375 movff xC+3,SSP1BUF ; send battery offset | |
| 643 | 1376 rcall WaitMSSP ; wait for TX to complete |
| 656 | 1377 rcall I2C_Check_ACK ; check for acknowledge by receiver |
| 1378 movff xC+2,SSP1BUF ; send battery offset | |
| 1379 rcall WaitMSSP ; wait for TX to complete | |
| 1380 rcall I2C_Check_ACK ; check for acknowledge by receiver | |
| 1381 movff xC+1,SSP1BUF ; send battery offset | |
| 1382 rcall WaitMSSP ; wait for TX to complete | |
| 1383 rcall I2C_Check_ACK ; check for acknowledge by receiver | |
| 1384 movff xC+0,SSP1BUF ; send battery offset | |
| 1385 rcall WaitMSSP ; wait for TX to complete | |
| 1386 rcall I2C_Check_ACK ; check for acknowledge by receiver | |
| 1387 bra I2C_PEN ; stop condition (and return) | |
| 1388 | |
| 628 | 1389 |
| 634 | 1390 ;----------------------------------------------------------------------------- |
| 1391 ; Read Gauge IC - Reset Accumulating Register to 0xFFFF | |
| 1392 ; | |
| 113 | 1393 global lt2942_charge_done |
| 634 | 1394 lt2942_charge_done: |
| 656 | 1395 btfsc battery_gauge_type ; =1: Gauge IC LTC2959, =0: LT2942 |
| 1396 bra lt2959_charge_done | |
| 1397 | |
| 623 | 1398 movlw 0x02 ; point to accumulated charge registers |
| 634 | 1399 rcall I2C_TX_GAUGE ; send byte to the LT2942 gauge IC |
| 623 | 1400 setf SSP1BUF ; data byte |
| 634 | 1401 rcall WaitMSSP ; wait for TX to complete |
| 1402 rcall I2C_Check_ACK ; check for acknowledge by receiver | |
| 623 | 1403 setf SSP1BUF ; data byte |
| 634 | 1404 rcall WaitMSSP ; wait for TX to complete |
| 1405 rcall I2C_Check_ACK ; check for acknowledge by receiver | |
| 656 | 1406 bra I2C_PEN ; stop condition (and return) |
| 1407 | |
| 1408 lt2959_charge_done: | |
| 1409 ; Reset Accumulating Register to 0x009EFF61 (0xFFFF * .159) | |
| 1410 movlw 0x03 ; point to accumulated charge registers | |
| 1411 rcall I2C_TX_GAUGE ; send byte to the LT2942 gauge IC | |
| 1412 movlw 0x00 | |
| 1413 movwf SSP1BUF ; data byte | |
| 1414 rcall WaitMSSP ; wait for TX to complete | |
| 1415 rcall I2C_Check_ACK ; check for acknowledge by receiver | |
| 1416 movlw 0x9E | |
| 1417 movwf SSP1BUF ; data byte | |
| 643 | 1418 rcall WaitMSSP ; wait for TX to complete |
| 656 | 1419 rcall I2C_Check_ACK ; check for acknowledge by receiver |
| 1420 movlw 0xFF | |
| 1421 movwf SSP1BUF ; data byte | |
| 1422 rcall WaitMSSP ; wait for TX to complete | |
| 1423 rcall I2C_Check_ACK ; check for acknowledge by receiver | |
| 1424 movlw 0x61 | |
| 1425 movwf SSP1BUF ; data byte | |
| 1426 rcall WaitMSSP ; wait for TX to complete | |
| 1427 rcall I2C_Check_ACK ; check for acknowledge by receiver | |
| 1428 bra I2C_PEN ; stop condition (and return) | |
| 634 | 1429 |
| 656 | 1430 |
| 634 | 1431 ;----------------------------------------------------------------------------- |
| 1432 ; Helper Function - send 1 Byte to the LT2942 Gauge IC | |
| 1433 ; | |
| 1434 I2C_TX_GAUGE: | |
| 1435 movwf i2c_temp2 ; save data byte to be sent | |
| 656 | 1436 rcall I2C_SEN ; start condition |
| 1437 movlw 0xC8 ; address byte + Write bit LT2942 | |
| 1438 btfsc battery_gauge_type ; =1: Gauge IC LTC2959, =0: LT2942 | |
| 1439 movlw 0xC6 ; address byte + Write bit LTC2559 | |
| 1440 rcall I2C_TX ; send byte | |
| 634 | 1441 movf i2c_temp2,W ; restore data byte to be sent |
| 656 | 1442 bra I2C_TX ; send byte and return |
| 582 | 1443 |
| 634 | 1444 |
| 1445 ;----------------------------------------------------------------------------- | |
| 1446 ; Helper Function - receive 1 Byte from the LT2942 Gauge IC | |
| 1447 ; | |
| 113 | 1448 I2C_RX_GAUGE: |
| 656 | 1449 rcall I2C_RSEN ; repeated start condition |
| 1450 movlw 0xC9 ; address byte + Read bit LT2942 | |
| 1451 btfsc battery_gauge_type ; =1: Gauge IC LTC2959, =0: LT2942 | |
| 1452 movlw 0xC7 ; address byte + Read bit LTC2959 | |
| 1453 rcall I2C_TX ; send byte | |
| 1454 bra I2C_RCEN ; enable receive mode | |
| 634 | 1455 |
| 1456 | |
| 1457 ;----------------------------------------------------------------------------- | |
| 1458 ; Reset Hardware and Software Battery Gauge | |
| 1459 ; | |
| 1460 ; called from comm.asm and menu_tree.asm | |
| 1461 ; | |
| 1462 global reset_battery_gauge_and_lt2942 | |
| 1463 reset_battery_gauge_and_lt2942: | |
| 656 | 1464 btfsc battery_gauge_available ; battery gauge chip available? |
| 634 | 1465 call lt2942_charge_done ; YES - reset meter to 0xFFFF |
| 1466 ;bra reset_battery_gauge ; continue resetting gauge registers | |
| 582 | 1467 |
| 1468 | |
| 634 | 1469 ;----------------------------------------------------------------------------- |
| 1470 ; Reset Software Battery Gauge | |
| 1471 ; | |
| 631 | 1472 global reset_battery_gauge |
| 634 | 1473 reset_battery_gauge: |
| 1474 bsf block_battery_gauge ; suspend ISR from accessing the battery registers | |
| 1475 movlw .100 ; set battery level to 100% | |
| 1476 movwf batt_percent ; ... | |
| 1477 banksel battery_gauge ; select bank ISR data | |
| 1478 clrf battery_gauge+0 ; null the battery registers | |
| 1479 clrf battery_gauge+1 ; ... | |
| 1480 clrf battery_gauge+2 ; ... | |
| 1481 clrf battery_gauge+3 ; ... | |
| 1482 clrf battery_gauge+4 ; ... | |
| 1483 clrf battery_gauge+5 ; ... | |
| 654 | 1484 banksel charge_cycles |
| 1485 clrf charge_cycles+0 ; null the charge cycles | |
| 1486 clrf charge_cycles+1 ; ... | |
| 634 | 1487 banksel common ; back to bank common |
| 1488 goto eeprom_battery_gauge_write ; update battery registers in EEPROM, unblock ISR and return | |
| 631 | 1489 |
| 1490 | |
| 634 | 1491 |
| 604 | 1492 IFDEF _rx_functions |
| 1493 | |
| 634 | 1494 ;----------------------------------------------------------------------------- |
| 1495 ; OSTC TR - probe if TR Module available | |
| 1496 ; | |
| 560 | 1497 global I2C_probe_OSTC_rx |
| 1498 I2C_probe_OSTC_rx: | |
| 634 | 1499 bcf ostc_rx_present ; default to no TR module available |
| 623 | 1500 clrf WREG ; bank-safe set to zero of ... |
| 1501 movff WREG,rx_firmware_cur_major ; ... current TR module firmware, major | |
| 1502 movff WREG,rx_firmware_cur_minor ; ... current TR module firmware, minor | |
| 1503 movlw .5 ; max number of tries for detecting a TR module | |
| 634 | 1504 movwf hy ; initialize loop counter for tries |
| 604 | 1505 I2C_probe_OSTC_rx_1: |
| 656 | 1506 rcall I2C_SEN ; start condition |
| 623 | 1507 movlw 0x50 ; address byte + write bit |
| 656 | 1508 rcall I2C_TX ; send byte |
| 623 | 1509 bsf ostc_rx_present ; YES - TR module detected |
| 656 | 1510 rcall I2C_PEN ; stop condition |
| 623 | 1511 btfss ostc_rx_present ; was a TR module detected? |
| 1512 return ; NO - done | |
| 634 | 1513 |
| 1514 WAITMS .1 ; wait 1 ms | |
| 656 | 1515 rcall I2C_SEN ; start condition |
| 623 | 1516 movlw 0x50 ; address byte + write bit |
| 656 | 1517 rcall I2C_TX ; send byte |
| 634 | 1518 movlw 0x1B ; command: get firmware |
| 656 | 1519 rcall I2C_TX ; send byte |
| 1520 rcall I2C_PEN ; stop condition | |
| 634 | 1521 |
| 1522 WAITMS .1 ; wait 1 ms | |
| 1523 | |
| 656 | 1524 rcall I2C_SEN ; start condition |
| 623 | 1525 movlw 0x51 ; address byte + Read bit |
| 582 | 1526 movwf SSP1BUF ; control byte |
| 634 | 1527 rcall WaitMSSP ; wait for TX to complete |
| 656 | 1528 rcall I2C_RCEN ; enable receive mode |
| 623 | 1529 movff SSP1BUF,rx_firmware_cur_major ; store as firmware version, major |
| 656 | 1530 rcall I2C_ACKEN ; send master acknowledge |
| 582 | 1531 |
| 560 | 1532 ; last byte in read from RX circuity always with a NACK! |
| 656 | 1533 rcall I2C_RCEN ; enable receive mode |
| 623 | 1534 movff SSP1BUF,rx_firmware_cur_minor ; store as firmware version, minor |
| 650 | 1535 rcall I2C_MasterNotAckStop ; Master NOT acknowledge and Stop |
| 643 | 1536 |
| 623 | 1537 ; wait for TR module becoming ready |
| 634 | 1538 movff rx_firmware_cur_minor,i2c_temp1 ; copy minor firmware version to bank common |
| 623 | 1539 movlw .147 ; code for not ready, minor |
| 1540 cpfseq i2c_temp1 ; equal? | |
| 634 | 1541 return ; NO - TR module ready, done |
| 1542 movff rx_firmware_cur_major,i2c_temp1 ; YES - copy major firmware version to bank common | |
| 623 | 1543 movlw .27 ; - code for not ready, major |
| 1544 cpfseq i2c_temp1 ; - equal? | |
| 634 | 1545 return ; NO - TR module ready, done |
| 623 | 1546 bsf active_reset_ostc_rx ; YES - apply reset to TR module |
| 1547 WAITMS .5 ; - wait 5 ms | |
| 1548 bcf active_reset_ostc_rx ; - release reset | |
| 1549 WAITMS .250 ; - wait for 250 ms | |
| 1550 WAITMS .250 ; - wait another 250 ms | |
| 1551 decfsz hy,F ; - decrement counter for number of tries, became zero? | |
| 1552 bra I2C_probe_OSTC_rx_1 ; - NO - try again | |
| 1553 bcf ostc_rx_present ; - YES - something is wrong, flag TR module as not available | |
| 634 | 1554 return ; - done |
| 582 | 1555 |
| 560 | 1556 |
| 634 | 1557 ;----------------------------------------------------------------------------- |
| 1558 ; OSTC TR - get Tank Data | |
| 1559 ; | |
| 560 | 1560 global I2C_get_tankdata |
| 1561 I2C_get_tankdata: | |
| 656 | 1562 rcall I2C_SEN ; start condition |
| 623 | 1563 movlw 0x50 ; address byte + write bit |
| 656 | 1564 rcall I2C_TX ; send byte |
| 623 | 1565 movlw 0x1E ; read buffer2 (48 bytes) |
| 656 | 1566 rcall I2C_TX ; send byte |
| 1567 rcall I2C_PEN ; stop condition | |
| 634 | 1568 |
| 1569 WAITMS .1 ; wait 1 ms | |
| 1570 | |
| 560 | 1571 ; read 48 bytes |
| 656 | 1572 rcall I2C_SEN ; start condition |
| 623 | 1573 movlw 0x51 ; address byte + read bit |
| 656 | 1574 rcall I2C_TX ; send byte |
| 582 | 1575 movlw .47 ; 47 with ACK + 1 w/o ACK |
| 634 | 1576 movwf i2c_temp2 ; initialize loop counter |
| 1577 lfsr FSR2,rx_buffer ; point to start of rx data buffer | |
| 560 | 1578 I2C_get_tankdata_loop_read: |
| 656 | 1579 rcall I2C_RCEN ; enable receive mode |
| 634 | 1580 movff SSP1BUF,POSTINC2 ; copy received byte to the rx buffer |
| 1581 bcf SSP1CON2,ACKDT ; reset ACKDT flag | |
| 656 | 1582 rcall I2C_ACKEN ; send master acknowledge |
| 634 | 1583 decfsz i2c_temp2,F ; decrement loop counter, done? |
| 1584 bra I2C_get_tankdata_loop_read ; NO - loop | |
| 1585 ; read last byte without ACK | |
| 656 | 1586 rcall I2C_RCEN ; enable receive mode |
| 634 | 1587 movff SSP1BUF,POSTINC2 ; copy received byte to the rx buffer |
| 650 | 1588 rcall I2C_MasterNotAckStop ; Master NOT acknowledge and Stop |
| 643 | 1589 return ; done |
| 1590 | |
| 582 | 1591 |
| 1592 | |
| 634 | 1593 ;----------------------------------------------------------------------------- |
| 1594 ; OSTC TR - Firmware Update | |
| 1595 ; | |
| 628 | 1596 IFDEF _rx_update |
| 1597 | |
| 560 | 1598 global I2C_update_OSTC_rx |
| 623 | 1599 I2C_update_OSTC_rx: ; transfer 64 byte to RX co-processor |
| 1600 ; setup for write | |
| 582 | 1601 bcf i2c_error_flag ; clear error flag |
| 623 | 1602 lfsr FSR2,buffer ; initialize pointer to send buffer used for verify |
| 1603 movlw .64 ; initialize loop counter: 64 byte with ACK | |
| 1604 movwf i2c_temp2 ; ... | |
| 1605 ; address write | |
| 656 | 1606 rcall I2C_SEN ; start condition |
| 623 | 1607 movlw 0x50 ; address byte + write bit |
| 656 | 1608 rcall I2C_TX ; send byte |
| 623 | 1609 ; write 64 bytes |
| 1610 I2C_update_OSTC_loop: | |
| 1611 TBLRD*+ ; read a byte from program memory | |
| 1612 movff TABLAT,POSTINC2 ; copy to send buffer | |
| 656 | 1613 movf TABLAT,W ; copy to W |
| 1614 rcall I2C_TX ; send byte | |
| 623 | 1615 decfsz i2c_temp2,F ;decrement loop counter, became zero? |
| 1616 bra I2C_update_OSTC_loop ; NO - loop | |
| 656 | 1617 rcall I2C_PEN ; stop condition |
| 623 | 1618 WAITMS .1 ; - wait another 1 ms |
| 1619 ; setup for read-back | |
| 1620 lfsr FSR2,buffer ; reset pointer to begin of send buffer | |
| 1621 movlw .63 ; initialize loop counter: 63 byte with ACK + 1 w/o ACK | |
| 634 | 1622 movwf i2c_temp2 ; ... |
| 623 | 1623 ; address read-back |
| 656 | 1624 rcall I2C_SEN ; start condition |
| 623 | 1625 movlw 0x51 ; address byte + read bit |
| 656 | 1626 rcall I2C_TX ; send byte |
| 623 | 1627 ; read-back 64 bytes |
| 560 | 1628 I2C_update_OSTC_loop_read: |
| 656 | 1629 rcall I2C_RCEN ; enable receive mode |
| 634 | 1630 movf SSP1BUF,W ; copy received byte to WREG |
| 623 | 1631 cpfseq POSTINC2 ; compare read-back byte with sent byte, equal? |
| 1632 bsf i2c_error_flag ; NO - not equal, set error flag | |
| 634 | 1633 bcf SSP1CON2,ACKDT ; reset ACKDT flag |
| 656 | 1634 rcall I2C_ACKEN ; send master acknowledge |
| 623 | 1635 decfsz i2c_temp2,F ; decrement loop counter, became zero? |
| 1636 bra I2C_update_OSTC_loop_read ; NO - loop | |
| 560 | 1637 ; 1 w/o ACK |
| 623 | 1638 bsf SSP1CON2, RCEN ; YES - enable receive mode |
| 634 | 1639 rcall WaitMSSP ; - wait for TX to complete |
| 623 | 1640 movf SSP1BUF,W ; - get 64th byte |
| 1641 cpfseq POSTINC2 ; - compare read-back byte with sent byte, equal? | |
| 1642 bsf i2c_error_flag ; NO - not equal, set error flag | |
| 650 | 1643 rcall I2C_MasterNotAckStop ; Master NOT acknowledge and Stop |
| 560 | 1644 WAITMS .1 |
| 623 | 1645 ; address commit |
| 656 | 1646 rcall I2C_SEN ; start condition |
| 623 | 1647 movlw 0x50 ; address byte + write bit |
| 656 | 1648 rcall I2C_TX ; send byte |
| 623 | 1649 movlw 0x1F ; write command |
| 656 | 1650 rcall I2C_TX ; send byte |
| 1651 rcall I2C_PEN ; stop condition | |
| 623 | 1652 WAITMS .5 ; required waiting time |
| 1653 ; error check | |
| 1654 btfss i2c_error_flag ; did an error occur? | |
| 1655 retlw .0 ; NO - data transfered successfully | |
| 1656 retlw .255 ; YES - error in data transfer occurred | |
| 582 | 1657 |
| 628 | 1658 ENDIF ; _rx_update |
| 1659 | |
| 1660 ENDIF ; _rx_functions | |
| 643 | 1661 |
| 634 | 1662 ;----------------------------------------------------------------------------- |
| 643 | 1663 ; Probe for MS5837 sensor |
| 1664 ; | |
| 1665 global I2C_probe_pressure_sensor ; Do not call from ISR! | |
| 1666 I2C_probe_pressure_sensor: ; Probe the type of sensor, set/clear press_sensor_type | |
| 1667 bcf press_sensor_type ; MS5541 as default | |
| 656 | 1668 rcall I2C_SEN ; start condition |
| 643 | 1669 movlw 0xEC ; address byte + write bit |
| 1670 movwf SSP1BUF ; control byte | |
| 1671 rcall WaitMSSP ; wait for TX to complete | |
| 656 | 1672 ; we need the ACKSTAT bit! Do not use I2C_TX routine here which might reset this bit! |
| 643 | 1673 btfss SSP1CON2,ACKSTAT ; ACK received? |
| 1674 bsf press_sensor_type ; MS5837 sensor found | |
| 656 | 1675 bra I2C_PEN ; stop condition |
| 643 | 1676 |
| 1677 ;-------------------------------------------------------------------- | |
| 1678 ; Helper Function - get the calibration parameter from # WREG address | |
| 1679 ; Do not call from ISR! | |
| 1680 I2C_get_calib_parameter: | |
| 1681 movwf lo ; store address | |
| 656 | 1682 rcall I2C_SEN ; start condition |
| 643 | 1683 movlw 0xEC ; address byte + write bit |
| 1684 rcall I2C_TX ; send byte | |
| 1685 movf lo,W ; Point to calibration register | |
| 1686 rcall I2C_TX ; send byte | |
| 656 | 1687 rcall I2C_PEN ; stop condition |
| 643 | 1688 |
| 656 | 1689 rcall I2C_SEN ; start condition |
| 643 | 1690 movlw 0xED ; address byte + read bit |
| 656 | 1691 rcall I2C_TX ; send byte |
| 1692 rcall I2C_RCEN ; enable receive mode | |
| 643 | 1693 movff SSP1BUF,dMSB ; High byte |
| 656 | 1694 rcall I2C_ACKEN ; send master acknowledge |
| 1695 | |
| 1696 rcall I2C_OneByteRX_NACK ; receive last byte with not acknowledge | |
| 643 | 1697 movff SSP1BUF,dLSB ; Low byte |
| 656 | 1698 bra I2C_PEN ; stop condition |
| 643 | 1699 |
| 1700 | |
| 1701 global I2C_get_calib_MS5837 ; Do not call from ISR! | |
| 1702 I2C_get_calib_MS5837: | |
| 1703 banksel common | |
| 1704 ; first, send a reset | |
| 656 | 1705 rcall I2C_SEN ; start condition |
| 643 | 1706 movlw 0xEC ; address byte + write bit |
| 1707 rcall I2C_TX ; send byte | |
| 1708 movlw 0x1E | |
| 1709 rcall I2C_TX ; send byte | |
| 656 | 1710 rcall I2C_PEN ; stop condition |
| 643 | 1711 WAITMS .5 ; 2.8ms according to datasheet |
| 1712 | |
| 1713 movlw 0xA2 ; Point to C1 | |
| 1714 rcall I2C_get_calib_parameter ; returns calibration value in lo and hi | |
| 1715 movff dLSB,C1+0 ; store calib | |
| 1716 movff dMSB,C1+1 ; store calib | |
| 623 | 1717 |
| 643 | 1718 movlw 0xA4 ; Point to C2 |
| 1719 rcall I2C_get_calib_parameter ; returns calibration value in lo and hi | |
| 1720 movff dLSB,C2+0 ; store calib | |
| 1721 movff dMSB,C2+1 ; store calib | |
| 1722 | |
| 1723 movlw 0xA6 ; Point to C3 | |
| 1724 rcall I2C_get_calib_parameter ; returns calibration value in lo and hi | |
| 1725 movff dLSB,C3+0 ; store calib | |
| 1726 movff dMSB,C3+1 ; store calib | |
| 1727 | |
| 1728 movlw 0xA8 ; Point to C4 | |
| 1729 rcall I2C_get_calib_parameter ; returns calibration value in lo and hi | |
| 1730 movff dLSB,C4+0 ; store calib | |
| 1731 movff dMSB,C4+1 ; store calib | |
| 1732 | |
| 1733 movlw 0xAA ; Point to C5 | |
| 1734 rcall I2C_get_calib_parameter ; returns calibration value in lo and hi | |
| 1735 movff dLSB,C5+0 ; store calib | |
| 1736 movff dMSB,C5+1 ; store calib | |
| 1737 | |
| 1738 movlw 0xAC ; Point to C6 | |
| 1739 rcall I2C_get_calib_parameter ; returns calibration value in lo and hi | |
| 1740 movff dLSB,C6+0 ; store calib | |
| 1741 movff dMSB,C6+1 ; store calib | |
| 1742 | |
| 1743 return | |
| 1744 | |
| 1745 global I2C_get_press_val_MS5837 | |
| 1746 I2C_get_press_val_MS5837: | |
| 656 | 1747 btfsc i2c_reinit_sensor2 ; Sensor ok? |
| 1748 rcall I2CReset ; Try a I2C reset first | |
| 1749 btfsc i2c_reinit_sensor2 ; Sensor ok? | |
| 1750 bra I2C_get_press_val_MS5837_skip ; We did a reset, restart conversion first | |
| 1751 | |
| 1752 rcall I2C_SEN ; start condition | |
| 643 | 1753 movlw 0xEC ; address byte + write bit |
| 1754 rcall I2C_TX ; send byte | |
| 1755 movlw 0x00 ; command byte (0x00, read ADC) | |
| 1756 rcall I2C_TX ; send byte | |
| 1757 | |
| 656 | 1758 rcall I2C_RSEN ; repeated start condition |
| 643 | 1759 movlw 0xED ; address byte + read bit |
| 656 | 1760 rcall I2C_TX ; send byte |
| 643 | 1761 |
| 650 | 1762 bsf i2c_busy_pressure ; reading new pressure |
| 656 | 1763 rcall I2C_RCEN ; enable receive mode |
| 643 | 1764 movff SSP1BUF,D1_buffer+2 ; Upper byte |
| 656 | 1765 rcall I2C_ACKEN ; send master acknowledge |
| 1766 rcall I2C_RCEN ; enable receive mode | |
| 643 | 1767 movff SSP1BUF,D1_buffer+1 ; high byte |
| 656 | 1768 rcall I2C_ACKEN ; send master acknowledge |
| 1769 rcall I2C_RCEN ; enable receive mode | |
| 643 | 1770 movff SSP1BUF,D1_buffer+0 ; Low byte |
| 1771 | |
| 650 | 1772 rcall I2C_MasterNotAckStop ; Master NOT acknowledge and Stop |
| 1773 bcf i2c_busy_pressure ; reading new pressure done. | |
| 656 | 1774 |
| 1775 I2C_get_press_val_MS5837_skip: | |
| 643 | 1776 ; Start temperature measurement |
| 656 | 1777 rcall I2C_SEN ; start condition |
| 643 | 1778 movlw 0xEC ; address byte + write bit |
| 1779 rcall I2C_TX ; send byte | |
| 1780 movlw 0x58 ; OSR=4096, type=D2 | |
| 1781 rcall I2C_TX ; send byte | |
| 656 | 1782 rcall I2C_PEN ; stop condition |
| 643 | 1783 bcf ms5837_state ; =0: result of temperature will be in the ADC |
| 656 | 1784 bcf i2c_reinit_sensor2 ; Clear error flag |
| 643 | 1785 return |
| 1786 | |
| 1787 global I2C_get_temp_val_MS5837 | |
| 1788 I2C_get_temp_val_MS5837: | |
| 656 | 1789 btfsc i2c_reinit_sensor2 ; Sensor ok? |
| 1790 rcall I2CReset ; Try a I2C reset first | |
| 1791 btfsc i2c_reinit_sensor2 ; Sensor ok? | |
| 1792 bra I2C_get_temp_val_MS5837_skip ; We did a reset, restart conversion first | |
| 1793 | |
| 1794 rcall I2C_SEN ; start condition | |
| 643 | 1795 movlw 0xEC ; address byte + write bit |
| 1796 rcall I2C_TX ; send byte | |
| 1797 movlw 0x00 ; command byte (0x00, read ADC) | |
| 1798 rcall I2C_TX ; send byte | |
| 1799 | |
| 656 | 1800 rcall I2C_RSEN ; repeated start condition |
| 643 | 1801 movlw 0xED ; address byte + read bit |
| 656 | 1802 rcall I2C_TX ; send byte |
| 643 | 1803 |
| 650 | 1804 bsf i2c_busy_temperature ; reading new temperature |
| 656 | 1805 rcall I2C_RCEN ; enable receive mode |
| 643 | 1806 movff SSP1BUF,D2_buffer+2 ; Upper byte |
| 656 | 1807 rcall I2C_ACKEN ; send master acknowledge |
| 1808 rcall I2C_RCEN ; enable receive mode | |
| 643 | 1809 movff SSP1BUF,D2_buffer+1 ; high byte |
| 656 | 1810 rcall I2C_ACKEN ; send master acknowledge |
| 1811 rcall I2C_RCEN ; enable receive mode | |
| 643 | 1812 movff SSP1BUF,D2_buffer+0 ; Low byte |
| 1813 | |
| 650 | 1814 rcall I2C_MasterNotAckStop ; Master NOT acknowledge and Stop |
| 1815 bcf i2c_busy_temperature ; reading new temperature done. | |
| 656 | 1816 |
| 1817 I2C_get_temp_val_MS5837_skip: | |
| 643 | 1818 ; Start pressure measurement |
| 656 | 1819 rcall I2C_SEN ; start condition |
| 643 | 1820 movlw 0xEC ; address byte + write bit |
| 1821 rcall I2C_TX ; send byte | |
| 1822 movlw 0x48 ; OSR=4096, type=D1 | |
| 1823 rcall I2C_TX ; send byte | |
| 656 | 1824 rcall I2C_PEN ; stop condition |
| 643 | 1825 bsf ms5837_state ; =0: result of pressure will be in the ADC |
| 656 | 1826 bcf i2c_reinit_sensor2 ; Clear error flag |
| 643 | 1827 return |
| 1828 | |
| 1829 | |
| 1830 ;----------------------------------------------------------------------------- | |
| 1831 ; I2C Bus error checker | |
| 1832 ; | |
| 1833 global check_i2c_error | |
| 1834 extern TFT_message_i2c_error | |
| 1835 check_i2c_error: | |
| 1836 btfss i2c_error_flag | |
| 1837 return | |
| 656 | 1838 bcf i2c_error_flag_lock ; arm error vault again |
| 643 | 1839 incf message_counter,F ; increase message counter |
| 1840 goto TFT_message_i2c_error ; show message for battery low (battery percent) and return | |
| 1841 | |
| 1842 ;----------------------------------------------------------------------------- | |
| 582 | 1843 END |