Systems and Methods for Estimating Position, Attitude, and/or Heading of a Vehicle

• US 20080269963A1
• Filed: 06/02/2005
• Published: 10/30/2008
• Est. Priority Date: 06/02/2004
• Status: Active Grant

• Current Assignee: Rockwell Collins Control Technologies, Inc. (Raytheon Technologies Corporation d/b/a RTX)
• Original Assignee: Rockwell Collins Control Technologies, Inc. (Raytheon Technologies Corporation d/b/a RTX)
• Inventors: Vos, David William, Gavrilets, Vladislav
• Granted Patent: US 8,229,606 B2
• Time in Patent Office: Days
• US Class Current: 701/4
• CPC Class Codes: G01C 21/1654 with electromagnetic compass
• CPC Class Codes: G05D 1/0825 using mathematical models

Abstract

A system for estimating at least one of position, attitude, and heading of a vehicle is disclosed. The system includes at least three gyroscopes configured to output a signal indicative of inertial angular rates around three mutually orthogonal axes of the vehicle and at least three accelerometers configured to output a signal indicative of accelerations along three mutually orthogonal axes of the vehicle. The system further includes a triaxial magnetometer configured to output a signal indicative of a projection of ambient magnetic field on three mutually orthogonal axes of the vehicle. The system also includes a sensor configured to output a signal indicative of vehicle altitude and a differential pressure sensor configured to output a signal indicative of airspeed of the vehicle. The system further includes a device configured to receive the signals and estimate at least of one of position, attitude, and heading of the vehicle.

Claims

1. A system for estimating at least one of position, attitude, and heading of a vehicle, the system comprising:

at least three gyroscopes configured to output a signal indicative of inertial angular rates around three mutually orthogonal axes of the vehicle;

at least three accelerometers configured to output a signal indicative of accelerations along three mutually orthogonal axes of the vehicle;

a triaxial magnetometer configured to output a signal indicative of a projection of ambient magnetic field on three mutually orthogonal axes of the vehicle;

a sensor configured to output a signal indicative of vehicle altitude;

a differential pressure sensor configured to output a signal indicative of airspeed of the vehicle; and

a device configured to receive the signals to estimate at least one of the position, the attitude, and the heading of the vehicle.

2. The system of claim 1, wherein the device configured to receive the signals comprises a Kalman filter.

3. The system of claim 1, wherein the device configured to receive the signals comprises a Kalman filter algorithm configured to receive the signals and estimate at least one of the position, the attitude, and the heading of the vehicle.

4. The system of claim 3, wherein the algorithm comprises a zero-drift algorithm configured to estimate at least one of the position, the attitude, and the heading of the vehicle.

5. The system of claim 4, wherein the algorithm further comprises a dead-reckoning algorithm configured to estimate at least one of the position, the attitude, and the heading of the vehicle.

6. The system of claim 5, wherein the dead-reckoning algorithm is configured to receive the signal indicative of airspeed of the vehicle, a wind speed estimate, and attitude and heading estimates from the dead-reckoning algorithm.

7. The system of claim 1, wherein the device configured to receive the signals is configured to use the signals from at least one of the triaxial magnetometer, the absolute pressure sensor, and at least one of the accelerometers to update estimates of at least one of the position, the attitude, and the heading of the vehicle.

8. The system of claim 7, wherein the at least one accelerometer comprises an accelerometer configured to output signals indicative of forward acceleration of the vehicle.

9. The system of claim 1, further comprising a global positioning system configured to estimate the position of the vehicle.

10. The system of claim 1, wherein the at least three gyroscopes comprise mechanical spinning gyroscopes.

11. The system of claim 1, wherein the sensor configured to output a signal indicative of vehicle altitude comprises an absolute pressure sensor.

12. The system of claim 1, further comprising a temperature sensor configured to output a signal indicative of air temperature outside the vehicle.

13. A vehicle comprising:

a system for estimating at least one of position, attitude, and heading of the vehicle, the system comprising

at least three gyroscopes configured to output a signal indicative of inertial angular rates around three mutually orthogonal axes of the vehicle,

at least three accelerometers configured to output a signal indicative of accelerations along three mutually orthogonal axes of the vehicle,

