Method and device for measuring the position and orientation of objects in the presence of interfering metals

• US 5,347,289 A
• Filed: 06/29/1993
• Issued: 09/13/1994
• Est. Priority Date: 06/29/1993
• Status: Expired due to Fees

• Current Assignee: Honeywell Incorporated (Honeywell International Inc.)
• Original Assignee: Honeywell Incorporated (Honeywell International Inc.)
• Inventors: Elhardt, Scott T.
• Primary Examiner(s): Blum, Theodore M.
• Application Number:
  US08/084,831
• Time in Patent Office: 441 Days
• Field of Search: 342/448, 342/451, 340/870.32, 364/559, 324/226, 324/207.25
• US Class Current: 342/448
• CPC Class Codes: G01S 5/0247 Determining attitude

Abstract

A method of measuring the position and orientation of an object is disclosed in conjunction with an apparatus to achieve this method. The method and apparatus reduce the metal effects caused by metal objects which are in close proximity to a magnetic field generator. The metal effects are reduced by utilizing a magnetic field generator which creates a rotating magnetic field vector and then measuring the time required for that magnetic field vector to travel between a known reference point and the sensor whose position is being measured. By keeping the frequency of the rotating magnetic field vector constant and measuring the time required for this magnetic field vector to travel the previously mentioned distance, an angle between a reference axis and a vector directed toward the sensor can be determined. Once appropriate angles are measured, calculations can be undergone to determine the position of the sensor. Furthermore, by utilizing a plurality of sensors the orientation of the sensors with respect to one another can be determined.

Claims

1. A sensing device for determining the position and orientation of an object in a predefined space, comprising:

a magnetic field generation means for generating a magnetic field having a rotating field vector, the field generation means situated in the predefined space at a known location and in a known orientation;

a first sensor means for sensing the rotating field vector and generating a signal in response to the rotating field vector, the first sensor means attached to the object whose position is being sensed;

a second sensor means for sensing the rotating field vector and generating a signal in response to the rotating field vector, the second sensor means attached to the object whose position is being sensed;

a timing means attached to the transmitting means and the first sensor means for sensing a first time period in which the rotating field vector travels between a reference point and the first sensor means, the timing means being further attached to the second sensor means for measuring a second time period in which the rotating magnetic field vector travels between the reference point and the second sensor means; and

a computing means for computing the position of the first sensor means based upon the first time period and for computing the position of the second sensor means based upon the second time period, the computing means for further computing the orientation of the object based upon the position of the first sensor means and the second sensor means.

2. The sensing device of claim 1 wherein the field generation means comprises a transmitting means having three orthogonal coils for generating magnetic fields having components aligned with the axis of the orthogonal coils and a drive signal generator for energizing the orthogonal coils so as to produce the rotating magnetic field vector.

3. The sensing device of claim 1 wherein the first sensor means comprises a magnetic sensor having three orthogonally situated sensor coils, in each sensor coil is induced an electrical current in the presence of a magnetic field oriented along a sensitive axis of each sensor coil, an amplifying network for sensing the electrical current induced in each of the sensor coils and producing a plurality of electrical signals indicative of the induced current, and a signal processing stage for receiving the electrical signals and producing an output electrical signal indicative of the root-sum-of-squares of the plurality of electrical signals.

4. The sensing device of claim 3 wherein the three sensor coils are an X-coil, a Y-coil, and a Z-coil.

5. The sensing device of claim 3 wherein each coil is attached to a sensing amplifier, the sensing amplifier capable of producing a voltage signal indicative of the amount of current induced in each coil by a magnetic field.

6. The sensing device of claim 1 wherein the magnetic field generation means further comprises an X-memory for storing X-waveforms, a Y-memory for storing Y-waveforms and a Z-memory for storing Z-waveforms, the X-memory having an output attached to an X-coil driving means for driving the X-coil in accordance with the stored X-waveforms, the Y-memory having an output attached to a Y-coil driving means for driving the Y-coil in accordance with the stored Y-waveforms, and the Z-memory having an output attached to a Z-coil driving means for driving the Z-coil in accordance with the stored Z-waveforms, the X-coil driving means attached to the transmitter X-coil, the Y-coil driving means attached to the transmitter Y-coil, the Z-coil driving means attached to the transmitter Z-coil.

7. A sensing device for determining the position of an object in a space, comprising:

a transmitting means for generating a plurality of rotating magnetic field vectors which rotate at a predetermined frequency, the transmitting means situated in at a known position;

means for sensing a magnetic field vector, the sensing means attached to the object who'"'"'s position is being determined, the sensing means having an output for outputting a sensor signal indicative of the sensed magnetic fields;

timing means for measuring a plurality of time duration required for the plurality of rotating field vectors to travel between a plurality of known reference points and the sensing means; and

computing means for computing the position of the sensing means based upon plurality of measured time duration.

8. The sensing device of claim 7 wherein the plurality of rotating magnetic field vectors are a first rotating magnetic field vector rotating in a first plane, a second rotating magnetic field vector rotating in a second plane, and a third rotating magnetic field vector rotating in a third plane.

9. The sensing device of claim 7 wherein the transmitting means has an X-coil, a Y-coil and a Z-coil orthogonally arranged for generating the plurality of rotating magnetic field vectors.

10. The sensing device of claim 8 wherein the first plane, the second plane, and the third plane are orthogonally related.

11. The sensing device of claim 7 wherein the sensing means is a three-axis magnetic field sensor capable of producing a first signal indicative of the sensed magnetic field aligned with first sensor axis, a second signal indicative of the sensed magnetic field aligned with the second sensor axis, and a third signal indicative of the sensed magnetic field aligned with the third sensor axis.

