ジャイロセンサのヨー角を電圧で出力できてもパッと見には何も変化がないので、動作確認用も兼ねてセンター(0度)付近の向きが分かるようにLEDを追加する。LEDに接続する抵抗は適当なものを選択する。
setup()の前にLEDを接続するピン番号の定義を追記。ピン番号は適当に選択する。
#define pinLedCenter 6
setup()内に追記して、LEDを接続するピンを出力モードに変更。
pinMode(OUTPUT, pinLedCenter);
loop()内に追記して、ヨー角が0度付近でLEDをONにする。
if (mympu.ypr[0] >= -1.0 && mympu.ypr[0] <= 1.0 ) { digitalWrite(pinLedCenter, HIGH); } else { digitalWrite(pinLedCenter, LOW); }
(つづく)