a triaxial magnetometer configured to output a signal indicative of a projection of ambient magnetic field on three mutually orthogonal axes of the vehicle,

a sensor configured to output a signal indicative of altitude,

a differential pressure sensor configured to output a signal indicative of airspeed of the vehicle, and

a device configured to receive the signals to estimate at least one of the position, the attitude, and the heading of the vehicle.

14. The vehicle of claim 13, wherein the vehicle comprises a fixed-wing aerial vehicle.

15. The vehicle of claim 13, wherein the vehicle comprises a ducted fan aerial vehicle.

16. The vehicle of claim 13, wherein the vehicle is an unmanned aerial vehicle.

17. The vehicle of claim 13, wherein the device configured to receive the signals comprises a Kalman filter.

18. The vehicle of claim 13, wherein the device configured to receive the signals comprises an algorithm configured to receive the signals and estimate at least one of the position, the attitude, and the heading of the vehicle.

19. The vehicle of claim 18, wherein the algorithm comprises a Zero-drift algorithm configured to estimate at least one of the position, the attitude, and the heading of the vehicle.

20. The vehicle of claim 19, wherein the algorithm further comprises a dead-reckoning algorithm configured to estimate at least one of the position, the attitude, and the heading of the vehicle.

21. The vehicle of claim 20, wherein the dead-reckoning algorithm is configured to receive the signal indicative of airspeed of the vehicle, a wind speed estimate, and attitude and heading estimates from the dead-reckoning algorithm.

22. The vehicle of claim 13, wherein the device configured to receive the signals is configured to use the signals from at least one of the triaxial magnetometer, the absolute pressure sensor, and at least one of the accelerometers to update estimates of at least one of the position, the attitude, and the heading of the vehicle.

23. The vehicle of claim 22, wherein the at least one accelerometer comprises an accelerometer configured to output signals indicative of forward acceleration of the vehicle.

24. The vehicle of claim 13, further comprising a global positioning system configured to estimate the position of the vehicle.

25. The vehicle of claim 13, wherein the gyroscopes comprise mechanical spinning gyroscopes.

26. The vehicle of claim 13, wherein the sensor configured to output a signal indicative of vehicle altitude comprises an absolute pressure sensor.

27. The vehicle of claim 13, further comprising a temperature sensor configured to output a signal indicative of air temperature outside the vehicle.

28. A method for estimating at least one of position, attitude, and heading of a vehicle, the method comprising:

generating signals of indicative of

inertial angular rates around three mutually orthogonal axes of the vehicle,

accelerations along three mutually orthogonal axes of the vehicle,

a projection of ambient magnetic field on three mutually orthogonal axes of the vehicle,

vehicle altitude,

airspeed of the vehicle, and

temperature outside the vehicle; and

estimating at least one of the position, the attitude, and the heading of the vehicle based on the signals.

29. The method of claim 28, wherein estimating at least one of the position, the attitude, and the heading of the vehicle comprises inputting the signals into a Kalman filter.

30. The method of claim 28, wherein estimating at least one of the position, the attitude, and the heading of the vehicle comprises inputting the signals into an algorithm configured to receive the signals and estimate at least one of the position, the attitude, and the heading of the vehicle.

31. The method of claim 28, wherein estimating at least one of the position, the attitude, and the heading of the vehicle comprises inputting the signals into a zero-drift algorithm configured to estimate at least one of the position, the attitude, and the heading of the vehicle.

32. The method of claim 31, wherein estimating at least one of the position, the attitude, and the heading of the vehicle comprises inputting estimations from the zero-drift algorithm into a dead-reckoning algorithm configured to estimate at least one of the position, the attitude, and the heading of the vehicle.

33. The method of claim 32, wherein inputting estimations from the zero-drift algorithm into the dead-reckoning algorithm comprises inputting signals indicative of true airspeed of the vehicle, a wind speed estimate, and attitude and heading estimates from the dead-reckoning algorithm.

34. The method of claim 28, wherein estimating at least one of the position, the attitude, and the heading of the vehicle comprises updating estimates of at least one of the position, the attitude, and the heading of the vehicle based on signals from at least one of a triaxial magnetometer, an absolute pressure sensor, and at least one accelerometer.