MMA8451Q.cpp

00001 /**
00002  * MMA8451Q 3-Axis, 14-bit/8-bit Digital Accelerometer
00003  */
00004  
00005 #include "mbed.h"
00006 #include "MMA8451Q.h"
00007 #include "af_mgr.h"
00008 
00009 #define REG_STATUS           0x00 // when F_MODE = 00
00010 #define REG_FIFO_STATUS      0x00 // when F_MODE > 0
00011 #define REG_XYZ_FIFO         0x01 // Root pointer to XYZ FIFO data
00012 #define REG_OUT_X_MSB        0x01 // 8 MSBs of 14-bit sample
00013 #define REG_OUT_X_LSB        0x02 // 6 LSBs of 14-bit sample
00014 #define REG_OUT_Y_MSB        0x03 
00015 #define REG_OUT_Y_LSB        0x04
00016 #define REG_OUT_Z_MSB        0x05
00017 #define REG_OUT_Z_LSB        0x06
00018 #define REG_F_SETUP          0x09 // FIFO setup
00019 #define REG_TRIG_CFG         0x0A // Map of FIFO daa capture events
00020 #define REG_SYSMOD           0x0B // Current System Mode
00021 #define REG_INT_SOURCE       0x0C // Interrupt status
00022 #define REG_WHO_AM_I         0x0D // Device ID (0x1A)
00023 #define REG_XYZ_DATA_CFG     0x0E // Dynamic Range Settings
00024 #define REG_HP_FILTER_CUTOFF 0x0F // Cutoff freq is set to 16Hz@800Hz
00025 #define REG_PL_STATUS        0x10 // Landscape/Portrait orientation status
00026 #define REG_PL_CFG           0x11 // Landscape/Portrait configuration
00027 #define REG_PL_COUNT         0x12 // Landscape/Portrait debounce counter 
00028 #define REG_PL_BF_ZCOMP      0x13 // Back/Front, Z-Lock Trip threshold
00029 #define REG_P_L_THS_REG      0x14 // Portrait to Landscape Trip Angle is 29 degree
00030 #define REG_FF_MT_CFG        0x15 // Freefall/Motion function block configuration
00031 #define REG_FF_MT_SRC        0x16 // Freefall/Motion event source register
00032 #define REG_FF_MT_THS        0x17 // Freefall/Motion threshold register
00033 #define REG_FF_MT_COUNT      0x18 // Freefall/Motion debounce counter
00034 // TRANSIENT
00035 #define REG_TRANSIENT_CFG    0x1D // Transient functional block configuration
00036 #define REG_TRANSIENT_SRC    0x1E // Transient event status register
00037 #define REG_TRANSIENT_THS    0x1F // Transient event threshold
00038 #define REG_TRANSIENT_COUNT  0x20 // Transient debounce counter
00039 // PULSE
00040 #define REG_PULSE_CFG        0x21 // ELE, Double_XYZ or Single_XYZ
00041 #define REG_PULSE_SRC        0x22 // EA, Double_XYZ or Single_XYZ
00042 #define REG_PULSE_THSX       0x23 // X pulse threshold
00043 #define REG_PULSE_THSY       0x24 // Y pulse threshold
00044 #define REG_PULSE_THSZ       0x25 // Z pulse threshold
00045 #define REG_PULSE_TMLT       0x26 // Time limit for pulse
00046 #define REG_PULSE_LTCY       0x27 // Latency time for 2nd pulse
00047 #define REG_PULSE_WIND       0x28 // Window time for 2nd pulse
00048 #define REG_ASLP_COUNT       0x29 // Counter setting for Auto-SLEEP
00049 // Control Registers
00050 #define REG_CTRL_REG1        0x2A // ODR = 800Hz, STANDBY Mode
00051 #define REG_CTRL_REG2        0x2B // Sleep Enable, OS Modes, RST, ST
00052 #define REG_CTRL_REG3        0x2C // Wake from Sleep, IPOL, PP_OD
00053 #define REG_CTRL_REG4        0x2D // Interrupt enable register
00054 #define REG_CTRL_REG5        0x2E // Interrupt pin (INT1/INT2) map
00055 // User Offset
00056 #define REG_OFF_X            0x2F // X-axis offset adjust
00057 #define REG_OFF_Y            0x30 // Y-axis offset adjust
00058 #define REG_OFF_Z            0x31 // Z-axis offset adjust
00059 
00060 // Value definitions
00061 #define BIT_TRIG_TRANS       0x20  // Transient interrupt trigger bit
00062 #define BIT_TRIG_LNDPRT      0x10  // Landscape/Portrati Orientation
00063 #define BIT_TRIG_PULSE       0x08  // Pulse interrupt trigger bit
00064 #define BIT_TRIG_FF_MT       0x04  // Freefall/Motion trigger bit
00065 
00066 MMA8451Q::MMA8451Q(I2C *i2c, int addr) : m_addr(addr<<1) {
00067     // activate the peripheral
00068     p_i2c = i2c ;
00069     uint8_t data[2] = {REG_CTRL_REG1, 0x01};
00070     writeRegs(data, 2);
00071 }
00072 
00073 MMA8451Q::~MMA8451Q() { }
00074 
00075 int MMA8451Q::readRegs(int addr, uint8_t * data, int len) 
00076 {
00077     char t[1] = {addr};
00078     int result ;
00079     __disable_irq() ; // Disable Interrupts
00080     result = p_i2c->write(m_addr, t, 1, true);
00081     if (result == 0) {
00082         result = p_i2c->read(m_addr, (char *)data, len);
00083     }
00084     __enable_irq() ; // Enable Interrupts
00085     return( result ) ;
00086 }
00087 
00088 int MMA8451Q::writeRegs(uint8_t * data, int len) 
00089 {
00090     int result ;
00091     __disable_irq() ; // Disable Interrupts
00092     result = p_i2c->write(m_addr, (char *)data, len);
00093     __enable_irq() ; // Enable Interrupts
00094     return( result ) ;
00095 }
00096 
00097 int MMA8451Q::getAllRawData(int16_t value[])
00098 {
00099     int result ;
00100     uint8_t data[6] ;
00101     result = readRegs(REG_OUT_X_MSB, data, 6) ;
00102     if (result == 0) {
00103         value[0] = ((int16_t)((data[0] << 8) | data[1])) >> 2 ;
00104         value[1] = ((int16_t)((data[2] << 8) | data[3])) >> 2 ;
00105         value[2] = ((int16_t)((data[4] << 8) | data[5])) >> 2 ;
00106     }
00107     return( result ) ;
00108 }
00109 
00110 int MMA8451Q::getAllData(float fvalue[])
00111 {
00112     int result ;
00113     uint8_t data[6] ;
00114     result = readRegs(REG_OUT_X_MSB, data, 6) ;
00115     if (result == 0) {
00116         fvalue[0] = (float)((int16_t)((data[0] << 8) | data[1])) / 16384.0 ;
00117         fvalue[1] = (float)((int16_t)((data[2] << 8) | data[3])) / 16384.0 ;
00118         fvalue[2] = (float)((int16_t)((data[4] << 8) | data[5])) / 16384.0 ;
00119     }
00120     return( result ) ;
00121 }
00122 
00123 int16_t MMA8451Q::getRawData(uint8_t addr)
00124 {
00125     int16_t value ;
00126     uint8_t data[2] ;
00127     readRegs(addr, data, 2) ;
00128     value = ((int16_t)((data[0] << 8) | data[1])) >> 2 ;
00129     return( value ) ;
00130 }
00131 
00132 int16_t MMA8451Q::getRawX(void) 
00133 {
00134     int16_t value ;
00135     value = getRawData(REG_OUT_X_MSB) ;
00136     return( value ) ;
00137 }
00138 
00139 int16_t MMA8451Q::getRawY(void) 
00140 {
00141     int16_t value ;
00142     value = getRawData(REG_OUT_Y_MSB) ;
00143     return( value ) ;
00144 }
00145 
00146 int16_t MMA8451Q::getRawZ(void) 
00147 {
00148     int16_t value ;
00149     value = getRawData(REG_OUT_Z_MSB) ;
00150     return( value ) ;
00151 }
00152   
00153 float MMA8451Q::getAccX(void)
00154 {
00155     return(((float)getRawX())/4096.0) ;
00156 }
00157 
00158 float MMA8451Q::getAccY(void) 
00159 {
00160     return(((float)getRawY())/4096.0) ;
00161 }
00162 
00163 float MMA8451Q::getAccZ(void) 
00164 {
00165     return(((float)getRawZ())/4096.0) ;
00166 }