12. The sensing device of claim 11 wherein the first signal, the second signal, and the third signal are manipulated to produce the sensor signal equivalent to the root-sum-of-squares of the first signal, the second signal, and the third signal.

13. The sensing device of claim 9 wherein the transmitting means has a memory for storing waveforms and coil driving means attached to the memory for driving the field generating coils.

14. The sensing device of claim 13 wherein the memory consists of an X-memory for storing X-waveforms, a Y-memory for storing Y-waveforms, and a Z-memory for storing Z-waveforms.

15. The sensing device of claim 14 wherein the coil driving means consists of an X-digital to analog converter attached to the X-memory and an X-driving amplifier attached to the X-digital to analog converter for driving the X-coil, a Y-digital to analog converter attached to the Y-memory and an Y-driving amplifier attached to the Y-digital to analog converter for driving the Y-coil, and a Z-digital to analog converter attached to the Z-memory and a Z-driving amplifier attached to the Z-digital to analog converter for driving the Z-coil.

16. The sensing device of claim 15 wherein the X-digital to analog converter, the Y-analog to digital converter, and the Z-analog to digital converter are multiplying digital to analog to digital converters capable of dynamically scaling their outputs.

17. A method of determining the position of an object in a space comprising the steps of:

generating a first rotating magnetic field using a magnetic field generator located at a known position, the first rotating magnetic field vector having a first magnetic field vector rotating at a predetermined frequency in a first plane;

measuring the time period required for the first magnetic field vector to travel from a known first reference point to a sensor, the sensor being attached to the object who'"'"'s position is being determined;

calculating a first angle in the first plane between a vector directed from the magnetic field vector to the first known reference point and a vector directed from the magnetic field generator to the sensor;

generating a second rotating magnetic field using the magnetic field generator, the second rotating magnetic field having a second magnetic field vector rotating at a predetermined frequency in a second plane;

measuring the time period required for the second magnetic field vector to travel from a known second reference point to the sensor;

calculating a second angle in the second plane between a vector directed from the magnetic field vector to the second known reference point and a vector directed from the magnetic field generator to the sensor;

generating a third rotating magnetic field using the magnetic field generator, the third rotating magnetic field having a third magnetic field vector rotating at a predetermined frequency in a third plane;

measuring the time period required for the third magnetic field vector to travel from a known third reference point to the sensor;

calculating a third angle in the third plane between a vector directed from the magnetic field vector to the third known reference point and a vector directed from the magnetic field generator to the sensor; and

calculating the position of the object with respect to the magnetic field generator using the first angle, the second angle, and the third angle.

18. The sensing device of claim 17 wherein the computing means receives the plurality of time measurements and converts the time measurements to a plurality angles of rotation based upon the predetermined frequency of rotation.

19. The sensing device of claim 18 wherein the computing means calculates the position of the sensing means based upon the plurality of calculated angles.

20. The method of claim 17 wherein the first plane, the second plane and the third plane are orthogonal to one another.

21. A position sensing device for determining the position of a sensor in a space, comprising:

magnetic field generation means for generating a plurality magnetic fields, the plurality of magnetic fields related such that they combine to form a plurality of rotating magnetic field vectors, the magnetic field generation means further having means for producing a reference signal indicative of the time at which the plurality of rotating magnetic field vectors pass through a predefined reference point;

magnetic field receiver means for sensing the plurality of magnetic fields and providing a sensor signal indicative of the magnitude of the sensed magnetic fields;

timing means attached to the receiver means to receive the sensor signal and interpret the sensor signal to determine when the rotating magnetic field vector intersects with the receiver means, the timing means also attached to the field generation means for receiving the reference signal, the timing means for determining the time period between the reference signal and a time at which the sensor signal indicates the detection of a rotating magnetic field vector; and

computing means for determining the angular relationship between the transmitter means, the predefined reference point, and the receiver means.

22. The position sensing device of claim 21 wherein the magnetic field generation means comprises:

transmitter means having a first coil and a second coil, the first coil and the second coil being aligned normal to one another; and

drive signal generator means for generating signals to be communicated to the transmitter means, communication of the signals to the transmitter means will result in the generation of the rotating magnetic field vectors.

23. The position sensing device of claim 22 wherein the generated signals have a high frequency component and a low frequency component thus creating a high frequency rotating magnetic field vector and a low frequency rotating magnetic field vector.

24. The position sensing device of claim 23 wherein the magnetic field receiver means comprises:

a receiver having three orthogonal receiver coils;

an amplifier means for receiving induced signals from the three orthogonal coils and producing three voltage signals indicative of the magnetic field sensed by the receiver, the voltage signals each having a low frequency component as a result of the low frequency component of the transmitted signal and a high frequency component as a result of the high frequency component of the transmitted signal;

filter means for separating the low frequency component of the voltage signals from the high frequency component of the voltage signals; and

signal processing means for receiving the voltage signals from the filter means and producing an RSS signal indicative of the root sum of squares of the voltage signals, whereby the RSS signal will peak when the magnetic field vector is present at the receiver.

25. The position sensing device of claim 24 wherein the timing means receives the reference signals and the RSS signals and determines the time period between the receipt of each signal.

26. The position sensing device of claim 21 wherein the transmitter means is capable of generating the plurality of magnetic fields in three orthogonal directions and is further capable of creating the plurality of rotating magnetic field vectors which rotate about three orthogonal axis.

27. The position sensing device of claim 26 wherein the plurality of magnetic fields generated signals have a high frequency component and a low frequency component thus creating a high frequency rotating magnetic field vector and a low frequency rotating magnetic field vector.