void WaypointSaver::poseCallback(const geometry_msgs::PoseStampedConstPtr &pose_msg) const
{
outputProcessing(pose_msg->pose, 0);
}
void WaypointSaver::TwistPoseCallback(const geometry_msgs::TwistStampedConstPtr &twist_msg,
const geometry_msgs::PoseStampedConstPtr &pose_msg) const
{
outputProcessing(pose_msg->pose, mps2kmph(twist_msg->twist.linear.x));
}
void WaypointSaver::CaninfoPoseCallback(const vehicle_socket::CanInfoConstPtr &can_msg,
const geometry_msgs::PoseStampedConstPtr &pose_msg) const
{
outputProcessing(pose_msg->pose,can_msg->speed);
}