yoshimi.'s Diary

よしみ.が過去にやってきたことに掃き溜めです

Gazeboで相補フィルタを用いて角度を算出する

Gazebo上でIMUのついている物体の傾きをRoll, Pitchの角度[度or rad]で求めたかったので、実践した。

参考文献

taku-info.com

github.com

これらを基にGazebo用に書き換えた。

f:id:yoshistl:20210613234520p:plain

物体(Gazeboの画面は諸事情により割愛)を-90度傾けたときの様子(背景が透けているのはご愛嬌で)。

まぁ、大体あってるのでヨシ!(ホントか?)

コードの可読性ゴミかつ精度が保障されてなくてもいいよという方はこちらを参考にしてください...

github.com