PASSIVE/RANGING/TRACKING PROCESSING METHOD FOR COLLISION AVOIDANCE GUIDANCE

• US 20030146869A1
• Filed: 07/13/2002
• Published: 08/07/2003
• Est. Priority Date: 04/22/2000
• Status: Active Grant

• Current Assignee: American GNC Corporation
• Original Assignee: American GNC Corporation
• Inventors: Lin, Ching-Fang, An, Dong
• Granted Patent: US 6,639,553 B2
• Time in Patent Office: Days
• US Class Current: 342/357.14
• CPC Class Codes: G01C 21/165 combined with non-inertial navigation instruments
• CPC Class Codes: G01C 3/18 with one observation point at each end of the base G01C3/20 takes precedence
• CPC Class Codes: G01S 11/12 using electromagnetic waves other than radio waves
• CPC Class Codes: G01S 5/0284 Relative positioning
• CPC Class Codes: G01S 5/04 Position of source determined by a plurality of spaced direction-finders
• CPC Class Codes: G01S 5/16 using electromagnetic waves other than radio waves

Abstract

A passive/ranging/tracking processing method provides information from passive sensors and associated tracking control devices and GPS/IMU integrated navigation system, so as to produce three dimensional position and velocity information of a target. The passive/ranging/tracking processing method includes the procedure of producing two or more sets of direction measurements of a target with respect to a carrier, such as sets of elevation and azimuth angles, from two or more synchronized sets of passive sensors and associated tracking control devices, installed on different locations of the carrier, computing the range vector measurement of the target with respect to the carrier using the two or more sets of direction measurements, and filtering the range vector measurement to estimate the three-dimensional position and velocity information of the target.

Claims

1. A passive/ranging/tracking method for tracking a target, comprising the steps of:

(a) producing at least a first set of direction measurements and a second set of direction measurements of the target with respect to a carrier from at least a first passive sensor and a second passive sensor through at least a first tracking control device and a second tracking control device respectively, wherein said first and second passive sensors are installed on said carrier and each of said first and second passive sensors is controlled by said respective tracking control device to keep pointing to said target;

(b) producing navigation data of said carrier, including position, velocity, and attitude data, using an onboard navigation system;

(c) computing a target range vector measurement of said target with respect to said carrier using said two first set and second set of direction measurements; and

(d) extracting three-dimensional position and velocity information of said target at a current epoch using said target range vector measurement.

2. The passive/ranging/tracking method, as recited in claim 1, wherein each of said passive sensors receives energy or signals emitted by said target and generates said first set and second set of direction measurements of said target which are sets of elevation and azimuth angle measurements of said target respectively.

3. The passive/ranging/tracking method, as recited in claim 2, wherein said range vector measurement contains direction and distance information of said target with respect to said carrier.

4. The passive/ranging/tracking method, as recited in claim 1, wherein each of said first and second tracking control devices comprises a two degree-of-freedom observation platform, wherein each of said first and second passive sensors is generated mounted on said two degree-of-freedom observation platform in order to isolate a maneuvering motion of said carrier to keep tracking said target.

5. The passive/ranging/tracking method, as recited in claim 4, wherein each of said first and second tracking control devices comprises an encoder installed in two gimbal axes to output a precise angular position of said passive sensor direction relative to a carrier body coordinate system of said carrier.

6. The passive/ranging/tracking method, as recited in claim 3, wherein each of said first and second tracking control devices comprises a two degree-of-freedom observation platform, wherein each of said first and second passive sensors is generated mounted on said two degree-of-freedom observation platform in order to isolate a maneuvering motion of said carrier to keep tracking said target.

7. The passive/ranging/tracking method, as recited in claim 6, wherein each of said first and second tracking control devices comprises an encoder installed in two gimbal axes to output a precise angular position of said passive sensor direction relative to a carrier body coordinate system of said carrier.

8. The passive/ranging/tracking method, as recited in claim 1, wherein the step (a) further comprises the steps of:

(a.1) producing said first set of direction measurements of said target with respect to said carrier using said first passive sensor through said first tracking control device; and

(a.2) producing said second set of direction measurements of said target with respect to said carrier using said second passive sensor through said second tracking control device.

9. The passive/ranging/tracking method, as recited in claim 3, wherein the step (a) further comprises the steps of:

(a.1) producing said first set of direction measurements of said target with respect to said carrier using said first passive sensor through said first tracking control device; and

(a.2) producing said second set of direction measurements of said target with respect to said carrier using said second passive sensor through said second tracking control device.

10. The passive/ranging/tracking method, as recited in claim 1, wherein the step (c) further comprises the steps of:

