AUGMENTED VEHICLE LOCATION SYSTEM

• US 20110153266A1
• Filed: 12/21/2010
• Published: 06/23/2011
• Est. Priority Date: 12/23/2009
• Status: Abandoned Application

• Current Assignee: Regents of The University of Minnesota (University of Minnesota)
• Original Assignee: Regents of The University of Minnesota (University of Minnesota)
• Inventors: Shankwitz, Craig, Arpin, Edmund, Newstrom, Bryan
• Application Number:
  US12/974,339
• Publication Number:
  US 20110153266A1
• Time in Patent Office: Days
• US Class Current: 702/150
• CPC Class Codes: G01C 21/165 combined with non-inertial navigation instruments
• CPC Class Codes: G01S 19/49 whereby the further system is an inertial position system, e.g. loosely-coupled

Abstract

A system comprises a mobile vehicle, a global positioning system (GPS) based vehicle position and heading system, at least one two-dimensional (2D) velocity sensor, a yaw rate system, and a vehicle position and heading estimator. The GPS based vehicle position and heading system is supported on the vehicle and measures global easting and global northing (measured position) of the vehicle, and determines a heading (measured heading) of the vehicle. The 2D velocity sensor measures the velocity of the vehicle with respect to the ground, over which the vehicle travels, in two orthogonal directions (measured velocity). The yaw rate system is supported on the vehicle and measures a yaw rate of the vehicle (yaw rate measurement). The vehicle position and heading estimator comprises at least one processor that computes a position of the vehicle (estimated position) and a heading of the vehicle (estimated heading) based on the measured position, the measured heading, the measured velocity and the yaw rate measurement.

Claims

1. A system comprising:

a mobile vehicle;

a global positioning system (GPS) based vehicle position and heading system supported on the vehicle measures global easting and global northing (measured position) of the vehicle, and determines a heading (measured heading) of the vehicle;

at least one two-dimensional (2D) velocity sensor measures the velocity of the vehicle with respect to the ground, over which the vehicle travels, in two orthogonal directions (measured velocity);

a yaw rate system supported on the vehicle measures a yaw rate of the vehicle (yaw rate measurement); and

a vehicle position and heading estimator comprising at least one processor that computes a position of the vehicle (estimated position) and a heading of the vehicle (estimated heading) based on the measured position, the measured heading, the measured velocity and the yaw rate measurement.

2. The system of claim 1, wherein the vehicle position and heading estimator comprises:

a heuristic filter configured to receive the measured position, update the estimated position and the estimated heading, and determine a measurement error covariance of the measured heading;

a linear Kalman filter configured to compute an optimal estimate of the vehicle heading (optimal heading estimate) and an estimate of a yaw rate system bias based on the measurement error covariance, the measured heading and the yaw rate measurement; and

a position propagator configured to propagate the estimated position based on the updated vehicle position estimate from the heuristic filter, the measured velocity, the yaw rate measurement and the estimated heading.

3. The system of claim 2, wherein:

the heuristic filter operates at a first frequency; and

the position propagator operates at a second frequency, which is higher than the first frequency.

4. The system of claim 2, wherein the heuristic filter determines the measurement error covariance based on at least one metric selected from the group consisting of a GPS quality value corresponding to a quality of the measured position, a distance between the measured position and the estimated position, an accuracy of the measured heading, a derivative of the measured heading with respect to time, and a quality of the measured heading.

5. The system of claim 1, wherein the GPS based vehicle position and heading system comprises:

a first antenna supported on the vehicle; and

a first GPS receiver configured to calculate the measured position based on GPS signals received through the first antenna.

6. The system of claim 5, wherein the GPS based vehicle position and heading system comprises a second antenna supported on the vehicle.

7. The system of claim 6, wherein:

the vehicle comprises an axis; and

the second antenna is displaced a distance from the first antenna measured along the axis.

8. The system of claim 5, wherein the first GPS receiver comprises a dual frequency, carrier phase digital GPS receiver.

9. The system of claim 5, wherein:

the vehicle comprises a longitudinal axis extending approximately parallel to a surface over which the vehicle travels; and

the velocity sensor measures a velocity in a first direction, which is parallel to the longitudinal axis, and a second direction, which is orthogonal to the longitudinal axis.

