#include "L3G4200D.h"
#include "HMC5883L.h"
#include "I2CLCD.h"

int main()
{
  I2CLCD lcd(p9,p10);
  L3G4200D motion;
  HMC5883L compass;
  short data[3];

  while(true)
  {
    motion.readData(data);
    lcd.write(data[0],5,0);
    lcd.write(data[1],5,0);
    lcd.write(data[2],5,0);
    int degree = compass.readData();
    lcd.write("\nAzimus=");
    lcd.write(degree,3,0);
    wait_ms(100);
    lcd.home();
  }
}

 1 ジャイロセンサーの定義
 2 方位センサーの定義
 3 LCDの定義
 4 
 5 
 6 
 7 LCDのオブジェクト
 8 ジャイロセンサーのオブジェクト
 9 方位センサーのオブジェクト
10 ジャイロの値を入れる配列
11 
12 
13 
14 動きを測定
15 
16 
17 
18 方位を測定
19 
20 
21 
22 
23 
24