Method of operating a magnetic compass on a machine
First Claim
1. A method of determining the heading of an excavator at a worksite using a magnetic field sensor, mounted on the excavator, said magnetic field sensor providing indications of the magnitude of the magnetic field of the earth in the X, Y and Z directions of the sensor, using inclinometers that provide an indication of the pitch and roll of the excavator, using a gyroscopic sensor for sensing rotation of the excavator about the Z axis of the magnetic field sensor, and using a processor circuit, having an associated memory, responsive to said magnetic field sensor, said inclinometers, and said gyroscopic sensor, comprising:
- creating and storing a calibration table of data, includingrotating said excavator at substantially constant speed about a generally vertical Z axis,storing the outputs from said magnetic field sensor, and said gyroscopic sensor,determining the beginning and end of a complete rotation of the excavator based on the repetition of data values from said magnetic field sensor, andscaling the data received from said gyroscopic sensor during the complete rotation and the corresponding data received from the magnetic field sensor into substantially equal angular increments, and storing such scaled data,sensing the magnetic field at the excavator with the magnetic field sensor, providing indications of the magnitude of the magnetic field in the X, Y and Z directions of the sensor,transforming the sensed indications of the magnetic field from the X, Y and Z coordinate reference frame of the sensor to the local level plane coordinate reference frame using the outputs from the inclinometers,determining the hard iron components of the transformed sensed indication of the magnetic field and removing such hard iron components to produce corrected indications of the magnetic field in the local level plane coordinate reference frame, andcomparing the corrected indications to the stored, scaled data to determine the heading of the excavator.
1 Assignment
0 Petitions
Accused Products
Abstract
A method of determining the heading of an excavator at a worksite uses a magnetic field sensor, mounted on the excavator, inclinometers that provide an indication of the pitch and roll of the excavator, a gyroscopic sensor that senses the rotational rate of the excavator about the Z axis of the magnetic field sensor, and a processor circuit, having an associated memory. A calibration table of data is created and stored using the gyroscopic sensor as the excavator is rotated at a uniform velocity. The sensed indications of the magnetic field from the coordinate reference frame of the sensor are transformed to the local level plane coordinate reference frame using the outputs from the inclinometers.
-
Citations
20 Claims
-
1. A method of determining the heading of an excavator at a worksite using a magnetic field sensor, mounted on the excavator, said magnetic field sensor providing indications of the magnitude of the magnetic field of the earth in the X, Y and Z directions of the sensor, using inclinometers that provide an indication of the pitch and roll of the excavator, using a gyroscopic sensor for sensing rotation of the excavator about the Z axis of the magnetic field sensor, and using a processor circuit, having an associated memory, responsive to said magnetic field sensor, said inclinometers, and said gyroscopic sensor, comprising:
-
creating and storing a calibration table of data, including rotating said excavator at substantially constant speed about a generally vertical Z axis, storing the outputs from said magnetic field sensor, and said gyroscopic sensor, determining the beginning and end of a complete rotation of the excavator based on the repetition of data values from said magnetic field sensor, and scaling the data received from said gyroscopic sensor during the complete rotation and the corresponding data received from the magnetic field sensor into substantially equal angular increments, and storing such scaled data, sensing the magnetic field at the excavator with the magnetic field sensor, providing indications of the magnitude of the magnetic field in the X, Y and Z directions of the sensor, transforming the sensed indications of the magnetic field from the X, Y and Z coordinate reference frame of the sensor to the local level plane coordinate reference frame using the outputs from the inclinometers, determining the hard iron components of the transformed sensed indication of the magnetic field and removing such hard iron components to produce corrected indications of the magnetic field in the local level plane coordinate reference frame, and comparing the corrected indications to the stored, scaled data to determine the heading of the excavator. - View Dependent Claims (2, 3, 4, 5)
-
-
6. A method of determining the heading of an excavator and compensating for soft iron errors at a worksite using a magnetic field sensor, mounted on the excavator, said magnetic field sensor providing indications of the magnitude of the magnetic field of the earth in the X, Y and Z directions of the sensor, using gravity reference sensors that provide an indication of the pitch and roll of the excavator, using a gyroscopic sensor for sensing rotation of the excavator about the Z axis of the magnetic field sensor, and using a processor circuit, having an associated memory, responsive to said magnetic field sensor, said inclinometers, and said gyroscopic sensor, comprising:
-
creating and storing a calibration table of data, including noting the pitch and roll of the excavator, rotating said excavator at substantially constant speed about a substantially vertical Z axis through a complete rotation, storing the outputs from said magnetic field sensor, said inclinometers, and said gyroscopic sensor, determining the beginning and end of a complete rotation of the excavator based on the repetition of data values from said magnetic field sensor, and scaling the data received from said gyroscopic sensor during the complete rotation and the corresponding data received from the magnetic field sensor into substantially equal angular increments, and storing such scaled data, sensing the magnetic field at the excavator with the magnetic field sensor, providing indications of the magnitude of the magnetic field in the X, Y and Z directions of the sensor, transforming the sensed indications of the magnetic field from the X, Y and Z coordinate reference frame of the sensor to the local level plane coordinate reference frame using the outputs from the inclinometers, and comparing the corrected indications to the stored, scaled data to determine the heading of the excavator. - View Dependent Claims (7, 8, 9, 10)
-
-
11. A method of determining the heading of an excavator at a worksite using a magnetic field sensor, mounted on the excavator, said magnetic field sensor providing indications of the magnitude of the magnetic field of the earth in the X, Y and Z directions of the sensor, using inclinometers that provide an indication of the pitch and roll of the excavator, using a gyroscopic sensor for sensing rotation of the excavator about the Z axis of the magnetic field sensor, and using a processor circuit, having an associated memory, responsive to said magnetic field sensor, said inclinometers, and said gyroscopic sensor, comprising:
-
creating and storing a calibration table of data, including rotating said excavator about a generally vertical Z axis through less than a complete rotation, storing the outputs from said magnetic field sensor, and said gyroscopic sensor, and separating the data received from said gyroscopic sensor during the less than complete rotation and the corresponding data received from the magnetic field sensor into substantially equal angular increments, and storing such data, sensing the magnetic field at the excavator with the magnetic field sensor, providing indications of the magnitude of the magnetic field in the X, Y and Z directions of the sensor, transforming the sensed indications of the magnetic field from the X, Y and Z coordinate reference frame of the sensor to the local level plane coordinate reference frame using the outputs from the inclinometers, determining the hard iron components of the transformed sensed indication of the magnetic field and removing such hard iron components to produce corrected indications of the magnetic field in the local level plane coordinate reference frame, and comparing the corrected indications to the stored, scaled data to determine the heading of the excavator. - View Dependent Claims (12, 13, 14, 15)
-
-
16. A method of determining the heading of an excavator and compensating for soft iron errors at a worksite using a magnetic field sensor, mounted on the excavator, said magnetic field sensor providing indications of the magnitude of the magnetic field of the earth in the X, Y and Z directions of the sensor, using gravity reference sensors that provide an indication of the pitch and roll of the excavator, using a gyroscopic sensor for sensing rotation of the excavator about the Z axis of the magnetic field sensor, and using a processor circuit, having an associated memory, responsive to said magnetic field sensor, said inclinometers, and said gyroscopic sensor, comprising:
-
creating and storing a calibration table of data, including noting the pitch and roll of the excavator, rotating said excavator about a substantially vertical Z axis through less than a complete rotation, storing the outputs from said magnetic field sensor, said inclinometers, and said gyroscopic sensor, and separating the data received from said gyroscopic sensor during the less than complete rotation and the corresponding data received from the magnetic field sensor into substantially equal angular increments, and storing such scaled data, sensing the magnetic field at the excavator with the magnetic field sensor, providing indications of the magnitude of the magnetic field in the X, Y and Z directions of the sensor, transforming the sensed indications of the magnetic field from the X, Y and Z coordinate reference frame of the sensor to the local level plane coordinate reference frame using the outputs from the inclinometers, and comparing the corrected indications to the stored, scaled data to determine the heading of the excavator. - View Dependent Claims (17, 18, 19, 20)
-
Specification