サーボの現在位置をみれる関数の作成

[RyuYamamoto]

現段階のプログラムだとサーボを動かしてからでないと角度を取得できないので、取得専用の関数を作成する。

[RyuYamamoto]

どうやらサーボ駆動用の関数でも角度が正常に返せていないようなので、まずはそこのバグから直す。

[RyuYamamoto]

角度が読めない問題に関して、3回送信していたのに対して、受信を6回していて、返却時に割り振られていない変数の値を取り出していたので正常に角度が読めていなかった。

ちなみに受信を6回していたのは速度を変更するときに送信3回に対して受信を6回しなければならないため。