(c.1) forming a first presumed target-sensor vector, representing a direction measurement between said first passive sensor and said target, expressed in a first passive sensor coordinate system, using a first elevation angle and azimuth angle measurement of said target from an output of said first passive sensor and a first unknown distance formed between said first passive sensor and said target;

(c.2) forming a second presumed target-sensor vector, representing a direction measurement between said second passive sensor and said target, expressed in a second passive sensor coordinate system, using a second elevation angle and azimuth angle measurement of said target from an output of said second passive sensor and a second unknown distance formed between said second passive sensor and said target;

(c.3) converting said first presumed target-sensor vector from said first passive sensor coordinate system to a navigation coordinate system of said carrier, using navigation data from a GPS/IMU integrated navigation system which provides position and attitude information of said carrier;

(c.4) converting said second presumed target-sensor vector from said second passive sensor coordinate system to said navigation coordinate system of said carrier, using said navigation data from said GPS/IMU integrated navigation system;

(c.5) computing said first passive sensor location vector, expressed in a local navigation coordinate system, using knowledge of a first passive sensor location in a carrier body coordinate system and said navigation data from said GPS/IMU integrated navigation system;

(c.6) computing said second passive sensor location vector, expressed in said local navigation coordinate system, using knowledge of a second passive sensor location in said carrier body coordinate system and said navigation data from said GPS/IMU integrated navigation system;

(c.7) forming a first presumed target vector, expressed in navigation coordinates, by adding said first target-sensor vector and said first passive sensor location vector;

(c.8) forming a second presumed target vector expressed in said navigation coordinates, by adding said second target-sensor vector and said second passive sensor location vector;

(c.9) finding said first unknown distance and said second unknown distance, using said first presumed target vector and said second presumed target vector;

(c.10) forming a first target vector, by inserting said first unknown distance into said first presumed target vector;

(c.11) forming a second target vector, by inserting said second unknown distance into said second presumed target vector; and

(c.12) forming a range vector measurement, using said first target vector and said second target vector.

11. The passive/ranging/tracking method, as recited in claim 10, wherein the step (c.9) further comprises the steps of:

(c.9.A1) forming a vector equation by differencing said first target vector and said second target vector; and

(c.9.A2) finding said first unknown distance and said second unknown distance, by resolving said vector equation, thereby a first position of said first passive sensors in said carrier body coordinate system and said target determine a first straight line in a 3-dimensional space and a second position of said second passive sensors in said carrier body coordinate system and said target determine a second straight line in said 3-dimensional space, so that an intersecting point of said first and second straight lines is a ranged position of said target.

12. The passive/ranging/tracking method, as recited in claim 10, wherein the step (c.9) further comprises the steps of:

(c.9.B1) forming a formula for a distance parameter, which represents a distance of two points between said first target vector and said second target vector, using said first target vector and said second target vector; and

(c.9.B2) finding a set of said first unknown distance and said second unknown distance, which makes a value of said distance parameter be minimal.

13. The passive/ranging/tracking method, as recited in claim 10, wherein the step (c.9) further comprises the steps of:

(c.9.C1) forming a vector equation by differencing said first target vector and said second target vector; and

(c.9.C2) finding said first unknown distance and said second unknown distance, by resolving said vector equation using a least squares method.

14. The passive/ranging/tracking method, as recited in claim 10, wherein the step (d) further comprises a step of filtering said range vector measurement at each epoch to estimate a current position of said target by a filter at said current epoch.

15. The passive/ranging/tracking method, as recited in claim 11, wherein the step (d) further comprises a step of filtering said range vector measurement at each epoch to estimate a current position of said target by a filter at said current epoch.

16. The passive/ranging/tracking method, as recited in claim 12, wherein the step (d) further comprises a step of filtering said range vector measurement at each epoch to estimate a current position of said target by a filter at said current epoch.

17. The passive/ranging/tracking method, as recited in claim 13, wherein the step (d) further comprises a step of filtering said range vector measurement at each epoch to estimate a current position of said target by a filter at said current epoch.

18. The passive/ranging/tracking method, as recited in claim 1, wherein each of said passive sensors is a passive image sensor and the step (a) comprises the steps of:

(a.1) determining at least a first and a second feature area in at least two synchronized image data from said, first and second passive image sensors, wherein said pair of features represents said target;

(a.2) computing a centroid for each of said feature areas in each of said synchronized images; and

(a.3) computing said direction measurements, using said centroids.

19. The passive/ranging/tracking method, as recited in claim 18, wherein, in the step (a.1), said feature areas are determined by a feature matching method.

