cleanup geometry/poses header

crosbot/include/crosbot/geometry/poses.hpp

@@ -333,28 +333,6 @@ public:
 };
 #endif
 
-/**
- * Methods to transform between Poses and btTransforms
- */
-//inline void getPoseFromTransform(const btTransform& trans, geometry_msgs::Pose& pose) {
-//    const btVector3& pos = trans.getOrigin();
-//    pose.position.x = pos.x();
-//    pose.position.y = pos.y();
-//    pose.position.z = pos.z();
-//    btQuaternion q =  trans.getRotation();
-//    pose.orientation.x = q.x();
-//    pose.orientation.y = q.y();
-//    pose.orientation.z = q.z();
-//    pose.orientation.w = q.w();
-//}
-//
-//inline void getTransformFromPose(const geometry_msgs::Pose& pose, btTransform& trans) {
-//    btVector3 pos(pose.position.x, pose.position.y, pose.position.z);
-//    trans.setOrigin(pos);
-//    btQuaternion q(pose.orientation.x, pose.orientation.y, pose.orientation.z, pose.orientation.w);
-//    trans.setRotation(q);
-//}
-
 } // namespace crosbot