#ifndef _WAYPOINT_H_
#define _WAYPOINT_H_

#include "geometry_msgs/Pose.h"
#include "ros/ros.h"

class Waypoint 
{
  public:
    geometry_msgs::Pose pose;
    ros::Duration  timepoint;
    Waypoint();
    Waypoint (geometry_msgs::Pose, ros::Duration);
    double distanceTo(geometry_msgs::Pose);
    double angleTo(geometry_msgs::Pose);
};

#endif