アナログジャイロセンサーについて(その6)

ジャイロセンサを積む筐体が激しく動く場合、一瞬しか点灯しない0度表示では、目視確認でそれを見逃すこともあるかもしれないので、Arduionoの空き端子にLEDを追加して0度表示を拡張する。

f:id:ohguma:20190110020156p:plain

setup()の前に追加するLED用ピン定義を追記。

#define pinLedRight 5
#define pinLedLeft 7

setup()内にLED用ピンのモード設定を明示。

    pinMode(OUTPUT, pinLedRight);
    pinMode(OUTPUT, pinLedLeft);

loop()内のヨー角0度表示用処理に、0度近くの左右それぞれ表示用処理を追加。

        if (mydeg >= -5.0 && mydeg <= -1.0 ) {
            digitalWrite(pinLedLeft, HIGH);
        } else {
            digitalWrite(pinLedLeft, LOW);
        }

        if (mydeg >= 1.0 && mydeg <= 5.0 ) {
            digitalWrite(pinLedRight, HIGH);
        } else {
            digitalWrite(pinLedRight, LOW);
        }

Arduionoの空き端子はまだあるので、さらにLEDを増してもよいかも。

(つづくかも)