#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.