Waypoint handler now gives desired orientation for vehicle.