System and method of correcting orientation errors

An orientation system comprises an orientation sensor, a distance sensor, and vehicle processing unit. The orientation sensor is configured to generate orientation data. The distance sensor is configured to generate relative distance data measuring relative distances to objects external to the vehicle. The vehicle processing unit is configured to receive the orientation data from the orientation sensor and the relative distance data from the distance sensor, wherein the vehicle processing unit detects orientation errors based on the relative distance data.