Setting up to do waypoint straight-line following