Test program for FXAS21002

Dependencies:   FXAS21002 mbed vt100

Committer:
Rhyme
Date:
Wed May 17 07:17:18 2017 +0000
Revision:
4:db440780b6d5
Parent:
0:5306d38db3c9
format changed to be compatible with CSV

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Rhyme 0:5306d38db3c9 1 #include "mbed.h"
Rhyme 0:5306d38db3c9 2 #include "dumb_i2c.h"
Rhyme 0:5306d38db3c9 3
Rhyme 0:5306d38db3c9 4 DUMB_I2C::DUMB_I2C(PinName sda, PinName scl, int addr) : m_i2c(sda, scl), m_addr(addr<<1) {
Rhyme 0:5306d38db3c9 5 // activate the peripheral
Rhyme 0:5306d38db3c9 6 freq = 100000 ; /* 100KHz */
Rhyme 0:5306d38db3c9 7 m_i2c.frequency(freq) ;
Rhyme 0:5306d38db3c9 8 }
Rhyme 0:5306d38db3c9 9
Rhyme 0:5306d38db3c9 10 DUMB_I2C::~DUMB_I2C() { }
Rhyme 0:5306d38db3c9 11
Rhyme 0:5306d38db3c9 12 uint8_t DUMB_I2C::address(void)
Rhyme 0:5306d38db3c9 13 {
Rhyme 0:5306d38db3c9 14 return( m_addr >> 1 ) ;
Rhyme 0:5306d38db3c9 15 }
Rhyme 0:5306d38db3c9 16
Rhyme 0:5306d38db3c9 17 void DUMB_I2C::frequency(uint32_t f)
Rhyme 0:5306d38db3c9 18 {
Rhyme 0:5306d38db3c9 19 freq = f ;
Rhyme 0:5306d38db3c9 20 m_i2c.frequency(freq) ;
Rhyme 0:5306d38db3c9 21 }
Rhyme 0:5306d38db3c9 22
Rhyme 0:5306d38db3c9 23 uint32_t DUMB_I2C::frequency(void)
Rhyme 0:5306d38db3c9 24 {
Rhyme 0:5306d38db3c9 25 return(freq) ;
Rhyme 0:5306d38db3c9 26 }
Rhyme 0:5306d38db3c9 27
Rhyme 0:5306d38db3c9 28 int DUMB_I2C::read(int addr, uint8_t *data, int len)
Rhyme 0:5306d38db3c9 29 {
Rhyme 0:5306d38db3c9 30 int result ;
Rhyme 0:5306d38db3c9 31 result = readRegs(addr, data, len) ;
Rhyme 0:5306d38db3c9 32 return( result ) ;
Rhyme 0:5306d38db3c9 33 }
Rhyme 0:5306d38db3c9 34
Rhyme 0:5306d38db3c9 35 int DUMB_I2C::write(int addr, uint8_t *data, int len)
Rhyme 0:5306d38db3c9 36 {
Rhyme 0:5306d38db3c9 37 uint8_t *buf ;
Rhyme 0:5306d38db3c9 38 int ack ;
Rhyme 0:5306d38db3c9 39 buf = new uint8_t[len+1] ;
Rhyme 0:5306d38db3c9 40 buf[0] = addr ;
Rhyme 0:5306d38db3c9 41 for (int i = 0 ; i < len ; i++ ) {
Rhyme 0:5306d38db3c9 42 buf[i+1] = data[i] ;
Rhyme 0:5306d38db3c9 43 }
Rhyme 0:5306d38db3c9 44 ack = writeRegs(buf, len+1) ;
Rhyme 0:5306d38db3c9 45 delete buf ;
Rhyme 0:5306d38db3c9 46 return( ack ) ;
Rhyme 0:5306d38db3c9 47 }
Rhyme 0:5306d38db3c9 48
Rhyme 0:5306d38db3c9 49 int DUMB_I2C::readRegs(int addr, uint8_t * data, int len) {
Rhyme 0:5306d38db3c9 50 int result ;
Rhyme 0:5306d38db3c9 51 char t[1] = {addr};
Rhyme 0:5306d38db3c9 52 m_i2c.write(m_addr, t, 1, true);
Rhyme 0:5306d38db3c9 53 result = m_i2c.read(m_addr, (char *)data, len);
Rhyme 0:5306d38db3c9 54 return( result ) ;
Rhyme 0:5306d38db3c9 55 }
Rhyme 0:5306d38db3c9 56
Rhyme 0:5306d38db3c9 57 int DUMB_I2C::writeRegs(uint8_t * data, int len) {
Rhyme 0:5306d38db3c9 58 int ack ;
Rhyme 0:5306d38db3c9 59 ack = m_i2c.write(m_addr, (char *)data, len);
Rhyme 0:5306d38db3c9 60 return( ack ) ;
Rhyme 0:5306d38db3c9 61 }