Waypoint Iteration 4

-Implemented waypoint tool
-Waypoints work
-Warppoints DONT work yet...