#include <geometry_msgs/PointStamped.h>


class Waypoint : public geometry_msgs::PointStamped {
public:
    float vel;
    float rad;
    bool stop;

    Waypoint() : 
        vel(1.0), 
        rad(0.8), 
        stop(false)
    {
    }

    double get_x() { return point.x; }
    double get_y() { return point.y; }
    double get_z() { return point.z; }
    float get_vel() { return vel; }
    float get_rad() { return rad; }
    bool get_stop() { return stop; }

    void set_x(double x) { point.x = x; }
    void set_y(double y) { point.y = y; }
    void set_z(double z) { point.z = z; }
    void set_vel(float v) { vel = v; }
    void set_rad(float r) { rad = r; }
    void set_stop(bool s) { stop = s; }
};