IMU3000 main

#include "WProgram.h"
#include <MyLib.h>

#include <stdio.h>

using namespace std;

HardwareTimer timer(1);

void setup() {

    LCD::LCD();
    LCD::WriteText(10,10,"Initialization",Green,Black);

    IMU.Init(2, I2C_FAST_MODE);
    IMU.SetLowPassFilter(F_5Hz);
    IMU.Calibration();

    timer.setPrescaleFactor(1);
    timer.setOverflow(0xFFFF);


}

void loop() {

    char s[30];
    int t;
    timer.refresh();

    t = timer.getCount();
    IMU.Update();
    t = timer.getCount() - t;

    sprintf(s,"Gyro %5d %5d %5d",IMU.gyro.x,IMU.gyro.y,IMU.gyro.z);
    LCD::WriteText(10,30,s,Green,Black);
    sprintf(s,"Acc  %5d %5d %5d",IMU.acc.x,IMU.acc.y,IMU.acc.z);
    LCD::WriteText(10,50,s,Green,Black);
    sprintf(s,"Cal  %5d %5d %5d",IMU.calib.x,IMU.calib.y,IMU.calib.z);
    LCD::WriteText(10,70,s,Green,Black);
    sprintf(s,"Time = %3dus  ", t/72);
    LCD::WriteText(10,90,s,Green,Black);

}