[C++] Quaternion to Euler λ³ν
Quaternion to EulerPermalink
λ§μ΄ μ΄λ€β¦
νμ§λ§ μ μ μΈμμ Έμ μΌλ¨ λΈλ‘κ·Έμ λ¨κΈ΄λ€
quat to eulerPermalink
μ½λλ μλμ κ°μ΄ μ¬μ©
νλ©΄ λ¨
ax+by+cz=1
#include <tf/tf.h>
tf::Quaternion q(
msg->pose.pose.orientation.x,
msg->pose.pose.orientation.y,
msg->pose.pose.orientation.z,
msg->pose.pose.orientation.w);
tf::Matrix3x3 m(q);
double roll, pitch, yaw;
m.getRPY(roll, pitch, yaw);
Leave a comment