37 lines
754 B
C++
37 lines
754 B
C++
#ifndef POSE_H
|
|
#define POSE_H
|
|
|
|
#include <cmath>
|
|
#include <iostream>
|
|
#include <geometry_msgs/Point.h>
|
|
#include <geometry_msgs/Quaternion.h>
|
|
|
|
namespace geometry_msgs
|
|
{
|
|
|
|
struct Pose
|
|
{
|
|
Point position;
|
|
Quaternion orientation;
|
|
|
|
Pose() = default;
|
|
|
|
Pose(Point position_, Quaternion orientation_)
|
|
: position(position_), orientation(orientation_) {};
|
|
};
|
|
|
|
// constants requiring out of line definition
|
|
inline bool operator==(const geometry_msgs::Pose &lhs, const geometry_msgs::Pose &rhs)
|
|
{
|
|
return lhs.position == rhs.position &&
|
|
lhs.orientation == rhs.orientation;
|
|
}
|
|
|
|
inline bool operator!=(const geometry_msgs::Pose &lhs, const geometry_msgs::Pose &rhs)
|
|
{
|
|
return !(lhs == rhs);
|
|
}
|
|
|
|
} // namespace geometry_msgs
|
|
|
|
#endif // POSE_H
|