#include <geometry_msgs/PointStamped.h>


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

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

    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; }

    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; }
};