-Finished implementation of waypoint handler
-Removed test module Unit Waypoint