回転行列からロール ピッチ ヨー角度を抽出する必要があり、自分の行っていることが正しいことを確認したい。
Eigen::Matrix< simFloat, 3, 1> rpy = orientation.toRotationMatrix().eulerAngles(0,1,2);
const double r = ((double)rpy(0));
const double p = ((double)rpy(1));
const double y = ((double)rpy(2));
あれは正しいですか?私はここを読んでいたので: http://eigen.tuxfamily.org/dox/group__Geometry__Module.html#gad118fececd448d7485ffea4858775e5a
そして、説明の最後に、間隔が角度を定義すると言われているとき、私は少し混乱しました.