Test program for FXAS21002
Dependencies: FXAS21002 mbed vt100
dumb_i2c.cpp@4:db440780b6d5, 2017-05-17 (annotated)
- 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?
User | Revision | Line number | New 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 | } |