#include <pose_helper.hpp>
Public Member Functions | |
double | calcAngularDistanceInRad (const geometry_msgs::Pose &pose1, const geometry_msgs::Pose &pose2) |
double | calcDistancePositionEucl (const geometry_msgs::Pose &pose1, const geometry_msgs::Pose &pose2) |
bool | checkOrientationsAreApproxEquale (const geometry_msgs::Pose &pose1, const geometry_msgs::Pose &pose2, const double orientation_rad_threshold) |
bool | checkPosesAreApproxEquale (const geometry_msgs::Pose &pose1, const geometry_msgs::Pose &pose2, const double position_threshold, const double orientation_rad_threshold) |
bool | checkPositionsAreApproxEquale (const geometry_msgs::Pose &pose1, const geometry_msgs::Pose &pose2, const double position_threshold) |
Static Public Member Functions | |
static boost::shared_ptr< PoseHelper > | getInstance () |
static void | resetInstance () |
Private Member Functions | |
Eigen::Quaterniond | convertPoseQuatToQuat (const geometry_msgs::Pose &pose) |
PoseHelper () | |
Static Private Attributes | |
static boost::shared_ptr< PoseHelper > | instance_ptr_ |
Definition at line 29 of file pose_helper.hpp.
|
private |
Definition at line 38 of file pose_helper.cpp.
double world_model::PoseHelper::calcAngularDistanceInRad | ( | const geometry_msgs::Pose & | pose1, |
const geometry_msgs::Pose & | pose2 | ||
) |
Definition at line 48 of file pose_helper.cpp.
double world_model::PoseHelper::calcDistancePositionEucl | ( | const geometry_msgs::Pose & | pose1, |
const geometry_msgs::Pose & | pose2 | ||
) |
Definition at line 42 of file pose_helper.cpp.
bool world_model::PoseHelper::checkOrientationsAreApproxEquale | ( | const geometry_msgs::Pose & | pose1, |
const geometry_msgs::Pose & | pose2, | ||
const double | orientation_rad_threshold | ||
) |
Definition at line 67 of file pose_helper.cpp.
bool world_model::PoseHelper::checkPosesAreApproxEquale | ( | const geometry_msgs::Pose & | pose1, |
const geometry_msgs::Pose & | pose2, | ||
const double | position_threshold, | ||
const double | orientation_rad_threshold | ||
) |
Definition at line 56 of file pose_helper.cpp.
bool world_model::PoseHelper::checkPositionsAreApproxEquale | ( | const geometry_msgs::Pose & | pose1, |
const geometry_msgs::Pose & | pose2, | ||
const double | position_threshold | ||
) |
Definition at line 62 of file pose_helper.cpp.
|
inlineprivate |
Definition at line 34 of file pose_helper.hpp.
|
static |
Definition at line 24 of file pose_helper.cpp.
|
static |
Definition at line 32 of file pose_helper.cpp.
|
staticprivate |
Definition at line 32 of file pose_helper.hpp.