fixed coordinates
Working waypoints, holy crap
Line splitting finally works, now figure out the start and end problems