#include "mbed.h"
#include "MMA7660.h"
#include "commands.h"

DigitalOut Zaxis_p(LED2);
DigitalOut Zaxis_n(LED3);
MMA7660 MMA(p28, p27);

static void _Initialize(void) {
    Zaxis_p = 0;
    Zaxis_n = 0;
}

static void _Process(void) {
    Zaxis_p = MMA.z();
    Zaxis_n = -MMA.z();
}

static void _Finalize(void) {
    _Initialize();
}

COMMAND_DEFINE Command_accel = {"accel", 0x02, _Initialize, _Finalize, _Process};