초록 ▼

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 c

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.

대표청구항 ▼

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 t

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; anda device configured to receive the signals to estimate at least one of the position, the attitude, and the heading of the vehicle,wherein the device is configured to estimate the attitude of the vehicle based in part on the signal indicative of vehicle altitude, andwherein the signal indicative of vehicle altitude is used to estimate the attitude 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 Kalman filter 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, anda device configured to receive the signals to estimate at least one of the position, the attitude, and the heading of the vehicle,wherein the device is configured to estimate the attitude of the vehicle based in part on the signal indicative of vehicle altitude, andwherein the signal indicative of vehicle altitude is used to estimate the attitude 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 Kalman filter algorithm is configured to receive the signal indicative of true 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 computer-implemented method for estimating at least one of position, attitude, and heading of a vehicle, the computer-implemented 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, andtemperature outside the vehicle; andestimating via the computer at least one of the position, the attitude, and the heading of the vehicle based on the signals,wherein the estimating comprises estimating the attitude of the vehicle based in part on the signal indicative of vehicle altitude, andwherein the signal indicative of vehicle altitude is used to estimate the attitude of the vehicle. 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 implemented by the computer. 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 via the computer 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 running on the computer 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 running on the computer 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 Kalman filter algorithm comprises inputting signals into the computer 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 via the computer 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.