Added WayPointManager, VectorDistanceToLine