A basic library for the MMA8652 accelerometer, provides data in either floating point G's or as a signed 16 bit integer.
Dependents: microbit_mouse_BLE_daybreak_version
Fork of MMA8652 by
MMA8652.cpp
- Committer:
- JimCarver
- Date:
- 2014-04-07
- Revision:
- 0:3ae1e808e61c
- Child:
- 1:ff30cc4759b4
File content as of revision 0:3ae1e808e61c:
#include "MMA8652.h" MMA8652::MMA8652(PinName sda, PinName scl) : _i2c(sda, scl) { begin(); } void MMA8652::RegRead( char reg, char * d, int len) { char cmd[1]; cmd[0] = reg; char i2c_addr = MMA8652_SLAVE_ADDR; _i2c.write( i2c_addr, cmd, 1); _i2c.read ( i2c_addr, d, len); } void MMA8652::begin(void) { char data[2]; // write 0000 0000 = 0x00 to accelerometer control register 1 to place MMA8652 into // standby // [7-1] = 0000 000 // [0]: active=0 data[0] = MMA8652_CTRL_REG1; data[1] = 0x00; _i2c.write( MMA8652_SLAVE_ADDR, data, 2); // write 0000 0001= 0x01 to XYZ_DATA_CFG register // [7]: reserved // [6]: reserved // [5]: reserved // [4]: hpf_out=0 // [3]: reserved // [2]: reserved // [1-0]: fs=00 for accelerometer range of +/-2g range with 0.244mg/LSB data[0] = MMA8652_XYZ_DATA_CFG; data[1] = 0x00; _i2c.write( MMA8652_SLAVE_ADDR, data, 2); // write 0000 1101 = 0x0D to accelerometer control register 1 // [7-6]: aslp_rate=00 // [5-3]: dr=100 for 50Hz data rate // [2]: 0 // [1]: 0 // [0]: active=1 to take the part out of standby and enable sampling data[0] = MMA8652_CTRL_REG1; data[1] = 0x21; _i2c.write( MMA8652_SLAVE_ADDR, data, 2); } void MMA8652::ReadXYZ(float * a) { char d[7]; int16_t t[6]; RegRead( MMA8652_STATUS, d, 7); t[0] = ((d[1] * 256) + ((unsigned short) d[2])); t[1] = ((d[3] * 256) + ((unsigned short) d[4])); t[2] = ((d[5] * 256) + ((unsigned short) d[6])); a[0] = (float) t[0] / 16384.0; a[1] = (float) t[1] / 16384.0; a[2] = (float) t[2] / 16384.0; }