openXsensor/arduino_shim.cpp

   1
   2 #include "arduino_shim.h"
   3
   4 #include "I2C.h"
   5
   6 #define INV6050_addrBis 0x68
   7
   8 _EXTERN_ATTRIB int shim_i2c_write(unsigned char slave_addr, unsigned char reg_addr,unsigned char length, unsigned char const *data) {
   9           return I2c.write( (uint8_t) slave_addr, (uint8_t) reg_addr,  (uint8_t) length , (uint8_t *)data ) ; // return 0 on success
  10 }
  11
  12 _EXTERN_ATTRIB int shim_i2c_writeByte( unsigned char reg_addr, unsigned char data) {
  13     return I2c.write( INV6050_addrBis , (uint8_t) reg_addr,  (uint8_t) data ) ; // return 0 on success
  14 }
  15
  16
  17 _EXTERN_ATTRIB int shim_i2c_read(unsigned char slave_addr, unsigned char reg_addr,unsigned char length, unsigned char *data) {
  18     return I2c.read( (uint8_t) slave_addr, (uint8_t) reg_addr, (uint8_t) length , (uint8_t *)data ) ; // return 0 on success
  19 }
  20
  21
  22 _EXTERN_ATTRIB int shim_i2c_writeBlock( unsigned char reg_addr,unsigned char length, unsigned char const *data) {
  23     return I2c.write(  INV6050_addrBis, (uint8_t) reg_addr,  (uint8_t) length , (uint8_t *)data ) ; // return 0 on success
  24 }
  25