diff --git a/clever/src/util.h b/clever/src/util.h deleted file mode 100644 index 0eb7f1e9..00000000 --- a/clever/src/util.h +++ /dev/null @@ -1,17 +0,0 @@ -#pragma once - -#include -#include - -inline void quaternionToEuler(geometry_msgs::Quaternion q, double& roll, double& pitch, double& yaw) -{ - tf::Quaternion tfq(q.x, q.y, q.z, q.w); - tf::Matrix3x3 m(tfq); - m.getRPY(roll, pitch, yaw); -} - -inline void eulerToQuaternion(geometry_msgs::Quaternion& q, double roll, double pitch, double yaw) -{ - tf::Quaternion tfq(roll, pitch, yaw); - quaternionTFToMsg(tfq, q); -}