A basic library for the MMA8652 accelerometer, provides data in either floating point G's or as a signed 16 bit integer.

Dependents:   Hello_MMA8652 Multi-Sensor Buddi_Blueband Freescale_Multi-Sensor_Shield ... more

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;
  
}