Stop drawing higlight lines over things.
Show next waypoint too
Fix an indentw
Fix collisions
Initial waypoint collision detection
Working waypoint collisions