Claims
- 1 A method for attitude alignment of a slave inertial measurement system that is connected to a rotationally mobile platform that is supported by a vehicle that is stationary relative to a reference navigation frame, comprising the steps of:
mounting a master reference inertial measurement system on the rotationally mobile platform; determining a master reference system attitude using measurements of acceleration and angular rates of the master reference inertial measurement system relative to the reference navigation frame; determining a slave system attitude by using measurements of acceleration and angular rates of the slave inertial measurement system relative to a slave system navigation reference frame; comparing the slave system attitude to the master reference system attitude to determine an attitude difference; and processing the attitude difference to obtain a correction to the slave system attitude.
- 2. The method of claim 1, further comprising an initialization step that includes the steps of:
obtaining an initial value of the master reference system attitude; obtaining an initial value of the slave system attitude; sampling the reference system attitude; sampling the slave system attitude; and processing the sampled master reference system attitude and the sampled slave system attitude to obtain an attitude correction; and applying the attitude correction to the slave system attitude to align the slave inertial measurement system.
- 3. The method of claim 1 wherein the step of determining the master reference system attitude further comprises the steps of:
defining a master reference system body frame for the master reference inertial measurement system; defining a slave system body frame for the slave inertial measurement system; and determining angular displacements between the master reference system body frame and the slave system body frame.
- 4. The method of claim 1, further comprising the step of determining values of angular displacement between the slave inertial measurement system and master reference inertial measurement system.
- 5. The method of claim 1 wherein the step of determining the master reference system attitude comprises the step of forming a master reference body to geodetic frame quaternion that indicates angular displacement between the master reference inertial measurement system and the reference navigation frame.
- 6. The method of claim 5 wherein the reference navigation frame is a geodetic coordinate frame.
- 7. The method of claim 5 wherein the step of determining the slave system attitude comprises the step of forming a slave system body quaternion that indicates angular displacement between the slave system body and the slave system navigation reference frame.
- 8. The method of claim 7 wherein the step of comparing the slave system attitude to the reference system attitude comprises the steps of:
forming a boresight quaternion that indicates an initial value of angular displacement between the master reference body frame and the slave system body frame; forming a master reference body to reference navigation frame quaternion that indicates an initial value of angular displacement between the master reference body frame and the reference navigation frame; and forming a reference quaternion that combines the angular displacement of the boresight quaternion and that of the master reference body to reference navigation frame quaternion; and calculating a rotation vector that indicates rotation from the slave system body quaternion and the reference quaternion.
- 9. The method of claim 7, further comprising the steps of:
collecting a selected number of sets of samples of the slave system body quaternion and the reference quaternion; calculating the rotation vector for each set of samples; and calculating average component values for the rotation vector for the selected number of samples.
- 10. The method of claim 8, further comprising the steps of:
filtering the average component values with a Kalman filter to calculate a boresight update quaternion; and using the boresight update quaternion to calculate an updated boresight quaternion.
- 11. The method of claim 1, further comprising the steps of:
determining a velocity vector for the slave inertial measurement system; determining a position change of the slave inertial measurement system in the slave system navigation reference frame; and calculating a velocity error using the slave system velocity vector and the a position change of the slave inertial measurement system in the slave system navigation reference frame.
- 12. A method for attitude alignment of a slave inertial measurement system that is connected to a selected one of a plurality of units mounted in a pod supported by a rotationally mobile platform mounted on a vehicle that is stationary relative to a reference navigation frame, comprising the steps of:
mounting a master reference inertial measurement system on the rotationally mobile platform; determining a master reference system attitude using its measurements of acceleration and angular rates relative to the reference navigation frame; determining a slave system attitude by using its measurements of acceleration and angular rates relative to the navigation reference frame; determining an initial value of angular displacement between the slave inertial measurement system and the master reference inertial measurement system; comparing the slave system attitude to the reference system attitude to determine an attitude difference; processing the attitude difference to obtain corrections to the slave system attitude and the angular displacement between the slave inertial measurement system and the master reference inertial measurement system; and providing a signal to units that remain in the pod after the selected unit has been launched
- 13. A method for correcting attitude errors of a unit that is to be launched from a rotationally mobile platform mounted on a stationary launch vehicle, the unit including a slave sensor fixed thereto to serve as a slave system body frame and the rotationally mobile platform including a master inertial measurement unit fixed thereto to serve as a master reference body frame, comprising the steps of:
initializing a boresight quaternion qBOR that has initial values of angular displacements between the master reference body and the slave system body; initializing latitude, longitude, height and angular orientation of a selected bore in the launch vehicle from which the unit is to be launched; initializing a quaternion qL→Geo* that indicates rotation from the master reference body frame to a geodetic frame; combining the boresight quaternion with the quaternion qL→Geo* to provide a reference quaternion qB* that indicates rotations between the selected bore and a slave system navigation frame; providing a slave system body quaternion that indicates rotation between the slave system body frame and a slave system navigation frame; calculating an update quaternion for adjusting the boresight quaternion; and combining the slave system body quaternion and the reference quaternion.
- 14. The method of claim 13 wherein the step of combining the boresight quaternion with the quaternion qL→GeO* to provide a reference quaternion comprises the step of multiplying the quaternion qL→GeO* by the boresight quaternion qBOR.
- 15. The method of claim 14 wherein the step of calculating an update quaternion comprises the steps of:
multiplying the reference quaternion by the slave system body quaternion to obtain approximate values for errors in the angular displacement between master reference body frame and the slave system body frame; calculating average values of the errors in the angular displacement for a selected number of samples; processing the average values of the errors with a Kalman filter to produce the boresight update quaternion; and combining the boresight update quaternion and the boresight quaternion to provide an updated boresight quaternion.
- 16. The method of claim 15, wherein the step of calculating the update to the boresight quaternion QBOR comprises the step of calculating a rotation vector using a small angle approximation to obtain a value for the quaternion product qBa=qBaqBORqL*=φε2*vector{qBaqL*} for a selected number of samples of each component of the quaternions qBa and qL*.
- 17. The method of claim 16, further comprising the steps of:
calculating an average value for each component of the quaternion product 2*vector{qBaqL*}; applying the average value for each component of the quaternion product 2*vector{qBaqL*} to a Kalman filter that is arranged to calculate components of a boresight update quaternion; and multiplying the slave system body frame boresight quaternion qBOR by the boresight update quaternion to obtain an updated slave system body frame boresight quaternion qBOR.
- 18. The method of claim 13, further comprising steps of:
measuring a velocity of the slave sensor in the master reference body frame before the units launched; measuring changes in position of the slave system body in the slave system navigation frame in selected time intervals; and calculating a velocity error using the measured velocity of the slave sensor and the changes in position of the slave system body.
- 19. The method of claim 18 wherein the calculated velocity error is used to update the attitude of the slave system body frame relative to the navigation reference frame to provide an improved accuracy of the slave system inertial measurement unit.
- 20. The method of claim 18 wherein the calculated velocity error is used in a Kalman filter to estimate error parameters of the slave inertial measurement unit and to apply corrections to improve its accuracy.
CROSS REFERENCE TO RELATED APPLICATION
[0001] Applicants claim the benefit of U.S. Provisional Application Serial No. 60/221,315, filed Jul. 28, 2000 for Transfer Alignment Using Attitude Matching And Velocity Observations On A Rotationally Mobile Platform.
Government Interests
[0002] Statement of Government Rights in Invention: The United States Government has rights in this invention under U.S. Army contract No. 43000278482.
PCT Information
Filing Document |
Filing Date |
Country |
Kind |
PCT/US01/23659 |
7/27/2001 |
WO |
|