Add Waypoint Class

Added the Waypoint class with appropriate getters and setters.