DuongTD/data_convert
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

remove function

Browse Source
This commit is contained in:
duongtd 2025-12-05 11:28:20 +07:00
parent 59c8d4fd69
commit 7416a97789
1 changed files with 22 additions and 22 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

44
include/data_convert/data_convert.h
View File

@ -10,32 +10,32 @@
#include <robot/time.h>
#include <cmath>
template <typename T>
bool isEqual(const T& a, const T& b, double eps = 1e-5)
{
return std::fabs(a - b) < eps;
}
// template <typename T>
// bool isEqual(const T& a, const T& b, double eps = 1e-5)
// {
// return std::fabs(a - b) < eps;
// }
inline bool operator==(const geometry_msgs::Quaternion& a, const geometry_msgs::Quaternion& b)
{
return isEqual(a.x, b.x) && isEqual(a.y, b.y) && isEqual(a.z, b.z) && isEqual(a.w, b.w);
}
// inline bool operator==(const geometry_msgs::Quaternion& a, const geometry_msgs::Quaternion& b)
// {
// return isEqual(a.x, b.x) && isEqual(a.y, b.y) && isEqual(a.z, b.z) && isEqual(a.w, b.w);
// }
inline bool operator==(const geometry_msgs::Point& a, const geometry_msgs::Point& b)
{
return isEqual(a.x, b.x) && isEqual(a.y, b.y) && isEqual(a.z, b.z);
}
// inline bool operator==(const geometry_msgs::Point& a, const geometry_msgs::Point& b)
// {
// return isEqual(a.x, b.x) && isEqual(a.y, b.y) && isEqual(a.z, b.z);
// }
inline bool operator==(const geometry_msgs::Pose& a, const geometry_msgs::Pose& b)
{
return (a.position == b.position) && (a.orientation == b.orientation);
}
// inline bool operator==(const geometry_msgs::Pose& a, const geometry_msgs::Pose& b)
// {
// return (a.position == b.position) && (a.orientation == b.orientation);
// }
inline bool operator==(const geometry_msgs::PoseStamped& a, const geometry_msgs::PoseStamped& b)
{
return (a.header.frame_id == b.header.frame_id) &&
(a.pose == b.pose);
}
// inline bool operator==(const geometry_msgs::PoseStamped& a, const geometry_msgs::PoseStamped& b)
// {
// return (a.header.frame_id == b.header.frame_id) &&
// (a.pose == b.pose);
// }
namespace data_convert
{