20. The passive/ranging/tracking method, as recited in claim 19, wherein said feature matching method is an attributed graph matching, wherein attributed graphs are represented by nodes and arcs where each of said nodes corresponds to a derived image feature and arcs represent relationships between said nodes.

21. The passive/ranging/tracking method, as recited in claim 18, wherein before the step (a.1), further comprises a step of detecting said moving target in both images from said passive image sensors.

22. The passive/ranging/tracking method, as recited in claim 18, wherein each of said passive image sensors is a visible/infrared camera, wherein said passive image sensors are externally synchronized with GPS timer signals, therefore said visible/infrared cameras capture image simultaneously and said synchronized image data are directly related.

23. A passive/ranging/tracking method for tracking a target, comprising the steps of:

(a) producing at least a first set of direction measurements and a second set of direction measurements of the target with respect to at least a first carrier and a second carrier from at least a first passive sensor and a second passive sensor through at least a first tracking control device and a second tracking control device respectively, wherein said first and second passive sensors and said first and second tracking control devices are installed on said carriers respectively and each of said first and second passive sensors is controlled by said respective tracking control device to keep pointing to said target;

(b) producing navigation data of said first and second carriers, including position, velocity, and attitude data, using a first onboard navigation system provided on said first carrier and a second onboard navigation system on said second carrier;

(c) computing a target range vector measurement of said target with respect to each of said carriers, using said two or more sets of direction measurements, wherein said first carrier and said second carrier are data-linked; and

(d) extracting three-dimensional position and velocity information of said target, expressed in a navigation coordinate system, at a current epoch using said target range vector measurement.

24. The passive/ranging/tracking method, as recited in claim 23, wherein each of said first and second passive sensors receives energy or signals emitted by said target and generates said first set and second set of direction measurements of said target which are sets of elevation and azimuth angle measurements of said target respectively.

25. The passive/ranging/tracking method, as recited in claim 24, wherein said range vector measurement contains direction and distance information of said target with respect to said carrier.

26. The passive/ranging/tracking method, as recited in claim 23, wherein each of said tracking control device comprises a two degree-of-freedom observation platform, wherein each of said passive sensors is generated mounted on said two degree-of-freedom observation platform in order to isolate a maneuvering motion of said carrier to keep tracking said target.

27. The passive/ranging/tracking method, as recited in claim 26, wherein each of said first and second tracking control devices comprises an encoder installed in two gimbal axes to output a precise angular position of said passive sensor direction relative to a carrier body coordinate system of said carrier.

28. The passive/ranging/tracking method, as recited in claim 25, wherein each of said first and second tracking control devices comprises a two degree-of-freedom observation platform, wherein each of said first and second passive sensors is generated mounted on said two degree-of-freedom observation platform in order to isolate a maneuvering motion of said carrier to keep tracking said target.

29. The passive/ranging/tracking method, as recited in claim 28, wherein each of said first and second tracking control devices comprises an encoder installed in two gimbal axes to output a precise angular position of said passive sensor direction relative to a carrier body coordinate system of said carrier.

30. The passive/ranging/tracking method, as recited in claim 29, wherein the step (a) further comprises the steps of:

(a.1) producing said first set of direction measurements of said target with respect to said first carrier using said first passive sensor through said first tracking control device; and

(a.2) producing said second set of direction measurements of said target with respect to said second carrier using said second passive sensor through said second tracking control device.

31. The passive/ranging/tracking method, as recited in claim 25, wherein the step (a) further comprises the steps of:

(a.1) producing said first set of direction measurements of said target with respect to said first carrier using said first passive sensor through said first tracking control device; and

(a.2) producing said second set of direction measurements of said target with respect to said second carrier using said second passive sensor through said second tracking control device.

32. The passive/ranging/tracking method, as recited in claim 23, wherein the step (c) further comprises the steps of:

(c.1) forming a first presumed target-sensor vector, representing a direction measurement between said first passive sensor and said target, expressed in a first passive sensor coordinate system, using a first elevation angle and azimuth angle measurement of said target from an output of said first passive sensor and a first unknown distance formed between said first passive sensor and said target;

(c.2) forming a second presumed target-sensor vector, representing a direction measurement between said second passive sensor and said target, expressed in a second passive sensor coordinate system, using a second elevation angle and azimuth angle measurement of said target from an output of said second passive sensor and a second unknown distance formed between said second passive sensor and said target;

(c.3) converting said first presumed target-sensor vector from said first passive sensor coordinate system to a first navigation coordinate system of said first carrier, using first navigation data from a GPS/IMU integrated navigation system which provides position and attitude information of said first carrier;

