File content as of revision 0:ff58cbebdb75:

#include "mbed.h"
#include "USBKeyboard.h"
#include "MMA7660.h"

MMA7660 MMA(p28, p27);
USBKeyboard keyboard;
DigitalOut connectionLed(LED1);

MMA7660::MMA7660(PinName sda, PinName scl, bool active) : _i2c(sda, scl)

{
    setActive(active);
    samplerate = 64;
}          
bool MMA7660::testConnection( void )
{
    if (_i2c.write(MMA7660_ADDRESS, NULL, 0) == 0 )
        return true;
    else
        return false;
}

void MMA7660::setActive(bool state)
{
    active = state;
    char modereg = read(MMA7660_MODE_R);
    modereg &= ~(1<<0);

    //If it somehow was in testmode, disable that
    if (modereg && (1<<2)) {
        modereg &= ~(1<<2);
        write(MMA7660_MODE_R, modereg);
    }

    modereg += state;
    write(MMA7660_MODE_R, modereg);
}                                                              //MMA7660::MMA7660(PinName sda, PinName scl, bool active) : _i2c(sda, scl)
int main()

{
    float x,y,z;
    {
        if (MMA.testConnection())
            connectionLed = 1;
    }
    void MMA7660::setsamplerate (int samplerate)
    {
        bool active_old = active;
        setActive(false);                               //Not allowed to be active to change anything
        int rates[] = {120, 64, 32, 16, 8, 4, 2, 1};    //Allowed samplerates (and their number in array is also number required for MMA)
        int sampleLoc = 0, sampleError = 10000, temp;
        for (int i = 0; i<8; i++) {
            temp = abs( rates[i] - samplerate );
            if (temp<sampleError) {
                sampleLoc = i;
                sampleError=temp;
            }
        }
        //Z1;                //variables to store acceleration values in X and Y


    }
    void MMA7660::readData(int *data) {
        bool active_old = active;
        if (!active) {
            setActive(true);
            wait(0.012 + 1/samplerate); //Wait until new sample is ready, my experience is that 1/samplerate isnt needed, but datasheet says so
        }

        char temp[3];
        bool alert;

        do {
            alert = false;
            read(MMA7660_XOUT_R, temp, 3);
            for (int i = 0; i<3; i++) {
                if (temp[i] > 63)
                    alert = true;
                if (temp[i] > 31)
                    temp[i] += 128+64;
                data[i] = (signed char)temp[i];
            }
        } while (alert);

        if (!active_old)
            setActive(false);


    }
    void MMA7660::readData(float *data) {
        int intdata[3];
        readData(intdata);
        for (int i = 0; i<3; i++)
            data[i] = intdata[i]/MMA7660_SENSITIVITY;
    }

    float MMA7660::x( void ) {
        return getSingle(0);
    }

    float MMA7660::y( void ) {
        return getSingle(1);
    }

    float MMA7660::z( void ) {
        return getSingle(2);
    }

    MMA7660::Orientation MMA7660::getSide( void ) {
        char tiltreg = read(MMA7660_TILT_R);
        //We care about 2 LSBs
        tiltreg &= 0x03;
        if (tiltreg == 0x01)
            return MMA7660::Front;
        if (tiltreg == 0x02)
            return MMA7660::Back;
        return MMA7660::Unknown;
    }

    MMA7660::Orientation MMA7660::getOrientation( void ) {
        char tiltreg = read(MMA7660_TILT_R);

        //We care about bit 2, 3 and 4 (counting from zero)
        tiltreg &= 0x07<<2;
        tiltreg >>= 2;
        if (tiltreg == 0x01)
            return MMA7660::Left;
        if (tiltreg == 0x02)
            return MMA7660::Right;
        if (tiltreg == 0x05)
            return MMA7660::Down;
        if (tiltreg == 0x06)
            return MMA7660::Up;
        return MMA7660::Unknown;
    }