0. 概要 姿勢を推定しようとしたところ、意外に困ったことが多かったので足回りの数式をまとめてみた。 特に、一般的な変換順序の回転行列は検索すれば出てくるのだけれども、いざ自身の開発しているプログラムに取り込もうとするとオーダーが異なっていて上手く取り込めないという事態が多く、ゼロベースから計算しているウェブサイトも余り見当たらなかったので、その辺について重点的に触れている。 1.0 姿勢について まず、ある物体の姿勢を表す時に用いる代表的な数式とその長短について説明する。 1.1 ロール・ピッチ・ヨー/オイラー角 (Euler angles) ロール・ピッチ・ヨー 一番、シンプルな方法として直交する3軸毎に回転角を設定するロール・ピッチ・ヨーの表現がある。 例えば、直交した3軸を次の順番Z->Y->Xで回転させた場合以下のようになる。 http://www.mech.tohoku-gak