Sourceless orientation sensor

• US 5,953,683 A
• Filed: 10/09/1997
• Issued: 09/14/1999
• Est. Priority Date: 10/09/1997
• Status: Expired due to Term

• Current Assignee: Ascension Technology Corporation (Roper Technologies, Inc.)
• Original Assignee: Ascension Technology Corporation (Roper Technologies, Inc.)
• Inventors: Kogan, Vladimir, Hansen, Per Krogh
• Primary Examiner(s): Barlow, Jr., John E.
• Assistant Examiner(s): Bui, Bryan
• Application Number:
  US08/946,916
• Time in Patent Office: 705 Days
• Field of Search: 702/95, 702/92, 702/150-154, 324/207.12, 324/207.17, 324/247, 324/253, 33/355 R, 33/356, 33/361
• US Class Current: 702/95
• CPC Class Codes: G01C 17/30 Earth-inductor compasses

Abstract

In a sourceless orientation sensor, the sensor measures the three orientation angles azimuth, elevation and roll in a fixed reference three-dimensional coordinate frame. The sensor utilizes a three-axis magnetic sensor to measure changes in the Earth'"'"'s magnetic field in order to determine the azimuth and roll (or elevation) angles after the elevation (or roll) angle has been determined by other means. A first embodiment utilizes a separate sensor to measure the elevation (or roll) angle in a fixed reference three-dimensional coordinate frame while a three axis magnetic sensor is used to measure the Earth'"'"'s magnetic field. The azimuth and the roll (or elevation) angles are then determined from these measurements. A second embodiment utilizes a combination of a three-axis accelerometer to sense the Earth'"'"'s gravity to measure the absolute elevation and roll angles for slow motions and a two-axis rate sensor to measure the azimuth and elevation velocities in the sensor frame. A direct method employing translation and integration is used to find the azimuth and elevation angles in the fixed reference three-dimensional coordinate frame. The roll angle is then found from the magnetic sensor measurements. Other embodiments are disclosed.

Claims

1. A sourceless orientation sensor, comprising:

a) two-axis magnetic sensing means for measuring the Earth'"'"'s magnetic field,

b) measuring means for measuring elevation or roll angle of said object with respect to a fixed reference three-dimensional coordinate frame, and

c) computing means for controlling the taking of measurements by said magnetic sensing means and measuring means and converting said measurements into azimuth, elevation and roll angles relative to a fixed coordinate frame, wherein said computing means receives signals from an initial calibration procedure of said magnetic sensing means and determines constant Earth magnetic field intensity and therefrom calculates a third axis component of the Earth'"'"'s magnetic field.

2. The sensor of claim 1, wherein said measuring means comprises an angle sensor.

3. The sensor of claim 2, wherein said measuring means is chosen from the group consisting of a magnetic sensing device, tilt sensors or an optical sensing device.

4. The sensor of claim 1, wherein said magnetic sensing means comprises a three-axis magnetic sensing means, said axes being mutually orthogonal.

5. The sensor of claim 4, further including an amplifier, lowpass filter and A/D converter interposed between said sensing means and said computer.

6. The sensor of claim 4, further including an amplifier, lowpass filter and A/D converter interposed between said measuring means and said computer.

7. A method of measuring the orientation of an object, including the steps of:

a) providing a sourceless orientation sensor comprising;

i) two-axis magnetic sensing means for measuring the Earth'"'"'s magnetic field,

ii) measuring means for measuring elevation or roll angle of said object with respect to a fixed reference three-dimensional coordinate frame; and

iii) a computer interconnected with said sensing means and measuring means;

b) programming said computer with first data from an initial calibration procedure of measurements of the constant intensity of the Earth'"'"'s magnetic field;

c) feeding said computer second data from said sensing means concerning two axes of the Earth'"'"'s magnetic field;

d) calculating, in said computer, a third axis of the Earth'"'"'s magnetic field;

e) feeding said computer third data from said measuring means concerning elevation or roll angle of said object in a fixed reference three-dimensional coordinate frame;

f) calculating orientation of said object in terms of azimuth, elevation and roll relative to a fixed reference three-dimensional coordinate frame.

8. The method of claim 7, further including the steps of amplifying and filtering said data.

9. The method of claim 7, further including the step of providing said magnetic sensing means with a third axis sensor.

10. A sourceless orientation sensor for determining orientation of an object, comprising:

a) two-axis magnetic sensing means for measuring direction and strength of the Earth'"'"'s magnetic field;

b) accelerometer means for measuring acceleration of the Earth'"'"'s gravity force;

c) measuring means for measuring elevation and azimuth angle velocities of said object with respect to a sensor frame; and

d) computer means for controlling taking of said measurements and for converting said measurements into azimuth, elevation and roll angles of said object with respect to a fixed reference three-dimensional coordinate frame.

11. The sensor of claim 10, wherein said measuring means comprises a plurality of rate sensors.

12. The sensor of claim 11, wherein said rate sensors comprise an elevation rate sensor and an azimuth rate sensor.

13. The sensor of claim 11, said rate sensors including means for measuring angular velocity of a mass.

14. The sensor of claim 11, wherein said measuring means comprises a plurality of pairs of spaced accelerometers.

15. The sensor of claim 14, wherein said accelerometers comprise an elevation sensor and an azimuth sensor.

16. The sensor of claim 15, wherein said computer means includes means for performing an integration in order to find the elevation rate and the azimuth rate.

17. The sensor of claim 10, wherein said measuring means comprises one rate sensor.

