16 #include <tf2/LinearMath/Quaternion.h>
17 #include <tf2/LinearMath/Matrix3x3.h>
18 #include <geometry_msgs/Pose.h>
36 msg.orientation.x = q.getX();
37 msg.orientation.y = q.getY();
38 msg.orientation.z = q.getZ();
39 msg.orientation.w = q.getW();
52 q.setValue(p.orientation.x,p.orientation.y,p.orientation.z,p.orientation.w);
54 double roll,pitch,
yaw;
55 m.getRPY(roll,pitch,
yaw);
ALFunction< T, T > * heading(AScalarToN< T, 2 > *df)
Definition: heading.h:114
yaw
Definition: adore_set_pose.py:36
Definition: areaofeffectconverter.h:20
Definition: quaternion.h:28
tf2::Quaternion headingToQuaternion(double heading) const
convert heading to quaternion
Definition: quaternion.h:42
double quaternionToHeading(const geometry_msgs::Pose &p) const
convert quaternion to heading
Definition: quaternion.h:49
void setHeading(double heading, geometry_msgs::Pose &msg) const
set heading of a Pose message
Definition: quaternion.h:31