Inertial/magnetic measurement device
First Claim
1. One or more computer-readable media adapted for use with a computing device which is adapted to execute at least one of direction and motion measurement, said media having computer-usable instructions embodied thereon for performing a method comprising:
- computing body-sensed navigational frame magnetic field vector using sensed magnetic data;
calculating attitude residuals between a group of body-sensed navigational frame magnetic field components and an initial magnetic reference frame;
outputting said residuals to a Kalman filter process;
measuring the observability for an attitude axis for each of roll, pitch, and yaw;
producing a measurement-noise covariance matrix;
using said measurement-noise covariance matrix in said Kalman filter process;
detecting for motion;
generating said initial magnetic reference frame if no motion is detected;
taking running averages for magnetic field until a predetermined amount of time has elapsed; and
outputting said running averages to serve as said initial magnetic field reference frame in said calculating step.
9 Assignments
0 Petitions
Accused Products
Abstract
Disclosed is a system and method for onboard optimal estimation of heading, pitch, and roll through real-time measurement of magnetic field, acceleration and angular motion in three dimensions. Magnetometer information is used to create an initial reference from which movement is measured. Thus, the process does not have to start when the body is in a known position. Further, the device does not have to continually rely on accelerometer data to get roll and pitch. To do this magnetic field data is used to complement gyro information. The magnetic data is used to estimate pitch, roll, and heading.
-
Citations
25 Claims
-
1. One or more computer-readable media adapted for use with a computing device which is adapted to execute at least one of direction and motion measurement, said media having computer-usable instructions embodied thereon for performing a method comprising:
-
computing body-sensed navigational frame magnetic field vector using sensed magnetic data; calculating attitude residuals between a group of body-sensed navigational frame magnetic field components and an initial magnetic reference frame; outputting said residuals to a Kalman filter process; measuring the observability for an attitude axis for each of roll, pitch, and yaw; producing a measurement-noise covariance matrix; using said measurement-noise covariance matrix in said Kalman filter process; detecting for motion; generating said initial magnetic reference frame if no motion is detected; taking running averages for magnetic field until a predetermined amount of time has elapsed; and outputting said running averages to serve as said initial magnetic field reference frame in said calculating step.
-
-
2. One or more computer-readable media adapted for use with a comprising device which is adapted to execute at least one of direction and motion measurement, said media having computer-usable instructions embodied thereon for performing a method comprising:
-
computing body-sensed navigational frame magnetic field vector using sensed magnetic data; calculating attitude residuals between a group of body-sensed navigational frame magnetic field components and an initial magnetic reference frame; outputting said residuals to a Kalman filter process; measuring the observability for an attitude axis for each of roll, pitch, and yaw; producing a measurement-noise covariance matrix; using said measurement-noise covariance matrix in said Kalman filter process; and wherein said producing a measurement-noise covariance matrix step comprises; using simulation generated empirical data to relate observability with angle measurement uncertainty. - View Dependent Claims (3)
-
-
4. One or more computer-readable media adapted for use with a computing device which is adapted to execute at least one of direction and motion measurement, said media having computer-usable instructions embodied thereon for performing a method comprising:
-
computing body-sensed navigational frame magnetic field vector using sensed magnetic data; calculating attitude residuals between a group of body-sensed navigational frame magnetic field components and an initial magnetic reference frame; outputting said residuals to a Kalman filter process; measuring the observability for an attitude axis for each of roll, pitch, and yaw; producing a measurement-noise covariance matrix; using said measurement-noise covariance matrix in said Kalman filter process; and said method including an intermittent gyro calibration module which assists in the calibration of gyro data, said intermittent gyro calibration module comprising; sensing for motion; low-pass filtering the gyro data; taking running averages for bias estimations if no motion is detected; and outputting said running averages for bias estimations to a gyro compensation process. - View Dependent Claims (5, 6, 7)
-
-
8. One or more computer-readable media adapted for use with an inertial measurement device, said media having computer-usable instructions embodied thereon for performing a method for of measuring at least one of direction and motion which makes use of magnetometer data, said method incorporating an anomaly filter process, said process comprising:
-
identifying whether an anomaly exists in said magnetometer data; notifying other processes of the existence of an anomaly if one exists; and submitting said magnetometer data to said other processes as reliable if no anomaly is identified wherein said identifying process comprises; computing a first magnitude of a first magnetic field vector which is derived from sensed onboard compensated magnetic field data; computing a second magnitude of a second magnetic field vector which is derived from initial reference magnetic field data; comparing said first magnitude to said second magnitude; and executing said notifying step if said first and second magnitudes are significantly different. - View Dependent Claims (9)
-
-
10. One or more computer-readable media adapted for use with an inertial measurement device, said media having computer-usable instructions embodied thereon for performing a method for of measuring at least one of direction and motion which makes use of magnetometer data, said method incorporating an anomaly filter process, said process comprising:
-
identifying whether an anomaly exists in said magnetometer data; notifying other processes of the existence of an anomaly if one exists; and submitting said magnetometer data to said other processes as reliable if no anomaly is identified wherein said identifying process comprises; computing a first magnitude of a magnetometer-sensed angular rate vector; computing a second magnitude of a gyro-sensed angular rate vector; comparing said first magnitude to said second magnitude; and executing said notifying step if said first and second magnitudes are significantly different.
-
-
11. One or more computer-readable media adapted for use with an inertial measurement device, said media having computer-usable instructions embodied thereon for performing a method for of measuring at least one of direction and motion which makes use of magnetometer data, said method incorporating an anomaly filter process, said process comprising:
-
identifying whether an anomaly exists in said magnetometer data; notifying other processes of the existence of an anomaly if one exists; and submitting said magnetometer data to said other processes as reliable if no anomaly is identified wherein said process comprises; estimating said anomaly; filtering out said anomaly if said notifying step has occurred; and outputting filtered values to at least one other process for the purpose of estimating at least one of position and motion. - View Dependent Claims (12)
-
-
13. One or more computer-readable media having computer-usable instructions embodied thereon for performing when executed by a computing device a method comprising:
-
receiving magnetic data including a plurality of simultaneously body-sensed measurements from a plurality of differently-oriented magnetic-sensing devices mounted on a body; using said magnetic data in calculating a magnetic-reading-based three-dimensional orientation for said body in relation to a known magnetic field. - View Dependent Claims (14, 15, 16, 17, 18)
-
-
19. A process for measuring at least one of direction and motion, said process comprising:
-
computing body-sensed navigational frame magnetic field vector using sensed magnetic data from a plurality of magnatometers; calculating attitude residuals between a group of body-sensed navigational frame magnetic field components and an initial magnetic reference frame using one or more computing devices; outputting said residuals to a Kalman filter process module on said one or more computing devices; measuring the observability for an attitude axis for each of roll, pitch, and yaw; producing a measurement-noise covariance matrix using said one or more computing devices; using said measurement-noise covariance matrix in said Kalman filter process module; detecting for motion; generating said initial magnetic reference frame if no motion is detected using said one or more computing devices; taking running averages for magnetic field until a predetermined amount of time has elapsed using said one or more computing devices; and outputting said running averages to serve as said initial magnetic field reference frame in said calculating step one said one or more computing devices.
-
-
20. An inertial measurement unit comprising:
-
a computer processing device, said computer processing device adapted to receive magnetic data including a plurality of simultaneously body-sensed measurements from a plurality of differently-oriented magnetic-sensing devices mounted on a body; and said computing device adapted to calculate a magnetic-reading-based three-dimensional orientation for said body in relation to a known magnetic field using said magnetic data. - View Dependent Claims (21, 22, 23, 24, 25)
-
Specification