Add toggle button to allow user select if offset waypoints or not