(c.4) converting said second presumed target-sensor vector from said second passive sensor coordinate system to a second navigation coordinate system of said second carrier, using said second navigation data from said GPS/IMU integrated navigation system which provides position and attitude information of said second carrier;

(c.5) computing a first passive sensor location vector, expressed in a first local navigation coordinate system, using knowledge of a first passive sensor location in a first carrier body coordinate system and said first navigation data from said GPS/IMU integrated navigation system;

(c.6) computing a second passive sensor location vector, expressed in a second local navigation coordinate system, using knowledge of a second passive sensor location in a second carrier body coordinate system and said second navigation data from said GPS/IMU integrated navigation system;

(c.7) forming a first presumed target vector, expressed in navigation coordinates, by adding said first target-sensor vector and said first passive sensor location vector;

(c.8) forming a second presumed target vector expressed in said navigation coordinates, by adding said second target-sensor vector and said second passive sensor location vector;

(c.9) finding said first unknown distance and said second unknown distance, using said first presumed target vector and said second presumed target vector;

(c.10) forming a first target vector, by inserting said first unknown distance into said first presumed target vector;

(c.11) forming a second target vector, by inserting said second known distance into said second presumed target vector; and

(c.12) forming a range vector measurement, using said first target vector and said second target vector.

33. The passive/ranging/tracking method, as recited in claim 32, wherein the step (c.9) further comprises the steps of:

(c.9.A1) forming a vector equation by differencing said first target vector and said second target vector; and

(c.9.A2) finding said first unknown distance and said second unknown distance, by resolving said vector equation, thereby a first position of said first passive sensors in said first carrier body coordinate system and said target determine a first straight line in a 3-dimensional space and a second position of said second passive sensors in said second carrier body coordinate system and said target determine a second straight line in said 3-dimensional space, so that an intersecting point of said first and second straight lines is a ranged position of said target.

34. The passive/ranging/tracking method, as recited in claim 32, wherein the step (c.9) further comprises the steps of:

(c.9.B1) forming a formula for a distance parameter, which represents a distance of two points between said first target vector and said second target vector, using said first target vector and said second target vector; and

(c.9.B2) finding a set of said first unknown distance and said second unknown distance, which makes a value of said distance parameter be minimal.

35. The passive/ranging/tracking method, as recited in claim 32, wherein the step (c.9) further comprises the steps of:

(c.9.C1) forming a vector equation by differencing said first target vector and said second target vector; and

(c.9.C2) finding said first unknown distance and said second unknown distance, by resolving said vector equation using a least squares method.

36. The passive/ranging/tracking method, as recited in claim 32, wherein the step (d) further comprises a step of filtering said range vector measurement at each epoch to estimate a current position of said target by a filter at said current epoch.

37. The passive/ranging/tracking method, as recited in claim 33, wherein the step (d) further comprises a step of filtering said range vector measurement at each epoch to estimate a current position of said target by a filter at said current epoch.

38. The passive/ranging/tracking method, as recited in claim 34, wherein the step (d) further comprises a step of filtering said range vector measurement at each epoch to estimate a current position of said target by a filter at said current epoch.

39. The passive/ranging/tracking method, as recited in claim 35, wherein the step (d) further comprises a step of filtering said range vector measurement at each epoch to estimate a current position of said target by a filter at said current epoch.

40. The passive/ranging/tracking method, as recited in claim 32, wherein each of said first and second passive sensors is a passive image sensor and the step (a) comprises the steps of:

(a.1) determining at least a first and a second feature area in at least two synchronized image data from said first and second passive image sensors, wherein said pair of features represents said target;

(a.2) computing a centroid for each of said feature areas in each of said synchronized images; and

(a.3) computing said direction measurements, using said centroids.

41. The passive/ranging/tracking method, as recited in claim 40, wherein, in the step (a.1), said feature areas are determined by a feature matching method.

42. The passive/ranging/tracking method, as recited in claim 41, wherein said feature matching method is an attributed graph matching, wherein attributed graphs are represented by nodes and arcs where each of said nodes corresponds to a derived image feature and arcs represent relationships between said nodes.

43. The passive/ranging/tracking method, as recited in claim 40, wherein before the step (a.1), further comprises a step of detecting said moving target in both images from said passive image sensors.

44. The passive/ranging/tracking method, as recited in claim 40, wherein each of said passive image sensors is a visible/infrared camera, wherein said passive image sensors are externally synchronized with GPS timer signals, therefore said visible/infrared cameras capture image simultaneously and said synchronized image data are directly related.