Methods and apparatus for navigational aiding using celestial object tracking
View Patent ↗Methods and computer products for establishing at least one of attitude, direction and position of a moving platform. At least one skymark of known ephemeris is imaged at each of a first set of discrete instants by means of an optical sensor coupled to the platform. A measurement is also obtained of the attitude of the platform at each of a second set of discrete instants by means of an inertial navigation system. A recursive of estimation filter is then applied to successive skymark position vectors to update an estimate of platform navigation state, with the measurement of attitude of the platform tightly coupled to the estimate of platform navigation state as updated by the recursive estimation filter. Various techniques of frame stacking and multi-hypothesis tracking may be applied to improve the robustness of navigation solutions.
1. A method for establishing at least one of attitude, direction and position of a platform in motion in an inertial frame, the method comprising:
a. optically imaging at least one skymark of known ephemeris at each of a first set of discrete instants by means of a sensor coupled to the platform to obtain successive skymark position vectors,
wherein the successive skymark position vectors account for evolution of successive images between non-identical times;
b. obtaining a measurement of attitude of the platform at each of a second set of discrete instants by means of an inertial navigation system;
c. combining a first of the successive skymark position vectors and the measurement of attitude of the platform at one of the second set of discrete instants to obtain an estimate of platform navigation state; and
d. applying a recursive estimation filter to successive skymark position vectors to update the estimate of platform navigation state;
wherein the measurement of attitude of the platform is tightly coupled to the estimate of platform navigation state as updated by the recursive estimation filter; and
wherein the successive images are spatially shifted based on a predicted motion.
2. A method in accordance with claim 1 , wherein the second set of discrete instants substantially overlaps the first set of discrete instants.
3. A method in accordance with claim 1 , wherein the recursive estimation filter is a Kalman filter.
4. A method in accordance with claim 1 , wherein the recursive estimation filter is an unscented Kalman filter.
5. A method in accordance with claim 1 , wherein the at least one skymark comprises at least one satellite.
6. A method in accordance with claim 1 , wherein the predicted motion includes predicted motion of a skymark.
7. A method in accordance with claim 1 , further comprising compensating for motion of the platform.
8. A method in accordance with claim 7 , wherein the compensation for motion of the platform is based, at least in part, on the measurement of attitude of the platform.
9. A method in accordance with claim 1 , further comprising separately summing successive image frames in parallel pipelines, wherein a first pipeline compensates for predicted motion and a second pipeline does not compensate for predicted motion.
10. A method in accordance with claim 9 , wherein the predicted motion includes motion of a skymark.
11. A method in accordance with claim 9 , wherein the predicted motion includes motion of the platform.
12. A method in accordance with claim 1 , wherein applying a recursive estimation filter comprises updating a set of states of a state vector at successive instants.
13. A method in accordance with claim 12 , wherein updating the set of states includes updating a proper subset of the set of states of the state vector.
14. A method in accordance with claim 12 , wherein updating the set of states includes at least one of appending a state to the state vector and deleting a state from the state vector.
15. A method in accordance with claim 14 , wherein appending a state to the state vector corresponds to entry of a satellite into a specified field of view.
16. A computer program product for use on a computer system for establishing at least one of attitude, direction and position of a platform in motion in an inertial frame, the computer program product comprising a non-transitory computer readable medium having computer readable program code fixed thereon, the computer readable program code including:
a. program code for inputting an image of at least one skymark of known ephemeris at each of a first set of discrete instants by means of a sensor coupled to a platform to obtain successive skymark position vectors, wherein the successive skymark position vectors account for evolution of successive images obtained by optical imaging between non-identical times;
b. program code for inputting a measurement of attitude of the platform at each of a second set of discrete instants;
c. program code for combining a first of the successive skymark position vectors and the measurement of attitude of the platform at one of the second set of discrete instants to obtain an estimate of platform navigation state; and
d. a recursive estimation filter adapted to update the estimate of platform navigation state,
wherein the measurement of attitude of the platform is tightly coupled to the estimate of platform navigation state as updated by the recursive estimation filter; and
wherein the successive images are spatially shifted based on a predicted motion.
17. A computer program product in accordance with claim 16 , wherein the recursive estimation filter is a Kalman filter.
18. A computer program product in accordance with claim 16 , wherein optically imaging includes frame stacking of successive images.
19. A computer program product in accordance with claim 16 , wherein the computer-readable program code further comprises program code for separately summing successive image frames in parallel pipelines, wherein a first pipeline compensates for predicted motion and a second pipeline does not compensate for predicted motion.