The invention described herein was made in the performance of official duties by an employee of the Department of the Navy and may be manufactured, used, licensed by or for the Government for any governmental purpose without payment of any royalties thereon.
The invention relates generally to guidance systems and methods, and more particularly to a magnetic anomaly guidance system and method that can be used to guide a movable and steerable platform toward a magnetic target.
The use of autonomous mobile sensing platforms (i.e., robotic vehicles) is desirable in many applications because of hostile environments, inherently dangerous tasks and/or cost considerations. For example, the military's searching for land mines buried in the ground or under the seafloor is ideally carried out without the use of any personnel in the searching vicinity. In the commercial world, robotic vehicles can be used to locate and track buried cables and/or pipelines. In each of these uses, the “target” generally is made at least partially from a magnetically polarizable material.
U.S. Pat. No. 6,476,610 discloses a magnetic anomaly sensing system and method that derives target localization signals from mathematical scalar contractions of the magnetic gradient tensor (i.e., rate of change of the magnetic field relative to an X,Y,Z component distance between two sensing locations). The gradient contraction scalar methods for scalar-based triangulation and ranging use square and cubic arrays of triaxial magnetometers to effectively develop more than five gradient components at each point of the sensor system's space. While this approach provides a robust method of target localization, it may also be too complex for simple guidance. This approach's complexity highlights some shortcomings that can hinder its effectiveness if used as the basis for a magnetic guidance system. More specifically, if a vehicle must be guided to contact or near contact with the magnetic target, errors in target localization can result because the approach relies on i) the use of the far-field dipole approximation for the target's magnetic signature, ii) the assumption that the distance from the sensing vehicle to the target is much greater than the distance between sensing locations on the vehicle, and iii) solutions of inverse trigonometric functions which can cause errors for certain vehicle angles of approach to the target.
Accordingly, it is an object of the present invention to provide a magnetic anomaly guidance method and system.
Another object of the present invention is to provide a guidance method and system that can be used by autonomous vehicles to home in on and track sub-surface magnetic targets.
Other objects and advantages of the present invention will become more obvious hereinafter in the specification and drawings.
In accordance with the present invention, a system for (and method of) magnetic anomaly guidance is provided for use with a non-magnetic support having a steering system coupled thereto. The steering system is one that is responsive to steering control commands that can control the support's direction of movement when the support is moved on a surface. The magnetic anomaly guidance system has at least two triaxial magnetometer (TM) sensors coupled to the support for movement therewith. Each TM sensor has X,Y,Z magnetic sensing axes with corresponding ones of the X,Y,Z magnetic sensing axes being parallel to one another. Each TM sensor outputs X,Y,Z components (Bx,By,Bz) of local magnetic fields. Each TM sensor is positioned at one of the vertices of an arrangement thereof. An axis of the arrangement is defined between each pair of the vertices. The arrangement is positioned on the support such that one of the X,Y,Z magnetic sensing axes for all of the sensors defines a forward direction of movement of the support. The arrangement further has an axis of symmetry that is fixed with respect to the forward direction of movement. The X,Y,Z components (Bx,By,Bz) of the TM sensors are processed to generate a partial gradient contraction associated with each axis of the arrangement of sensors. As a result, a plurality of partial gradient contractions are generated. Relationships between the plurality of partial gradient contractions are used to generate the steering control commands for the steering system that is coupled to the support.
Other objects, features and advantages of the present invention will become apparent upon reference to the following description of the preferred embodiments and to the drawings, wherein corresponding reference characters indicate corresponding parts throughout the several views of the drawings and wherein:
Referring now to the drawings, and more particularly to
The single-axis gradiometer guidance system consists of two triaxial magnetometer (TM) sensors 10 and 12 mounted on support platform 100 and coupled to a processor/controller 14 which, in turn, generates command signals used by steering system 104. Processor/controller 14 could also be used to command/control the output of drive system 102.
Each of TM sensors 10 and 12 is a triaxial magnetometer (TM) sensor. As is known in the art, a TM sensor has three mutually orthogonal magnetic field sensing axes for sensing magnetic field (i.e., B-field) components (Bx,By,Bz). The sense axis directions define a convenient and computationally efficient choice for a local (X,Y,Z) coordinate system.
The design and construction requirements that the B-field component sensing axes of the TM sensors used in the present invention must meet in order for this invention to provide a robust guidance system/method are as follows:
In accordance with the present invention, each of TM sensors 10 and 12 is coupled to or mounted on platform 100 such that their X,Y,Z B-field sensing axes are parallel to one another and parallel to the overall X,Y,Z system's local coordinates reference frame. The system's X,Y,Z coordinate frame moves with platform 100. One of the system's X,Y,Z axes is chosen as the forward direction of movement of platform 100. By way of example, this will be the X-axis in each embodiment described herein so that the forward direction of movement will be in the +X direction. Accordingly, TM sensors 10 and 12 have their X-sensing axis aligned with the forward direction of movement of platform 100.
TM sensors 10 and 12 are arranged along a line or axis 16 and are spaced apart from one another along axis 16. More specifically, TM sensors 10 and 12 are separated by a distance d (i.e., d=ΔX in this case) while ΔY=ΔZ=0. Each of TM sensors 10 and 12 senses the X,Y,Z components of the magnetic B-field where (B1x,B1Y,B1Z) are the components sensed by TM sensor 10 and (B2X,B2Y, B2Z) are the components sensed by TM sensor 12. These B-field components are passed to processor/controller 14.
Processor/controller 14 processes the B-field components to generate a partial gradient contraction C associated with axis 16 where
c=[(ΔBX/ΔX)2+(ΔBY/ΔX)2+ΔBZ/ΔX)2+ΔBZ/ΔX)2]0.5
and where
ΔBX=(B2X−B1X)
ΔBY=(B2Y−B1Y)
ΔBz=(B2Z−B1Z)
In general, this single-axis partial contraction C is dependent on sensor-to-target distance, sensor axis orientation and sensor axis length. More specifically, these dependencies can be explained as follows:
Based on the above for a given distance to a target and a given target moment, partial gradient contraction C will be strongest when a (magnetic) target 300 is aligned with axis 16 (i.e., θ=0°) and weakest when a target 302 is aligned on a line perpendicular to and passing through the center of axis 16 (i.e., θ=90°). An intermediate value of C will result for a target 304 located such that 0<θ<90°.
If a single-axis gradiometer as just described were to be used in a magnetic guidance system, the C-values could be used in the following way. Platform 100 would move in a search pattern until the C-values increase from the background noise level to a level indicative of target detection. On detection of a target, processor/controller 14 would command steering system 104 (and, possibly, drive system 102) to rotate platform 100 to maximize the C-value. The maximum C-value at a given position of the sensor corresponds to the sensor axis alignment in the direction of the target. Platform 100 would then proceed in a direction that maintains a maximum C-value at each platform position until contact with the target is made.
The single-axis gradiometer-based guidance method is limited in that it requires substantial trial and error to find the initial alignment of the sensor axis with the target direction and to maintain that alignment as the sensor platform maneuvers toward the target. Thus, the single-axis configuration does not have the potential for robust guidance for typical two and three-dimensional search scenarios. More appropriate sensor configurations for robust two and three-dimensional magnetic guidance are presented herein where multi-axis arrays composed of single-axis-gradiometer-type axes are geometrically configured to take advantage of the symmetry properties of the gradient contraction in order to develop robust magnetic guidance parameters. Briefly, implementation of this concept involves the development of gradient contraction-based guidance signals from planar sets of at least two single-axis-gradiometer-type “primary guidance axes” and one or more “secondary guidance axes” that are symmetrically disposed about a geometric axis of symmetry. Examples of appropriate sensor configurations and magnetic guidance methods are discussed in the following paragraphs.
For example,
The triangular arrangement of TM sensors 20, 22 and 24 defines three sensor pairs or “axes” of measurement with each such axis being defined between a pair of TM sensors. That is, a left primary axis 30 is defined between TM sensors 20 and 22, a right primary axis 32 is defined between TM sensors 20 and 24, and a bottom secondary axis 34 is defined between TM sensors 22 and 24. The length of axis 30 or L30 is equal to that of axis 32 or L32. The paired equal-length axes 30 and 32 are symmetrically disposed about axis of symmetry 26 in order to develop the primary guidance signals that are used to align axis 26 with the target direction. Secondary axis 34 is perpendicular to axis of symmetry 26 and develops an additional “secondary” guidance signal that can be combined with the primary signals from axes 30 and 32 to provide the invention with more robust magnetic guidance capabilities. The length of axis 34 or L34 will not equal L30 and L32 in the case of an isosceles triangle, but will equal L30 and L32 in the case of an equilateral triangle.
In a magnetic anomaly guidance system, the X,Y,Z components of the B-fields sensed by TM sensors 20, 22 and 24 (i.e., respectively written as (B1X,B1Y,B1Z), (B2X,B2Y,B2Z) and (B3X,B3Y,B3Z)) are processed by processor/controller 14 to generate partial gradient contractions associated with each of axes 30, 32 and 34. Specifically,
C30=[(B2X−B1X)2+(B2Y−B1Y)2+(B2Z−B1Z)2]0.5/L30
C32=[(B3X−B1X)2+(B3Y−B1Y)2+(B3Z−B1Z)2]0.5/L32
C34=[(B3X−B2X)2+(B3Y−B2Y)2+(B3Z−B2Z)2]0.5/L34
In operation of such a guidance system, when platform 100 is headed straight at a target, axis of symmetry 26 will be pointed at the target so that C30=C32 while, for an equilateral planar array of TM sensors, C34<C30=C32 since secondary axis 34 is both further from the target and perpendicular to the “target direction” (i.e., the direction that axis of symmetry 26 makes with the target). When platform 100 is not headed directly to the target, the relative magnitudes of C30, C32 and C34 constitute guidance parameters used by processor/controller 14 to generate steering command signals for the steering system which has been omitted from
The guidance method can be implemented in the following fashion. Once a target has been detected, platform 100 is rotated about the Z-axis until the relationship C30=C32>C34 is satisfied. This essentially aligns platform 100 so that axis of symmetry 26 is pointed at the target in the +X direction. Platform 100 is then moved in the +X direction while maintaining the relationship C30=C32>C34. As platform 100 moves toward the target, the values of C30, C32 and C34 increase as the platform-to-target distance decreases. Any time the relationship C30=C32>C34 is not maintained, platform 100 is rotated until this relationship is again attained. For the sensor-platform configuration and forward direction shown in
For the simple planar three TM sensor arrangement, some of the aforementioned ambiguities can be mitigated by using the configuration of
In the
In using either of the
The guidance method can be implemented in the following fashion. Once a target has been detected, platform 100 is rotated until C30=C32 to align the platform's forward direction of motion with the target. The appropriate direction of rotation of platform 100 about the Z-axis is determined by the relative magnitudes of C30 and C32. For example, if platform 100 deviates to the left of the target, the relationship C30<C32 develops. Conversely, if platform 100 deviates to the right of the target, the relationship C30>C32 develops.
The robustness and versatility of the multi-axis array approach for magnetic guidance can be enhanced by increasing the number of axes presented by the array of sensors. Thus, the present invention is not limited to three-axis gradiometer guidance systems. For example, six-axis gradiometer guidance systems could also be created by the addition of a fourth TM sensor as illustrated in
The partial gradient contractions C30, C32, C34, C36, C38 and C40 can be determined by the same process described for the three-axis gradiometer. The relationships between the C-values can be used by process/controller 14 to generate steering control commands for steering system 104. For example, when platform 100 is headed straight towards a target with axis of symmetry 26 aligned therewith, the following “alignment relationships” are true:
C40>C30,C32
C30=C32>C36,C38
C36=C38<C34
A rotation of platform 100 to the right (left) results in the target being located in the left (right) side of the system's detection space thereby causing relative reductions in C30 and C38 and relative increases in C32 and C36. Relative to the condition where axis 40 is aligned with a target, platform rotations in either direction will cause reductions in C40 and increases in C34.
It is to be understood that systems based on the use of four TM sensors are not limited to the quadrilateral arrangement depicted in FIG. 5. For example, four TM sensors could be arranged in a planar square or planar trapezoid. The square's side or trapezoid's base would be positioned perpendicular to the arrangement's axis of symmetry that would be aligned with the support platform's forward direction of movement and that would divide the arrangement into two mirror-image halves.
The
The advantages of the present invention are numerous. The invention's symmetrical arrangements of triaxial magnetometer sensors, and methods of using relationships between gradient contraction values from symmetrically arranged axes of the sensor arrangements, provides a novel magnetic guidance system and method. The present invention will be useful as part of an autonomous vehicle controlled system that uses a detected magnetic anomaly to steer itself. The magnetic anomaly can originate from a point target or from continuous track such as a buried cable, pipeline or specifically-placed guidance track.
Although the invention has been described relative to a specific embodiment thereof, there are numerous variations and modifications that will be readily apparent to those skilled in the art in light of the above teachings. It is therefore to be understood that, within the scope of the appended claims, the invention may be practiced other than as specifically described.
Number | Name | Date | Kind |
---|---|---|---|
5777477 | Wynn | Jul 1998 | A |
6242907 | Clymer et al. | Jun 2001 | B1 |
6339328 | Keene et al. | Jan 2002 | B1 |