MMA8452
Dependents: ECE2035_SUM17_Project
Revision 0:79012a2fa4d1, committed 2017-07-14
- Comitter:
- kennyainny
- Date:
- Fri Jul 14 21:42:37 2017 +0000
- Commit message:
- no changes
Changed in this revision
MMA8452.cpp | Show annotated file Show diff for this revision Revisions of this file |
MMA8452.h | Show annotated file Show diff for this revision Revisions of this file |
diff -r 000000000000 -r 79012a2fa4d1 MMA8452.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/MMA8452.cpp Fri Jul 14 21:42:37 2017 +0000 @@ -0,0 +1,538 @@ +// Authors: Ashley Mills, Nicholas Herriot +/* Copyright (c) 2013 Vodafone, MIT License + * + * Permission is hereby granted, free of charge, to any person obtaining a copy of this software + * and associated documentation files (the "Software"), to deal in the Software without restriction, + * including without limitation the rights to use, copy, modify, merge, publish, distribute, + * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is + * furnished to do so, subject to the following conditions: + * + * The above copyright notice and this permission notice shall be included in all copies or + * substantial portions of the Software. + * + * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING + * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND + * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, + * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, + * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. + */ + +#include "MMA8452.h" +#include "mbed.h" + +#ifdef MMA8452_DEBUG +// you need to define Serial pc(USBTX,USBRX) somewhere for the below line to make sense +extern Serial pc; +#define MMA8452_DBG(...) pc.printf(__VA_ARGS__); pc.printf("\r\n"); +#else +#define MMA8452_DBG(...) +#endif + +// Connect module at I2C address using I2C port pins sda and scl +MMA8452::MMA8452(PinName sda, PinName scl, int frequency) : _i2c(sda, scl) , _frequency(frequency) { + MMA8452_DBG("Creating MMA8452"); + + // set I2C frequency + _i2c.frequency(_frequency); + + // setup read and write addresses for convenience + _readAddress = MMA8452_ADDRESS | 0x01; + _writeAddress = MMA8452_ADDRESS & 0xFE; + + // set some defaults + _bitDepth = BIT_DEPTH_UNKNOWN; + setBitDepth(BIT_DEPTH_12); + _dynamicRange = DYNAMIC_RANGE_UNKNOWN; + setDynamicRange(DYNAMIC_RANGE_2G); + + MMA8452_DBG("Done"); +} + + +// Destroys instance +MMA8452::~MMA8452() {} + +// Setting the control register bit 1 to true to activate the MMA8452 +int MMA8452::activate() { + // perform write and return error code + return logicalORRegister(MMA8452_CTRL_REG_1,MMA8452_ACTIVE_MASK); +} + +// Setting the control register bit 1 to 0 to standby the MMA8452 +int MMA8452::standby() { + // perform write and return error code + return logicalANDRegister(MMA8452_CTRL_REG_1,MMA8452_STANDBY_MASK); +} + +// this reads a register, applies a bitmask with logical AND, sets a value with logical OR, +// and optionally goes into and out of standby at the beginning and end of the function respectively +int MMA8452::maskAndApplyRegister(char reg, char mask, char value, int toggleActivation) { + if(toggleActivation) { + if(standby()) { + return 1; + } + } + + // read from register + char oldValue = 0; + if(readRegister(reg,&oldValue)) { + return 1; + } + + // apply bitmask + oldValue &= mask; + + // set value + oldValue |= value; + + // write back to register + if(writeRegister(reg,oldValue)) { + return 1; + } + + if(toggleActivation) { + if(activate()) { + return 1; + } + } + return 0; +} + +int MMA8452::setDynamicRange(DynamicRange range, int toggleActivation) { + _dynamicRange = range; + return maskAndApplyRegister( + MMA8452_XYZ_DATA_CFG, + MMA8452_DYNAMIC_RANGE_MASK, + range, + toggleActivation + ); +} + +int MMA8452::setDataRate(DataRateHz dataRate, int toggleActivation) { + return maskAndApplyRegister( + MMA8452_CTRL_REG_1, + MMA8452_DATA_RATE_MASK, + dataRate<<MMA8452_DATA_RATE_MASK_SHIFT, + toggleActivation + ); +} + +int MMA8452::setBitDepth(BitDepth depth,int toggleActivation) { + _bitDepth = depth; + return maskAndApplyRegister( + MMA8452_CTRL_REG_1, + MMA8452_BIT_DEPTH_MASK, + depth<<MMA8452_BIT_DEPTH_MASK_SHIFT, + toggleActivation + ); +} + +char MMA8452::getMaskedRegister(int addr, char mask) { + char rval = 0; + if(readRegister(addr,&rval)) { + return 0; + } + return (rval&mask); +} + +int MMA8452::isXYZReady() { + return getMaskedRegister(MMA8452_STATUS,MMA8452_STATUS_ZYXDR_MASK)>0; +} + +int MMA8452::isXReady() { + return getMaskedRegister(MMA8452_STATUS,MMA8452_STATUS_XDR_MASK)>0; +} + +int MMA8452::isYReady() { + return getMaskedRegister(MMA8452_STATUS,MMA8452_STATUS_YDR_MASK)>0; +} + +int MMA8452::isZReady() { + return getMaskedRegister(MMA8452_STATUS,MMA8452_STATUS_ZDR_MASK)>0; +} + + +int MMA8452::getDeviceID(char *dst) { + return readRegister(MMA8452_WHO_AM_I,dst); +} + +int MMA8452::getStatus(char* dst) { + return readRegister(MMA8452_STATUS,dst); +} + +MMA8452::DynamicRange MMA8452::getDynamicRange() { + char rval = 0; + if(readRegister(MMA8452_XYZ_DATA_CFG,&rval)) { + return MMA8452::DYNAMIC_RANGE_UNKNOWN; + } + rval &= (MMA8452_DYNAMIC_RANGE_MASK^0xFF); + return (MMA8452::DynamicRange)rval; +} + +MMA8452::DataRateHz MMA8452::getDataRate() { + char rval = 0; + if(readRegister(MMA8452_CTRL_REG_1,&rval)) { + return MMA8452::RATE_UNKNOWN; + } + // logical AND with inverse of mask + rval = rval&(MMA8452_DATA_RATE_MASK^0xFF); + // shift back into position + rval >>= MMA8452_DATA_RATE_MASK_SHIFT; + return (MMA8452::DataRateHz)rval; +} + +// Reads xyz +int MMA8452::readXYZRaw(char *dst) { + if(_bitDepth==BIT_DEPTH_UNKNOWN) { + return 1; + } + int readLen = 3; + if(_bitDepth==BIT_DEPTH_12) { + readLen = 6; + } + return readRegister(MMA8452_OUT_X_MSB,dst,readLen); +} + +int MMA8452::readXRaw(char *dst) { + if(_bitDepth==BIT_DEPTH_UNKNOWN) { + return 1; + } + int readLen = 1; + if(_bitDepth==BIT_DEPTH_12) { + readLen = 2; + } + return readRegister(MMA8452_OUT_X_MSB,dst,readLen); +} + +int MMA8452::readYRaw(char *dst) { + if(_bitDepth==BIT_DEPTH_UNKNOWN) { + return 1; + } + int readLen = 1; + if(_bitDepth==BIT_DEPTH_12) { + readLen = 2; + } + return readRegister(MMA8452_OUT_Y_MSB,dst,readLen); +} + +int MMA8452::readZRaw(char *dst) { + if(_bitDepth==BIT_DEPTH_UNKNOWN) { + return 1; + } + int readLen = 1; + if(_bitDepth==BIT_DEPTH_12) { + readLen = 2; + } + return readRegister(MMA8452_OUT_Z_MSB,dst,readLen); +} + +int MMA8452::readXYZCounts(int *x, int *y, int *z) { + char buf[6]; + if(readXYZRaw((char*)&buf)) { + return 1; + } + if(_bitDepth==BIT_DEPTH_12) { + *x = twelveBitToSigned(&buf[0]); + *y = twelveBitToSigned(&buf[2]); + *z = twelveBitToSigned(&buf[4]); + } else { + *x = eightBitToSigned(&buf[0]); + *y = eightBitToSigned(&buf[1]); + *z = eightBitToSigned(&buf[2]); + } + + return 0; +} + +int MMA8452::readXCount(int *x) { + char buf[2]; + if(readXRaw((char*)&buf)) { + return 1; + } + if(_bitDepth==BIT_DEPTH_12) { + *x = twelveBitToSigned(&buf[0]); + } else { + *x = eightBitToSigned(&buf[0]); + } + return 0; +} + +int MMA8452::readYCount(int *y) { + char buf[2]; + if(readYRaw((char*)&buf)) { + return 1; + } + if(_bitDepth==BIT_DEPTH_12) { + *y = twelveBitToSigned(&buf[0]); + } else { + *y = eightBitToSigned(&buf[0]); + } + return 0; +} + +int MMA8452::readZCount(int *z) { + char buf[2]; + if(readZRaw((char*)&buf)) { + return 1; + } + if(_bitDepth==BIT_DEPTH_12) { + *z = twelveBitToSigned(&buf[0]); + } else { + *z = eightBitToSigned(&buf[0]); + } + return 0; +} + +double MMA8452::convertCountToGravity(int count, int countsPerG) { + return (double)count/(double)countsPerG; +} + +int MMA8452::getCountsPerG() { + // assume starting with DYNAMIC_RANGE_2G and BIT_DEPTH_12 + int countsPerG = 1024; + if(_bitDepth==BIT_DEPTH_8) { + countsPerG = 64; + } + switch(_dynamicRange) { + case DYNAMIC_RANGE_4G: + countsPerG /= 2; + break; + case DYNAMIC_RANGE_8G: + countsPerG /= 4; + break; + } + return countsPerG; +} + +int MMA8452::readXYZGravity(double *x, double *y, double *z) { + int xCount = 0, yCount = 0, zCount = 0; + if(readXYZCounts(&xCount,&yCount,&zCount)) { + return 1; + } + int countsPerG = getCountsPerG(); + + *x = convertCountToGravity(xCount,countsPerG); + *y = convertCountToGravity(yCount,countsPerG); + *z = convertCountToGravity(zCount,countsPerG); + return 0; +} + +int MMA8452::readXGravity(double *x) { + int xCount = 0; + if(readXCount(&xCount)) { + return 1; + } + int countsPerG = getCountsPerG(); + + *x = convertCountToGravity(xCount,countsPerG); + return 0; +} + +int MMA8452::readYGravity(double *y) { + int yCount = 0; + if(readYCount(&yCount)) { + return 1; + } + int countsPerG = getCountsPerG(); + + *y = convertCountToGravity(yCount,countsPerG); + return 0; +} + +int MMA8452::readZGravity(double *z) { + int zCount = 0; + if(readZCount(&zCount)) { + return 1; + } + int countsPerG = getCountsPerG(); + + *z = convertCountToGravity(zCount,countsPerG); + return 0; +} + +// apply an AND mask to a register. read register value, apply mask, write it back +int MMA8452::logicalANDRegister(char addr, char mask) { + char value = 0; + // read register value + if(readRegister(addr,&value)) { + return 0; + } + // apply mask + value &= mask; + return writeRegister(addr,value); +} + + +// apply an OR mask to a register. read register value, apply mask, write it back +int MMA8452::logicalORRegister(char addr, char mask) { + char value = 0; + // read register value + if(readRegister(addr,&value)) { + return 0; + } + // apply mask + value |= mask; + return writeRegister(addr,value); +} + +// apply an OR mask to a register. read register value, apply mask, write it back +int MMA8452::logicalXORRegister(char addr, char mask) { + char value = 0; + // read register value + if(readRegister(addr,&value)) { + return 0; + } + // apply mask + value ^= mask; + return writeRegister(addr,value); +} + +// Write register (The device must be placed in Standby Mode to change the value of the registers) +int MMA8452::writeRegister(char addr, char data) { + // what this actually does is the following + // 1. tell I2C bus to start transaction + // 2. tell slave we want to write (slave address & write flag) + // 3. send the write address + // 4. send the data to write + // 5. tell I2C bus to end transaction + + // we can wrap this up in the I2C library write function + char buf[2] = {0,0}; + buf[0] = addr; + buf[1] = data; + return _i2c.write(MMA8452_ADDRESS, buf,2); + // note, could also do return writeRegister(addr,&data,1); +} + +int MMA8452::eightBitToSigned(char *buf) { + return (int8_t)*buf; +} + +int MMA8452::twelveBitToSigned(char *buf) { + // cheat by using the int16_t internal type + // all we need to do is convert to little-endian format and shift right + int16_t x = 0; + ((char*)&x)[1] = buf[0]; + ((char*)&x)[0] = buf[1]; + // note this only works because the below is an arithmetic right shift + return x>>4; +} + +int MMA8452::writeRegister(char addr, char *data, int nbytes) { + // writing multiple bytes is a little bit annoying because + // the I2C library doesn't support sending the address separately + // so we just do it manually + + // 1. tell I2C bus to start transaction + _i2c.start(); + // 2. tell slave we want to write (slave address & write flag) + if(_i2c.write(_writeAddress)!=1) { + return 1; + } + // 3. send the write address + if(_i2c.write(addr)!=1) { + return 1; + } + // 4. send the data to write + for(int i=0; i<nbytes; i++) { + if(_i2c.write(data[i])!=1) { + return 1; + } + } + // 5. tell I2C bus to end transaction + _i2c.stop(); + return 0; +} + +int MMA8452::readRegister(char addr, char *dst, int nbytes) { + // this is a bit odd, but basically proceeds like this + // 1. Send a start command + // 2. Tell the slave we want to write (slave address & write flag) + // 3. Send the address of the register (addr) + // 4. Send another start command to delineate read portion + // 5. Tell the slave we want to read (slave address & read flag) + // 6. Read the register value bytes + // 7. Send a stop command + + // we can wrap this process in the I2C library read and write commands + if(_i2c.write(MMA8452_ADDRESS,&addr,1,true)) { + return 1; + } + return _i2c.read(MMA8452_ADDRESS,dst,nbytes); +} + +// most registers are 1 byte, so here is a convenience function +int MMA8452::readRegister(char addr, char *dst) { + return readRegister(addr,dst,1); +} + +MMA8452::BitDepth MMA8452::getBitDepth() { + return _bitDepth; +} + +#ifdef MMA8452_DEBUG +void MMA8452::debugRegister(char reg) { + // get register value + char v = 0; + if(readRegister(reg,&v)) { + MMA8452_DBG("Error reading specified register"); + return; + } + // print out details + switch(reg) { + case MMA8452_CTRL_REG_1: + MMA8452_DBG("CTRL_REG_1 has value: 0x%x",v); + MMA8452_DBG(" 7 ALSP_RATE_1: %d",(v&0x80)>>7); + MMA8452_DBG(" 6 ALSP_RATE_0: %d",(v&0x40)>>6); + MMA8452_DBG(" 5 DR2: %d", (v&0x20)>>5); + MMA8452_DBG(" 4 DR1: %d", (v&0x10)>>4); + MMA8452_DBG(" 3 DR0: %d", (v&0x08)>>3); + MMA8452_DBG(" 2 LNOISE: %d", (v&0x04)>>2); + MMA8452_DBG(" 1 FREAD: %d", (v&0x02)>>1); + MMA8452_DBG(" 0 ACTIVE: %d", (v&0x01)); + break; + + case MMA8452_XYZ_DATA_CFG: + MMA8452_DBG("XYZ_DATA_CFG has value: 0x%x",v); + MMA8452_DBG(" 7 Unused: %d", (v&0x80)>>7); + MMA8452_DBG(" 6 0: %d", (v&0x40)>>6); + MMA8452_DBG(" 5 0: %d", (v&0x20)>>5); + MMA8452_DBG(" 4 HPF_Out: %d",(v&0x10)>>4); + MMA8452_DBG(" 3 0: %d", (v&0x08)>>3); + MMA8452_DBG(" 2 0: %d", (v&0x04)>>2); + MMA8452_DBG(" 1 FS1: %d", (v&0x02)>>1); + MMA8452_DBG(" 0 FS0: %d", (v&0x01)); + switch(v&0x03) { + case 0: + MMA8452_DBG("Dynamic range: 2G"); + break; + case 1: + MMA8452_DBG("Dynamic range: 4G"); + break; + case 2: + MMA8452_DBG("Dynamic range: 8G"); + break; + default: + MMA8452_DBG("Unknown dynamic range"); + break; + } + break; + + case MMA8452_STATUS: + MMA8452_DBG("STATUS has value: 0x%x",v); + MMA8452_DBG(" 7 ZYXOW: %d",(v&0x80)>>7); + MMA8452_DBG(" 6 ZOW: %d", (v&0x40)>>6); + MMA8452_DBG(" 5 YOW: %d", (v&0x20)>>5); + MMA8452_DBG(" 4 XOW: %d", (v&0x10)>>4); + MMA8452_DBG(" 3 ZYXDR: %d",(v&0x08)>>3); + MMA8452_DBG(" 2 ZDR: %d", (v&0x04)>>2); + MMA8452_DBG(" 1 YDR: %d", (v&0x02)>>1); + MMA8452_DBG(" 0 XDR: %d", (v&0x01)); + break; + + default: + MMA8452_DBG("Unknown register address: 0x%x",reg); + break; + } +} +#endif \ No newline at end of file
diff -r 000000000000 -r 79012a2fa4d1 MMA8452.h --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/MMA8452.h Fri Jul 14 21:42:37 2017 +0000 @@ -0,0 +1,343 @@ +#pragma once + +// Authors: Ashley Mills, Nicholas Herriot +/* Copyright (c) 2013 Vodafone, MIT License + * + * Permission is hereby granted, free of charge, to any person obtaining a copy of this software + * and associated documentation files (the "Software"), to deal in the Software without restriction, + * including without limitation the rights to use, copy, modify, merge, publish, distribute, + * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is + * furnished to do so, subject to the following conditions: + * + * The above copyright notice and this permission notice shall be included in all copies or + * substantial portions of the Software. + * + * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING + * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND + * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, + * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, + * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. + */ + +// the SparkFun breakout board defaults to 1, set to 0 if SA0 jumper on the bottom of the board is set +// see the Table 10. I2C Device Address Sequence in Freescale MMA8452Q pdf + +#include "mbed.h" + +#define MMA8452_DEBUG 1 + +// More info on MCU Master address can be found on section 5.10.1 of http://www.freescale.com/webapp/sps/site/prod_summary.jsp?code=MMA8452Q +#define SA0 1 +#if SA0 + #define MMA8452_ADDRESS 0x3A // 0x1D<<1 // SA0 is high, 0x1C if low - +#else + #define MMA8452_ADDRESS 0x38 // 0x1C<<1 +#endif + +// Register descriptions found in section 6 of pdf +#define MMA8452_STATUS 0x00 // Type 'read' : Status of the data registers +#define MMA8452_OUT_X_MSB 0x01 // Type 'read' : x axis - MSB of 2 byte sample +#define MMA8452_OUT_X_LSB 0x02 // Type 'read' : x axis - LSB of 2 byte sample +#define MMA8452_OUT_Y_MSB 0x03 // Type 'read' : y axis - MSB of 2 byte sample +#define MMA8452_OUT_Y_LSB 0x04 // Type 'read' : y axis - LSB of 2 byte sample +#define MMA8452_OUT_Z_MSB 0x05 // Type 'read' : z axis - MSB of 2 byte sample +#define MMA8452_OUT_Z_LSB 0x06 // Type 'read' : z axis - LSB of 2 byte sample + +// register definitions +#define MMA8452_XYZ_DATA_CFG 0x0E + +#define MMA8452_SYSMOD 0x0B // Type 'read' : This tells you if device is active, sleep or standy 0x00=STANDBY 0x01=WAKE 0x02=SLEEP +#define MMA8452_WHO_AM_I 0x0D // Type 'read' : This should return the device id of 0x2A + +#define MMA8452_PL_STATUS 0x10 // Type 'read' : This shows portrait landscape mode orientation +#define MMA8452_PL_CFG 0x11 // Type 'read/write' : This allows portrait landscape configuration +#define MMA8452_PL_COUNT 0x12 // Type 'read' : This is the portraint landscape debounce counter +#define MMA8452_PL_BF_ZCOMP 0x13 // Type 'read' : +#define MMA8452_PL_THS_REG 0x14 // Type 'read' : + +#define MMA8452_FF_MT_CFG 0X15 // Type 'read/write' : Freefaul motion functional block configuration +#define MMA8452_FF_MT_SRC 0X16 // Type 'read' : Freefaul motion event source register +#define MMA8452_FF_MT_THS 0X17 // Type 'read' : Freefaul motion threshold register +#define MMA8452_FF_COUNT 0X18 // Type 'read' : Freefaul motion debouce counter + +#define MMA8452_ASLP_COUNT 0x29 // Type 'read/write' : Counter settings for auto sleep +#define MMA8452_CTRL_REG_1 0x2A // Type 'read/write' : +#define MMA8452_CTRL_REG_2 0x2B // Type 'read/write' : +#define MMA8452_CTRL_REG_3 0x2C // Type 'read/write' : +#define MMA8452_CTRL_REG_4 0x2D // Type 'read/write' : +#define MMA8452_CTRL_REG_5 0x2E // Type 'read/write' : + +// Defined in table 13 of the Freescale PDF +/// xxx these all need to have better names +#define STANDBY 0x00 // State value returned after a SYSMOD request, it can be in state STANDBY, WAKE or SLEEP +#define WAKE 0x01 // State value returned after a SYSMOD request, it can be in state STANDBY, WAKE or SLEEP +#define SLEEP 0x02 // State value returned after a SYSMOD request, it can be in state STANDBY, WAKE or SLEEP +#define ACTIVE 0x01 // Stage value returned and set in Control Register 1, it can be STANDBY=00, or ACTIVE=01 + +#define TILT_STATUS 0x03 // Tilt Status (Read only) +#define SRST_STATUS 0x04 // Sample Rate Status Register (Read only) +#define SPCNT_STATUS 0x05 // Sleep Count Register (Read/Write) +#define INTSU_STATUS 0x06 // Interrupt Setup Register +#define MODE_STATUS 0x07 // Mode Register (Read/Write) +#define SR_STATUS 0x08 // Auto-Wake and Active Mode Portrait/Landscape Samples per Seconds Register (Read/Write) +#define PDET_STATUS 0x09 // Tap/Pulse Detection Register (Read/Write) +#define PD_STATUS 0xA // Tap/Pulse Debounce Count Register (Read/Write) + +// masks for enabling/disabling standby +#define MMA8452_ACTIVE_MASK 0x01 +#define MMA8452_STANDBY_MASK 0xFE + +// mask for dynamic range reading and writing +#define MMA8452_DYNAMIC_RANGE_MASK 0xFC + +// mask and shift for data rate reading and writing +#define MMA8452_DATA_RATE_MASK 0xC7 +#define MMA8452_DATA_RATE_MASK_SHIFT 0x03 + +// mask and shift for general reading and writing +#define MMA8452_WRITE_MASK 0xFE +#define MMA8452_READ_MASK 0x01 + +// mask and shift for bit depth reading and writing +#define MMA8452_BIT_DEPTH_MASK 0xFD +#define MMA8452_BIT_DEPTH_MASK_SHIFT 0x01 + +// status masks and shifts +#define MMA8452_STATUS_ZYXDR_MASK 0x08 +#define MMA8452_STATUS_ZDR_MASK 0x04 +#define MMA8452_STATUS_YDR_MASK 0x02 +#define MMA8452_STATUS_XDR_MASK 0x01 + +/** + * Wrapper for the MMA8452 I2C driven accelerometer. + */ +class MMA8452 { + + public: + + enum DynamicRange { + DYNAMIC_RANGE_2G=0x00, + DYNAMIC_RANGE_4G, + DYNAMIC_RANGE_8G, + DYNAMIC_RANGE_UNKNOWN + }; + + enum BitDepth { + BIT_DEPTH_12=0x00, + BIT_DEPTH_8, // 1 sets fast read mode, hence the inversion + BIT_DEPTH_UNKNOWN + }; + + enum DataRateHz { + RATE_800=0x00, + RATE_400, + RATE_200, + RATE_100, + RATE_50, + RATE_12_5, + RATE_6_25, + RATE_1_563, + RATE_UNKNOWN + }; + + /** + * Create an accelerometer object connected to the specified I2C pins. + * + * @param sda I2C data port + * @param scl I2C clock port + * @param frequency + * + */ + MMA8452(PinName sda, PinName scl, int frequency); + + /// Destructor + ~MMA8452(); + + /** + * Puts the MMA8452 in active mode. + * @return 0 on success, 1 on failure. + */ + int activate(); + + /** + * Puts the MMA8452 in standby. + * @return 0 on success, 1 on failure. + */ + int standby(); + + /** + * Read the device ID from the accelerometer (should be 0x2a) + * + * @param dst pointer to store the ID + * @return 0 on success, 1 on failure. + */ + int getDeviceID(char* dst); + + /** + * Read the MMA8452 status register. + * + * @param dst pointer to store the register value. + * @ return 0 on success, 1 on failure. + */ + int getStatus(char* dst); + + /** + * Read the raw x, y, an z registers of the MMA8452 in one operation. + * All three registers are read sequentially and stored in the provided buffer. + * The stored values are signed 2's complement left-aligned 12 or 8 bit integers. + * + * @param dst The destination buffer. Note that this needs to be 3 bytes for + * BIT_DEPTH_8 and 6 bytes for BIT_DEPTH_12. It is upto the caller to ensure this. + * @return 0 for success, and 1 for failure + * @sa setBitDepth + */ + int readXYZRaw(char *dst); + + /// Read the raw x register into the provided buffer. @sa readXYZRaw + int readXRaw(char *dst); + /// Read the raw y register into the provided buffer. @sa readXYZRaw + int readYRaw(char *dst); + /// Read the raw z register into the provided buffer. @sa readXYZRaw + int readZRaw(char *dst); + + /** + * Read the x, y, and z signed counts of the MMA8452 axes. + * + * Count resolution is either 8 bits or 12 bits, and the range is either +-2G, +-4G, or +-8G + * depending on settings. The number of counts per G are 1024, 512, 256 for 2,4, and 8 G + * respectively at 12 bit resolution and 64, 32, 16 for 2, 4, and 8 G respectively at + * 8 bit resolution. + * + * This function queries the MMA8452 and returns the signed counts for each axes. + * + * @param x Pointer to integer to store x count + * @param y Pointer to integer to store y count + * @param z Pointer to integer to store z count + * @return 0 on success, 1 on failure. + */ + int readXYZCounts(int *x, int *y, int *z); + + /// Read the x axes signed count. @sa readXYZCounts + int readXCount(int *x); + /// Read the y axes signed count. @sa readXYZCounts + int readYCount(int *y); + /// Read the z axes signed count. @sa readXYZCounts + int readZCount(int *z); + + /** + * Read the x, y, and z accelerations measured in G. + * + * The measurement resolution is controlled via setBitDepth which can + * be 8 or 12, and by setDynamicRange, which can be +-2G, +-4G, or +-8G. + * + * @param x A pointer to the double to store the x acceleration in. + * @param y A pointer to the double to store the y acceleration in. + * @param z A pointer to the double to store the z acceleration in. + * + * @return 0 on success, 1 on failure. + */ + int readXYZGravity(double *x, double *y, double *z); + + /// Read the x gravity in G into the provided double pointer. @sa readXYZGravity + int readXGravity(double *x); + /// Read the y gravity in G into the provided double pointer. @sa readXYZGravity + int readYGravity(double *y); + /// Read the z gravity in G into the provided double pointer. @sa readXYZGravity + int readZGravity(double *z); + + /// Returns 1 if data has been internally sampled (is available) for all axes since last read, 0 otherwise. + int isXYZReady(); + /// Returns 1 if data has been internally sampled (is available) for the x-axis since last read, 0 otherwise. + int isXReady(); + /// Returns 1 if data has been internally sampled (is available) for the y-axis since last read, 0 otherwise. + int isYReady(); + /// Returns 1 if data has been internally sampled (is available) for the z-axis since last read, 0 otherwise. + int isZReady(); + + /** + * Reads a single byte from the specified MMA8452 register. + * + * @param addr The internal register address. + * @param dst The destination buffer address. + * @return 1 on success, 0 on failure. + */ + int readRegister(char addr, char *dst); + + /** + * Reads n bytes from the specified MMA8452 register. + * + * @param addr The internal register address. + * @param dst The destination buffer address. + * @param nbytes The number of bytes to read. + * @return 1 on success, 0 on failure. + */ + int readRegister(char addr, char *dst, int nbytes); + + /** + * Write to the specified MMA8452 register. + * + * @param addr The internal register address + * @param data Data byte to write + */ + int writeRegister(char addr, char data); + + /** + * Write a data buffer to the specified MMA8452 register. + * + * @param addr The internal register address + * @param data Pointer to data buffer to write + * @param nbytes The length of the data buffer to write + */ + int writeRegister(char addr, char *data, int nbytes); + + int setDynamicRange(DynamicRange range, int toggleActivation=1); + int setBitDepth(BitDepth depth, int toggleActivation=1); + int setDataRate(DataRateHz dataRate, int toggleActivation=1); + + DynamicRange getDynamicRange(); + DataRateHz getDataRate(); + BitDepth getBitDepth(); + + #ifdef MMA8452_DEBUG + void debugRegister(char reg); + #endif + + private: + /** + * Reads the specified register, applies the mask with logical AND, logical ORs the value + * and writes back the result to the register. If toggleActivation is set to true then the + * device is put in standby before the operation, and activated at the end. + * Setting it to false is useful for setting options on a device that you want to keep in + * standby. + */ + int maskAndApplyRegister(char reg, char mask, char value, int toggleActivation); + + /// Reads the specified register, applies the mask with logical AND, and writes the result back. + int logicalANDRegister(char addr, char mask); + /// Reads the specified register, applies the mask with logical OR, and writes the result back. + int logicalORRegister(char addr, char mask); + /// Reads the specified register, applies the mask with logical XOR, and writes the result back. + int logicalXORRegister(char addr, char mask); + + /// Converts the 12-bit two's complement number in buf to a signed integer. Returns the integer. + int twelveBitToSigned(char *buf); + /// Converts the 8-bit two's complement number in buf to a signed integer. Returns the integer. + int eightBitToSigned(char *buf); + + /// Converts a count to a gravity using the supplied countsPerG. Returns the gravity. + double convertCountToGravity(int count, int countsPerG); + + /// Reads the register at addr, applies the mask with logical AND, and returns the result. + char getMaskedRegister(int addr, char mask); + + /// Get the counts per G for the current settings of bit depth and dynamic range. + int getCountsPerG(); + + I2C _i2c; + int _frequency; + int _readAddress; + int _writeAddress; + + BitDepth _bitDepth; + DynamicRange _dynamicRange; +}; \ No newline at end of file