Claims
- 1. A method of vehicle attitude determination, comprising the steps of:
(a) receiving position and velocity information data from a global positioning system receiver; (b) receiving vehicle dynamics information data from one or more vehicle dynamics sensors; and (c) determining a vehicle attitude from the position and velocity information and the vehicle dynamics information data using a Kalman filter.
- 2. The method of claim 1, wherein the Kalman filter has a linear structure.
- 3. The method of claim 1, wherein the Kalman filter is an extended Kalman filter.
- 4. The method of claim 1, wherein the step of determining a vehicle attitude comprises the substep of selecting a gain matrix for the Kalman filter based upon a fixed external parameter.
- 5. The method of claim 1, wherein the Kalman filter uses a solution to vector equations, x(k+1)=Φx(k)+Bu(k) and z(k)=Cx(k)+v(k), wherein x is a vehicle state vector, Φ is a vehicle dynamics matrix, B is a vehicle control efficiency matrix, u is a vehicle control vector based upon the vehicle dynamics information data, z is a measurement vector based upon the position and velocity information data, C is a measurement coefficient matrix and v is a noise vector.
- 6. The method of claim 5, wherein the vehicle dynamics matrix and the vehicle control efficiency matrix are based upon vehicle parameters and the measurement coefficient matrix and noise vector are based upon global positioning receiver parameters.
- 7. The method of claim 5, wherein the Kalman filter uses a gain matrix, Lk=PCTV−1, where P is a solution to a Riccati matrix equation, x(k+1)=Φx(k)+Bu(k) and z(k)=Cx(k)+v(k) and V is a measurement noise covariance matrix.
- 8. The method of claim 5, wherein the state vector includes inertial positions, attitude angles, body axis speeds and angular rates of the vehicle.
- 9. The method of claim 5, wherein the control vector includes deflections of vehicle control surfaces.
- 10. The method of claim 5, wherein the vehicle control efficiency matrix includes efficiency values for vehicle control surfaces.
- 11. The method of claim 1, wherein the step of determining a vehicle attitude comprises the sub step of linearizing the position and velocity information.
- 12. The method of claim 1, wherein the step of determining a vehicle attitude is performed in a body axis coordinate system.
- 13. The method of claim 1, wherein the step of determining a vehicle attitude is performed in a wind axis coordinate system.
- 14. An article of manufacture embodying logic to perform a method of vehicle attitude determination comprising the steps of:
(a) receiving position and velocity information data from a global positioning system receiver; (b) receiving vehicle dynamics information data from one or more vehicle dynamics sensors; and (c) determining a vehicle attitude from the position and velocity information data and the vehicle dynamics information data using a Kalman filter.
- 15. The article of claim 14, wherein the Kalman filter has a linear structure.
- 16. The article of claim 14, wherein the Kalman filter is an extended Kalman filter.
- 17. The article of claim 14, wherein the step of determining a vehicle attitude comprises the substep of selecting a gain matrix for the Kalman filter based upon a fixed external parameter.
- 18. The article of claim 14, wherein the Kalman filter uses a solution to vector equations, x(k+1)=Φx(k)+Bu(k) and z(k)=Cx(k)+v(k), wherein x is a vehicle state vector, Φ is a vehicle dynamics matrix, B is a vehicle control efficiency matrix, u is a vehicle control vector based upon the vehicle dynamics information data, z is a measurement vector based upon the position and velocity information data, C is a measurement coefficient matrix and v is a noise vector.
- 19. The article of claim 18, wherein the vehicle dynamics matrix and the vehicle control efficiency matrix are based upon vehicle parameters and the measurement coefficient matrix and noise vector are based upon global positioning receiver parameters.
- 20. The article of claim 18, wherein the Kalman filter uses a gain matrix, Lk=PCTV−1, where P is a solution to a Riccati matrix equation, x(k+1)=Φx(k)+Bu(k) and z(k)=Cx(k)+v(k), V is a measurement noise covariance matrix.
- 21. The article of claim 18, wherein the state vector includes inertial positions, attitude angles, body axis speeds and angular rates of the vehicle.
- 22. The article of claim 18, wherein the control vector includes deflections of vehicle control surfaces.
- 23. The article of claim 18, wherein the vehicle control efficiency matrix includes efficiency values for vehicle control surfaces.
- 24. The article of claim 14, wherein the step of determining a vehicle attitude comprises the substep of linearizing the position and velocity information.
- 25. The article of claim 14, wherein the step of determining a vehicle attitude is performed in a body axis coordinate system.
- 26. The article of claim 14, wherein the step of determining a vehicle attitude is performed in a wind axis coordinate system.
- 27. A system for vehicle orientation determination, comprising:
(a) a global positioning system receiver for determining position and velocity information data; (b) one or more vehicle dynamics sensors for determining vehicle dynamics information data; and (c) an attitude processor communicatively coupled to the global positioning system receiver unit and the one or more vehicle dynamics sensors for determining a vehicle attitude from the position and velocity information data and the vehicle dynamics information data using a Kalman filter.
- 28. The system of claim 27, wherein the Kalman filter has a linear structure.
- 29. The system of claim 27, wherein the Kalman filter is an extended Kalman filter.
- 30. The system of claim 27, wherein the attitude processor selects a gain matrix for the Kalman filter based upon a fixed external parameter.
- 31. The system of claim 27, wherein the Kalman filter uses a solution to vector equations, x(k+1)=Φx(k)+Bu(k) and z(k)=Cx(k)+v(k), wherein x is a vehicle state vector, Φ is a vehicle dynamics matrix, B is a vehicle control efficiency matrix, u is a vehicle control vector based upon the vehicle dynamics information data, z is a measurement vector based upon the position and velocity information data, C is a measurement coefficient matrix and v is a noise vector.
- 32. The system of claim 31, wherein the vehicle dynamics matrix and the vehicle control efficiency matrix are based upon vehicle parameters and the measurement coefficient matrix and noise vector are based upon global positioning receiver parameters.
- 33. The system of claim 31, wherein the Kalman filter uses a gain matrix, Lk=PCTV−1, where P is a solution to a Riccati matrix equation, x(k+1)=Φx(k)+Bu(k) and z(k)=Cx(k)+v(k), V is a measurement noise covariance matrix.
- 34. The system of claim 31, wherein the state vector includes inertial positions, attitude angles, body axis speeds and angular rates of the vehicle.
- 35. The system of claim 31, wherein the control vector includes deflections of vehicle control surfaces.
- 36. The system of claim 31, wherein the vehicle control efficiency matrix includes efficiency values for vehicle control surfaces.
- 37. The system of claim 27, wherein the attitude processor linearizes the position and velocity information.
- 38. The system of claim 27, wherein the attitude processor determines the vehicle attitude in a body axis coordinate system.
- 39. The system of claim 27, wherein the attitude processor determines the vehicle attitude in a wind axis coordinate system.
CROSS-REFERENCE TO RELATED APPLICATIONS
[0001] This application claims the benefit under 35 U.S.C. §119(e) of co-pending and commonly assigned U.S. Provisional Patent Application Ser. No. 60/224,916, filed on Aug. 10, 2000, by Jason L. Speyer and Laurence H. Mutuel, entitled “AIRCRAFT ATTITUDE DETERMINATION USING GPS,” and attorney's docket number 30435.100USP1, which application is incorporated by reference herein.
STATEMENT REGARDING FEDERALLY SPONSORED RESEARCH OR DEVELOPMENT
[0002] This invention was made with Government support under Grant No. 4-442568-23265, awarded by the National Aeronautics & Space Administration. The Government has certain rights in this invention.
Provisional Applications (1)
|
Number |
Date |
Country |
|
60224916 |
Aug 2000 |
US |