18. The sensor of claim 10, wherein said computer means includes means for receiving signals from an initial calibration of said magnetic sensing means and determining the constant Earth magnetic field intensity and therefrom calculating a third axis component of the Earth'"'"'s magnetic field.

19. The sensor of claim 10, wherein said magnetic sensing means has a third axis of magnetic sensing means, said axes being mutually orthogonal.

20. The sensor of claim 10, wherein said accelerometer means comprises a three-axis accelerometer for measuring acceleration of the Earth'"'"'s gravity, said computer receiving further signals from said three-axis accelerometer and, therefrom, determining roll angle and elevation angle of said object with respect to a fixed reference three-dimensional coordinate frame, when the sensor is held still or moving very slowly.

21. The sensor of claim 20, wherein said computer means includes means for controlling receiving of signals from said magnetic sensing means and therefrom calculates azimuth angle of said object with respect to a fixed reference three-dimensional coordinate frame, when said sensor is held still or is moving very slowly.

22. The sensor of claim 21, wherein said computer means includes means for finding drift errors on orientation angles by finding a difference between orientation angles determined from "drift free" measurements, when the sensor is held still and the orientation angles determined from using measurements from said measuring means.

23. The sensor of claim 22, wherein said computer means further compensates for said drift errors, when said sensor is moving, dependent upon rate of angular movements of said sensor.

24. The sensor of claim 10, further including an amplifier and lowpass filter interposed between said sensing means and said computer.

25. The sensor of claim 11, further including an amplifier and lowpass filter interposed between said measuring means and said computer.

26. A method of measuring the orientation of an object, including the steps of:

a) providing a sourceless orientation sensor comprising;

i) two-axis magnetic sensing means for measuring the Earth'"'"'s magnetic field;

ii) accelerometer means for measuring acceleration of the Earth'"'"'s gravity force;

iii) measuring means for measuring elevation and azimuth angle velocities of said object in a sensor frame; and

iv) a computer interconnected with said sensing means and measuring means;

b) programming said computer with first data from an initial calibration procedure of measurements of the constant intensity of the Earth'"'"'s magnetic field;

c) feeding said computer second data from said sensing means concerning two axes of the Earth'"'"'s magnetic field;

d) calculating, in said computer, a third axis of the Earth'"'"'s magnetic field;

e) feeding said computer third data from said accelerometer means concerning acceleration of the Earth'"'"'s gravity force;

f) said computer converting said angular velocity measurements into elevation and azimuth angles of said object in a fixed reference three-dimensional coordinate frame;

g) said computer further converting said second data from said sensing means into roll angle of said object with respect to a fixed reference three-dimensional coordinate frame;

h) said computer outputting azimuth, elevation and roll angles with respect to a fixed reference three-dimensional coordinate frame.

27. The method of claim 26, further including the steps of amplifying and filtering said data.

28. The method of claim 26, further including the step of providing said magnetic sensing means with a third axis sensor.

29. The method of claim 26, wherein said step of feeding said computer third data is carried out by measuring acceleration of the Earth'"'"'s gravity with a three-axis accelerometer.

30. The method of claim 26, wherein said measuring means comprises two pairs of spaced accelerometers.

31. The method of claim 30, further including the step of integrating a sum of outputs from said two pairs of spaced accelerometers to determine velocity of azimuth and elevation of said object.

32. The method of claim 27, including the further step of calculating azimuth angle of said object, with respect to a fixed reference three-dimensional coordinate frame, from signals from said magnetic sensing means, when the sensing means is held still or moving very slowly.

33. The method of claim 32, including the step of finding drift errors on orientation angles by finding a difference between orientation angles determined from the "drift free" measurements, when said sensor is held still and orientation angles determined from using measurements from said measuring means.

34. The method of claim 33, including the further step of compensating for said drift errors, when the magnetic sensing means is moving, depending upon a rate of the angular movement.

35. A method of measuring the orientation of an object, comprising:

a) providing a sourceless orientation sensor comprising;

i) two-axis magnetic sensing means for measuring Earth'"'"'s magnetic field;

ii) accelerometer means for measuring acceleration of Earth'"'"'s gravity force;

iii) measuring means for measuring elevation velocity of said object in a sensor frame;

iv) a computer interconnected with said sensing means and said measuring means;

b) programming said computer with first data from an initial calibration procedure of measurements of constant intensity of the Earth'"'"'s magnetic field;

c) feeding said computer with second data from said magnetic sensing means concerning two axes of Earth'"'"'s magnetic field;

d) calculating, in said computer, a third axis of the Earth'"'"'s magnetic field;

e) feeding said computer third data from said accelerometer means concerning acceleration of Earth'"'"'s gravity force;

f) said computer converting said elevation velocity and a last determined azimuth velocity into elevation and azimuth angle estimates of said object relative to a fixed reference three-dimensional coordinate frame;

g) said computer further converting said signals from said magnetic sensing means into roll angle estimates of said object relative to said fixed reference three-dimensional coordinate frame;

h) said computer further using said signals from said magnetic sensing means to find a different azimuth angle, comparing this azimuth angle to an azimuth angle estimate and finding a more accurate azimuth angle velocity estimate;

i) said computer repeating steps f-h until a difference between two consecutively determined azimuth angles is less than a preprogrammed level;

j) said computer outputting to a host computer said azimuth, elevation and roll angles of said object relative to said fixed reference three-dimensional coordinate frame.

36. The method of claim 35, further including the step of providing said magnetic means with a third axis sensor.