10. The system of claim 5, wherein the yaw rate system comprises an inertial measurement unit.

11. The system of claim 1, wherein:

the system comprises a plurality of 2D velocity sensors; and

the yaw rate system comprises at least two of the plurality of 2D velocity sensors.

12. A method of estimating a vehicle position comprising:

moving a mobile vehicle;

performing global positioning system (GPS) based measurements at a first frequency using at least one GPS receiver and at least one antenna supported on the vehicle including measuring a position of the vehicle (measured position) and a heading of the vehicle (measured heading); and

between successive GPS based measurements, estimating, at a second frequency that is greater than the first frequency, a position of the vehicle (estimated position) based on the measured position, the measured heading, a two-dimensional (2D) velocity measurement of the vehicle (measured velocity) and a yaw rate measurement of the vehicle, using at least one processor supported on the vehicle.

13. The method of claim 12, wherein estimating, at a second frequency, a position of the vehicle comprises:

determining an initial estimated position of the vehicle based on the measured position;

determining an initial estimated heading of the vehicle based on the measured heading;

calculating a measurement error covariance of the measured heading;

computing an optimal vehicle heading estimate and yaw rate system bias based on the measurement error covariance, the measured heading and the yaw rate measurement;

updating the estimated position based on the previously estimated position, the measured velocity, the yaw rate measurement and the optimal vehicle heading estimate; and

repeating the calculating, computing and updating steps a finite number of times.

14. The method of claim 13, further comprising:

obtaining the velocity measurement using a 2D velocity sensor supported on the vehicle; and

obtaining the yaw rate measurement using a yaw rate system supported on the vehicle comprising one of an inertial measurement unit and a plurality of 2D velocity sensors.

15. The method of claim 13, wherein calculating a measurement error covariance of the vehicle heading measurement comprises calculating a measurement error covariance of the vehicle heading measurement based on at least one metric selected from the group consisting of a GPS quality value corresponding to a quality of the measured position, a distance between the measured position and the estimated position, an accuracy of the measured heading, a derivative of the measured heading with respect to time, and a quality of the measured heading.

16. A method of estimating a vehicle position comprising:

providing a system comprising;

a mobile vehicle;

a global positioning system (GPS) supported on the mobile vehicle;

a heading system supported on the mobile vehicle;

at least one two-dimensional (2D) velocity sensor supported on the vehicle;

a yaw rate system supported on the vehicle; and

a vehicle position and heading estimator supported on the vehicle comprising at least one processor;

moving the mobile vehicle;

calculating global easting and global northing of the vehicle (measured position) using the GPS calculating a heading of the vehicle (measured heading) using the heading system;

measuring a velocity of the vehicle in two orthogonal directions (measured velocity) using the 2D velocity sensor;

measuring a yaw rate of the vehicle (measured yaw rate) using the yaw rate system;

computing an estimated position of the vehicle based on the measured position, the measured heading, the measured velocity and the measured yaw rate using the at least one processor.

17. The method of claim 16, wherein computing an estimated position of the vehicle comprises:

determining an initial estimated position of the vehicle based on the measured position;

determining an initial estimated heading of the vehicle based on the measured heading;

calculating a measurement error covariance of the measured heading;

computing an optimal vehicle heading estimate and yaw rate system bias based on the measurement error covariance, the measured heading and the yaw rate measurement;

updating the estimated position based on the previously estimated position, the measured velocity, the yaw rate measurement and the optimal vehicle heading estimate; and

repeating the calculating, computing and updating steps a finite number of times.

18. The method of claim 16, wherein measuring a yaw rate of the vehicle comprises measuring a yaw rate using an inertial measurement unit supported on the vehicle.

19. The method of claim 16, wherein measuring a yaw rate of the vehicle comprises measuring a yaw rate using a plurality of 2D velocity sensors supported on the vehicle.

20. The method of claim 16, wherein:

a vehicle comprises a longitudinal axis extending approximately parallel to a surface over which the vehicle travels; and

the 2D velocity sensor measures a velocity in a first direction, which is parallel to the longitudinal axis, and a second direction, which is orthogonal to the longitudinal axis.