35 #ifndef DWB_CRITICS_ALIGNMENT_UTIL_H 36 #define DWB_CRITICS_ALIGNMENT_UTIL_H 38 #include <geometry_msgs/Pose2D.h> 54 #endif // DWB_CRITICS_ALIGNMENT_UTIL_H TFSIMD_FORCE_INLINE tfScalar distance(const Vector3 &v) const
geometry_msgs::Pose2D getForwardPose(const geometry_msgs::Pose2D &pose, double distance)
Projects the given pose forward the specified distance in the x direction.