2014/06/24

ジャイロセンサ Act.2

くらんべりーさんのウエブログ
「特に縛りなく」
を http://cranberrytree.blogspot.jp/
よく読ませていただいてます。

Arduino 関連の情報が満載です。
「加速度+ジャイロのGY-521(MPU-6050)を使ってみた -2- カルマンフィルター」
http://cranberrytree.blogspot.jp/2014/06/gy-521mpu-6050-2.html

のスケッチを改造し、
PC
---------------------
  Serial.print("kalAngleX = ");
  Serial.print(kalAngleX, 2);
  Serial.print("(");
  Serial.print(roll, 2);
  Serial.print("\t");
  Serial.print("kalAngleY = ");
  Serial.print(kalAngleY, 2);
  Serial.print("(");
  Serial.print(pitch, 2);
  Serial.print("\t");
  Serial.print("gyroZangle = ");
  Serial.print(gyroZangle, 2);
  Serial.println("");
---------------------
LCD
---------------------
  nX = int(round(roll * 100));
  nY = int(round(pitch * 100));
  sprintf(StrBuf_nX, "%5d", nX);
  sprintf(StrBuf_nY, "%5d", nY);

  kX = int(round(kalAngleX * 100));
  kY = int(round(kalAngleY * 100));
  sprintf(StrBuf_kX, "%5d", kX);
  sprintf(StrBuf_kY, "%5d", kY);
---------------------
表示させてみました。
時間が経過してもX方向Y方向とも
数値に目立った変はありませんでした。


急遽、3点支持台を製作しました。

0 件のコメント:

コメントを投稿