Skip to content

Instantly share code, notes, and snippets.

@qh-huang

qh-huang/Create an Eigen Quaternion from Roll, Pitch Yaw (in rad)

Last active June 23, 2016 09:59
Show Gist options
  • Save qh-huang/bce1d37de0879821dec41767a675a79c to your computer and use it in GitHub Desktop.
Save qh-huang/bce1d37de0879821dec41767a675a79c to your computer and use it in GitHub Desktop.
Download ZIP
Playing with Robotic Programming
Raw
Create an Eigen Quaternion from Roll, Pitch Yaw (in rad)
Eigen::Quaternion<float> q;
Eigen::AngleAxis<float> aaZ(pcl::deg2rad(rz), Eigen::Vector3f::UnitZ());
Eigen::AngleAxis<float> aaY(pcl::deg2rad(ry), Eigen::Vector3f::UnitY());
Eigen::AngleAxis<float> aaX(pcl::deg2rad(rx), Eigen::Vector3f::UnitX());
q = aaZ * aaY * aaX;
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment