カルマンフィルタを用いることで、だいぶ安定するようになった。
秋月のジャイロモジュールの場合、ハイパスフィルタが入っているので取り除く必要があるかと思ったが、今回使用したアルゴリズムだと、そのままのデータで問題がなかった。 積分する必要もなかった。逆に積分してしまうと値がおかしくなってしまった。
カルマンフィルタに関してほとんど知らないので、なぜかは良く分からない。単純に加速度計のデータの方が重みがあるのかもしれない。
これで姿勢制御ができれば、いろいろなものに応用できる。