Fixed waypoint won't reset when adding a new destination
Draw waypoints
Remove unsless waypoints
Attempt to fix pathfinding