US Patent 9971352 Automated co-pilot control for autonomous vehicles

A control system for a vehicle includes at least one controller. The controller is programmed to receive first sensor readings from a first group of sensors and provide a first vehicle pose based on the first sensor readings. The first vehicle pose includes a first location and a first orientation of the vehicle. The controller is also programmed to receive second sensor readings from a second group of sensors and provide a second vehicle pose based on the second sensor readings. The second vehicle pose includes a second location and a second orientation of the vehicle. The controller is further programmed to, in response to the first vehicle pose being outside a predetermined range of the second vehicle pose, generate a diagnostic signal.