System for autonomous vehicle navigation with carrier phase DGPS and laser-scanner augmentation
First Claim
1. A navigational device for determining the position and heading of an object, comprising:
- a navigation calculation device configured to calculate the position and the heading of the object based on an output of a velocity detecting device and an output of a yaw rate detecting device; and
an estimator configured to estimate, based on a carrier phase and a pseudorange received from a global positioning satellite, (1) an error of the velocity detecting device, (2) an error of the yaw rate detecting device, (3) a position error and a heading error of the object, and (4) an integer-valued bias of a carrier, wherein the navigation calculation device is configured to update the position and the heading of the object based on the position error and the heading error estimated by the estimator.
3 Assignments
0 Petitions
Accused Products
Abstract
A horizontal navigation system aided by a carrier phase differential Global Positioning System (GPS) receiver and a Laser-Scanner (LS) for an Autonomous Ground Vehicle (AGV). The high accuracy vehicle navigation system is highly demanded for advanced AGVs. Although high positioning accuracy is achievable by a high performance RTK-GPS receiver, the performance should be considerably degraded in a high-blockage environment due to tall buildings and other obstacles. The present navigation system is to provide decimetre-level positioning accuracy in such a severe environment for precise GPS positioning. The horizontal navigation system is composed of a low cost Fiber Optic Gyro (FOG) and a precise odometer. The navigation errors are estimated using a tightly coupled Extended Kalman Filter (EKF). The measurements of the EKF are double differenced code and carrier phase from a dual frequency GPS receiver and relative positions derived from laser scanner measurements.
-
Citations
20 Claims
-
1. A navigational device for determining the position and heading of an object, comprising:
-
a navigation calculation device configured to calculate the position and the heading of the object based on an output of a velocity detecting device and an output of a yaw rate detecting device; and
an estimator configured to estimate, based on a carrier phase and a pseudorange received from a global positioning satellite, (1) an error of the velocity detecting device, (2) an error of the yaw rate detecting device, (3) a position error and a heading error of the object, and (4) an integer-valued bias of a carrier, wherein the navigation calculation device is configured to update the position and the heading of the object based on the position error and the heading error estimated by the estimator. - View Dependent Claims (2, 3, 4, 5, 6, 7)
-
-
8. A navigational method of determining a position and heading of an object, comprising:
-
calculating the position and the heading of the object based on an output of a velocity detecting device and an output of a yaw rate detecting device;
estimating, based on a carrier phase and a pseudorange received from a global positioning satellite, (1) an error of the velocity detecting device, (2) an error of the yaw rate detecting device, (3) a position error and a heading error of the object, and (4) an integer-valued bias of a carrier; and
updating the position and the heading of the object based on the estimated position error and the estimated heading error. - View Dependent Claims (9, 10, 11, 12, 13, 14)
-
-
15. A navigational system for determining a position and heading of a vehicle using inertial and satellite navigation, comprising:
-
a velocity detecting device configured to detect a velocity of the vehicle;
a yaw rate detecting device configured to detect a yaw rate of the vehicle;
a landmark database configured to store position data of a known landmark;
a range measuring device attached to the vehicle, the range measuring device configured to measure a range from the vehicle to the known landmark;
a navigation calculation device configured to calculate the position and the heading of the autonomous vehicle based on the velocity detected by the velocity detecting device and the yaw rate detected by the yaw rate detecting device; and
an estimator configured to estimate, based on a carrier phase and a pseudorange received from a global positioning satellite, (1) an error of the velocity detecting device, (2) an error of the yaw rate detecting device, (3) a position error and a heading error of the object, and (4) an integer-valued bias of a carrier, wherein the navigation calculation device is configured to update the position and the heading of the object based on the position error and the heading error estimated by the estimator. - View Dependent Claims (16, 17, 18, 19, 20)
-
Specification