File content as of revision 3:df25c72e16be:

// Author: Edoardo De Marchi
/* Copyright (C) 2012 mbed.org, 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 "MMA7660FC.h"

#define OUT_X 0x00              // [6:0] are Read Only 6-bit output value X (XOUT[5] is 0 if the g direction is positive, 1 is negative)
#define OUT_Y 0x01              // [6:0] are Read Only 6-bit output value Y (YOUT[5] is 0 if the g direction is positive, 1 is negative)
#define OUT_Z 0x02              // [6:0] are Read Only 6-bit output value Z (ZOUT[5] is 0 if the g direction is positive, 1 is negative)
#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)



        // Connect module at I2C address addr using I2C port pins sda and scl
MMA7660FC::MMA7660FC(PinName sda, PinName scl, int addr) : m_i2c(sda, scl), m_addr(addr)
{

}


        // Destroys instance
MMA7660FC::~MMA7660FC()
{

}


        // Device initialization
void MMA7660FC::init()
{
    
    write_reg(INTSU_STATUS, 0x10);      // automatic interrupt after every measurement
    write_reg(SR_STATUS, 0x00);         // 120 Samples/Second
    write_reg(MODE_STATUS, 0x01);       // Active Mode
    
}


        // Reads X, Y, Z data
void MMA7660FC::read_g(int *x, int *y, int *z)
{

    const char Addr_X = OUT_X;
    char buf[3] = {0,0,0};
    
    m_i2c.write(m_addr, &Addr_X, 1);         // Pointer to the OUT_X register
    m_i2c.read(m_addr, buf, 3);              // Read register content into buffer with 6bit
    
    *x = buf[0];
    *y = buf[1];
    *z = buf[2];      
  
}


      // Reads x data
float MMA7660FC::read_x()
{

    m_i2c.start();                  // Start
    m_i2c.write(0x98);              // A write to device 0x98
    m_i2c.write(OUT_X);             // Register to read
    m_i2c.start();                  
    m_i2c.write(0x99);              // Read from device 0x99
    char x = m_i2c.read(0);         // Read the data
    m_i2c.stop();
    
    return (float)x;  

}


      // Reads y data
float MMA7660FC::read_y()
{

    m_i2c.start();                  // Start
    m_i2c.write(0x98);              // A write to device 0x98
    m_i2c.write(OUT_Y);             // Register to read
    m_i2c.start();                  
    m_i2c.write(0x99);              // Read from device 0x99
    char y = m_i2c.read(0);         // Read the data
    m_i2c.stop();
    
    return (float)y; 

}


      // Reads z data
float MMA7660FC::read_z()
{

    m_i2c.start();                  // Start
    m_i2c.write(0x98);              // A write to device 0x98
    m_i2c.write(OUT_Z);             // Register to read
    m_i2c.start();                  
    m_i2c.write(0x99);              // Read from device 0x99
    char z = m_i2c.read(0);         // Read the data
    m_i2c.stop();
    
    return (float)z;

}


        // Read from specified MMA7660FC register
char MMA7660FC::read_reg(char addr)
{
    
    m_i2c.start();                  // Start
    m_i2c.write(0x98);              // A write to device 0x98
    m_i2c.write(addr);              // Register to read
    m_i2c.start();                  
    m_i2c.write(0x99);              // Read from device 0x99
    char c = m_i2c.read(0);         // Read the data
    m_i2c.stop();                   
 
    return c;
    
}


        // Write register (The device must be placed in Standby Mode to change the value of the registers) 
void MMA7660FC::write_reg(char addr, char data)
{

    char cmd[2] = {0, 0};
    
    cmd[0] = MODE_STATUS;
    cmd[1] = 0x00;                      // Standby Mode on
    m_i2c.write(m_addr, cmd, 2);
  
    cmd[0] = addr;
    cmd[1] = data;                      // New value of the register
    m_i2c.write(m_addr, cmd, 2); 
      
    cmd[0] = MODE_STATUS;
    cmd[1] = 0x01;                      // Active Mode on
    m_i2c.write(m_addr, cmd, 2);
                  
}