#include "mbed.h"
#include "test_env.h"
#include "MMA7660.h"

#if defined(TARGET_FF_ARDUINO)
MMA7660 MMA(I2C_SDA, I2C_SCL);
#else
MMA7660 MMA(p28, p27);
#endif

int main() {
    MBED_HOSTTEST_TIMEOUT(15);
    MBED_HOSTTEST_SELECT(default_auto);
    MBED_HOSTTEST_DESCRIPTION(I2C MMA7660 accelerometer);
    MBED_HOSTTEST_START("MBED_A13");

    if (!MMA.testConnection())
        MBED_HOSTTEST_RESULT(false);

    for(int i = 0; i < 5; i++) {
        printf("x: %f, y: %f, z: %f\r\n", MMA.x(), MMA.y(), MMA.z());
        wait(0.2);
    }

    MBED_HOSTTEST_RESULT(true);
}