no change
Dependents: Airmouse LV9-Pai-grupa7-tim8-zad1 Airmouse_ Project2 ... more
Fork of MMA8451Q by
Diff: MMA8451Q.cpp
- Revision:
- 5:9e6dc5a4ca82
- Parent:
- 3:db7126dbd63f
--- a/MMA8451Q.cpp Fri Oct 12 11:35:07 2012 +0000 +++ b/MMA8451Q.cpp Mon Jun 24 23:22:37 2013 +0000 @@ -26,7 +26,8 @@ #define UINT14_MAX 16383 -MMA8451Q::MMA8451Q(PinName sda, PinName scl, int addr) : m_i2c(sda, scl), m_addr(addr) { +MMA8451Q::MMA8451Q(PinName sda, PinName scl, int addr) : m_i2c(sda, scl), m_addr(addr) +{ // activate the peripheral uint8_t data[2] = {REG_CTRL_REG_1, 0x01}; writeRegs(data, 2); @@ -34,31 +35,37 @@ MMA8451Q::~MMA8451Q() { } -uint8_t MMA8451Q::getWhoAmI() { +uint8_t MMA8451Q::getWhoAmI() +{ uint8_t who_am_i = 0; readRegs(REG_WHO_AM_I, &who_am_i, 1); return who_am_i; } -float MMA8451Q::getAccX() { +float MMA8451Q::getAccX() +{ return (float(getAccAxis(REG_OUT_X_MSB))/4096.0); } -float MMA8451Q::getAccY() { +float MMA8451Q::getAccY() +{ return (float(getAccAxis(REG_OUT_Y_MSB))/4096.0); } -float MMA8451Q::getAccZ() { +float MMA8451Q::getAccZ() +{ return (float(getAccAxis(REG_OUT_Z_MSB))/4096.0); } -void MMA8451Q::getAccAllAxis(float * res) { +void MMA8451Q::getAccAllAxis(float * res) +{ res[0] = getAccX(); res[1] = getAccY(); res[2] = getAccZ(); } -int16_t MMA8451Q::getAccAxis(uint8_t addr) { +int16_t MMA8451Q::getAccAxis(uint8_t addr) +{ int16_t acc; uint8_t res[2]; readRegs(addr, res, 2); @@ -70,12 +77,14 @@ return acc; } -void MMA8451Q::readRegs(int addr, uint8_t * data, int len) { +void MMA8451Q::readRegs(int addr, uint8_t * data, int len) +{ char t[1] = {addr}; m_i2c.write(m_addr, t, 1, true); m_i2c.read(m_addr, (char *)data, len); } -void MMA8451Q::writeRegs(uint8_t * data, int len) { +void MMA8451Q::writeRegs(uint8_t * data, int len) +{ m_i2c.write(m_addr, (char *)data, len); }