Rigid bodyにおいて姿勢角を計測したいのですがどのようにしたら良いでしょうか?
5 views (last 30 days)
Show older comments
MathWorks Support Team
on 31 Aug 2020
Answered: MathWorks Support Team
on 31 Aug 2020
Simscape multibodyにてあるフレームのロール角度を計測したいと考えています。
どのようにしたら良いでしょうか?
Accepted Answer
MathWorks Support Team
on 31 Aug 2020
Transform sensorブロックを使用して計測したいBase-Follower間のプロパティを確認してください。
なお、本ブロックでは各姿勢角そのものは計算していません。
各軸の角速度は出力できますが、これを積分して角度とすることは出来ません。
角度を計算したい場合には、クォータニオンQや回転行列Rからオイラー角を算出します。
例えば、回転行列Rからオイラー角(ロール、ピッチ、ヨー)は以下の算出式で求めることが可能です。
y = atan2(R(2,1),R(1,1));
p = atan2(-R(3,1),sqrt(R(3,2)^2+R(3,3)^2));
r = atan2(R(3,2),R(3,3));
またRobotics Toolboxをお持ちであれば回転行列R、クォータニオンQからオイラー角に変換するコマンドがあります。
rotm2eul:
quat2eul:
0 Comments
More Answers (0)
See Also
Categories
Find more on Applications in Help Center and File Exchange
Community Treasure Hunt
Find the treasures in MATLAB Central and discover how the community can help you!
Start Hunting!