Positioning and navigation method and system thereof
First Claim
1. A positioning and navigation system, comprising:
- an IMU (Inertial Measurement Unit) providing inertial measurements including body angular rates and specific forces;
a GPS (Global Positioning System) processor receiving GPS satellite signals to derive position and velocity information and GPS measurements including pseudorange, carrier phase, and Doppler shift;
a magnetometer generating an Earth magnetic field measurement; and
a central navigation processor which comprises;
a Kalman filter receiving said GPS raw measurements and said inertial navigation solution derived from said INS processor which is blended with said GPS raw measurements to derive a plurality of INS corrections and GPS corrections, wherein said INS corrections are fed back from said Kalman filter to said INS processor to correct said inertial navigation solution;
an INS (Inertial Navigation System) processor receiving said inertial measurements, including said body angular rates and said specific forces, for computing an inertial navigation solution which are position, velocity, acceleration, and attitude of a carrier carrying said positioning and navigation system; and
an AHRS (Attitude and Heading Reference System) processor receiving said Earth magnetic field measurement from said magnetometer and said inertial measurements from said IMU which is blended with said Earth magnetic field measurement for computing an AHRS solution which are attitude and heading data of said carrier and being outputted as navigation solution when said GPS satellite signals are not available.
1 Assignment
0 Petitions
Accused Products
Abstract
A positioning and navigation method and system thereof can substantially solve the problems encountered in global positioning system-only and inertial navigation system-only, such as loss of global positioning satellite signal sensibility to jamming and spoofing, and inertial solution'"'"'s drift over time, in which the velocity and acceleration from an inertial navigation processor and an attitude and heading solution from an AHRS processor are used to aid the code and carrier phase tracking of the global positioning system satellite signals, so as to enhance the performance of the global positioning and inertial integration system, even in heavy jamming and high dynamic environments and when the GPS satellite signals are not available.
89 Citations
40 Claims
-
1. A positioning and navigation system, comprising:
-
an IMU (Inertial Measurement Unit) providing inertial measurements including body angular rates and specific forces;
a GPS (Global Positioning System) processor receiving GPS satellite signals to derive position and velocity information and GPS measurements including pseudorange, carrier phase, and Doppler shift;
a magnetometer generating an Earth magnetic field measurement; and
a central navigation processor which comprises;
a Kalman filter receiving said GPS raw measurements and said inertial navigation solution derived from said INS processor which is blended with said GPS raw measurements to derive a plurality of INS corrections and GPS corrections, wherein said INS corrections are fed back from said Kalman filter to said INS processor to correct said inertial navigation solution;
an INS (Inertial Navigation System) processor receiving said inertial measurements, including said body angular rates and said specific forces, for computing an inertial navigation solution which are position, velocity, acceleration, and attitude of a carrier carrying said positioning and navigation system; and
an AHRS (Attitude and Heading Reference System) processor receiving said Earth magnetic field measurement from said magnetometer and said inertial measurements from said IMU which is blended with said Earth magnetic field measurement for computing an AHRS solution which are attitude and heading data of said carrier and being outputted as navigation solution when said GPS satellite signals are not available. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29)
-
-
30. A positioning and navigation system, comprising:
-
an IMU (Inertial Measurement Unit) providing inertial measurements including body angular rates and specific forces;
a magnetometer generating an Earth magnetic field measurement; and
a central navigation processor which comprises;
an INS (Inertial Navigation System) processor receiving said inertial measurements, including said body angular rates and said specific forces, for computing an inertial navigation solution which are position, velocity, acceleration, and attitude of a carrier carrying said positioning and navigation system; and
an AHRS processor receiving said Earth magnetic field measurement from said magnetometer and said inertial measurements from said IMU which is blended with said Earth magnetic field measurement for computing an AHRS solution which are attitude and heading data of said carrier. - View Dependent Claims (31)
-
-
32. A positioning and navigation method, comprising the steps of:
-
(a) receiving a plurality of global positioning system satellite signals to derive position and velocity information and a plurality of global positioning system (GPS) raw measurements, including pseudorange, carrier phase, and Doppler shift, of a carrier;
(b) sending said GPS raw measurements to a central navigation processor from a GPS (Global Positioning System) processor;
(c) receiving a plurality of inertial measurements including body angular rates and specific forces from a IMU (Inertial Measurement Unit);
(d) sending said inertial measurements from said IMU to an INS (Inertial Navigation System) processor of said central navigation processor for computing an inertial navigation solution, which are position, velocity, acceleration, and attitude of said carrier;
(e) receiving an Earth magnetic field measurement from a magnetometer;
(f) sending said Earth magnetic field measurement from said magnetometer to an AHRS (Attitude and Heading Reference System) processor of said central navigation processor;
(g) sending said inertial measurements, including said body angular rates and said specific forces from said IMU to said AHRS processor to blend with said Earth magnetic field measurement for computing an AHRS solution which are attitude and heading data of said carrier;
(h) blending an inertial navigation solution derived from said INS processor and said GPS raw measurements from said GPS processor in a Kalman filter to derive a plurality of INS corrections and GPS corrections; and
(i) feeding back said INS corrections from said Kalman filter to said INS processor to correct said inertial navigation solution. - View Dependent Claims (33, 34, 35, 36, 37)
-
-
38. A positioning and navigation method, comprising the steps of:
-
(a) receiving a plurality of inertial measurements including body angular rates and specific forces from an IMU (Inertial Measurement Unit);
(b) sending said inertial measurements from said IMU to an INS (Inertial Navigation System) processor of a central navigation processor for computing an inertial navigation solution which are position, velocity, acceleration and attitude of a carrier;
(c) receiving an Earth magnetic field measurement from a magnetometer;
(d) sending said Earth magnetic field measurement from said magnetometer to an AHRS (Attitude and Heading Reference System) processor of said central navigation processor; and
(e) sending said inertial measurements from said IMU to said AHRS processor of said central navigation processor to blend with said Earth magnetic field measurement for computing an AHRS solution which are attitude and heading data of said carrier. - View Dependent Claims (39, 40)
-
Specification