Skip to content

Instantly share code, notes, and snippets.

@bricerebsamen

bricerebsamen/rpy_quat.cpp

Created May 6, 2015 23:44
Show Gist options
  • Save bricerebsamen/1b745086d3e8cbfbccf8 to your computer and use it in GitHub Desktop.
Save bricerebsamen/1b745086d3e8cbfbccf8 to your computer and use it in GitHub Desktop.
Download ZIP
roll pitch yaw from quaternion using KDL
Raw
rpy_quat.cpp
double roll, pitch, yaw;
KDL::Rotation::Quaternion(x, y, z, w).GetRPY(roll, pitch, yaw);
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment