MACHINE POSITIONING SYSTEM UTILIZING POSITION ERROR CHECKING

• US 20140180579A1
• Filed: 12/20/2012
• Published: 06/26/2014
• Est. Priority Date: 12/20/2012
• Status: Active Grant

• Current Assignee: Caterpillar Incorporated
• Original Assignee: Caterpillar Incorporated
• Inventors: FRIEND, Paul Russell, WILLIS, Frank Arthur, CHEN, Qi
• Granted Patent: US 9,234,758 B2
• Time in Patent Office: Days
• US Class Current: 701/469
• CPC Class Codes: E02F 9/264 Sensors and their calibration for indicating the position of the work tool
• CPC Class Codes: G01B 11/00 Measuring arrangements characterised by the use of optical techniques
• CPC Class Codes: G01C 21/1652 with ranging devices, e.g. LIDAR or RADAR
• CPC Class Codes: G01C 21/1656 with passive imaging devices, e.g. cameras
• CPC Class Codes: G01S 17/86 Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
• CPC Class Codes: G01S 17/89 for mapping or imaging
• CPC Class Codes: G01S 19/48 by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
• CPC Class Codes: G01S 19/49 whereby the further system is an inertial position system, e.g. loosely-coupled

Abstract

A system and method for estimating position of a machine is disclosed. The method may include receiving, from a perception sensor, scene data describing an environment in a vicinity of the machine and estimating a first position of the machine based on the scene data. The method may include determining whether a first signal indicative of a location of the machine is received by the machine and estimating a second position of the machine when it is determined that the first signal is received. The method may include comparing the second position with the first position and estimating a third position of the machine using at least one of the first position and the second position.

Claims

1. A method of estimating position of a machine, comprising:

receiving, from a perception sensor, scene data describing an environment in a vicinity of the machine;

estimating a first position of the machine based on the scene data;

determining whether a first signal indicative of a location of the machine is received by the machine;

estimating a second position of the machine when it is determined that the first signal is received;

comparing the second position and the first position; and

estimating a third position of the machine using at least one of the first position and the second position,

wherein estimating the third position is performed based on a result of the comparison between the second position and the first position.

2. The method of claim 1, wherein the first signal is a global positioning system signal.

3. The method of claim 1, wherein the scene data is generated by the perception sensor by scanning for physical objects in the vicinity of the machine.

4. The method of claim 1, further comprising estimating a fourth position of the machine, wherein:

the fourth position is estimated in a propagation stage of a Kalman filter;

the third position is estimated in a measurement update stage of the Kalman filter; and

the third position is estimated based on the fourth position and at least one of the first position and the second position.

5. The method of claim 1, wherein the third position is estimated using a combination of the first position and the second position when an uncertainty of the second position in comparison to an uncertainty of the first position is within a predetermined range.

6. The method of claim 1, wherein the third position is estimated using one of the first position and the second position based on uncertainties associated with the first position and the second position.

7. The method of claim 1, further comprising:

comparing the third position and the first position; and

declaring a fault with respect to the third position if the third position is not within a predetermined range of the first position.

8. A system for estimating position of a machine, comprising:

a perception sensor configured to generate scene data describing an environment in a vicinity of the machine;

a locating device configured to receive a first signal indicative of a location of the machine; and

a controller in communication with the perception sensor and the locating device, the controller configured to;

estimate a first position of the machine based on the scene data;

determine whether the first signal indicative of a location of the machine is received by the machine;

estimate a second position of the machine when it is determined that the first signal is received;

compare the second position with the first position; and

estimate a third position of the machine using at least one of the first position and the second position,

wherein the controller is configured to estimate the third position based on a result of the comparison between the second position and the first position.

9. The system of claim 8, wherein the first signal is a global positioning system signal.

10. The system of claim 8, wherein the perception sensor is configured to generate the scene data by scanning for physical objects in the vicinity of the machine.

11. The system of claim 8, wherein the controller is further configured to estimate a fourth position of the machine, wherein:

the fourth position is estimated in a propagation stage of a Kalman filter;

the third position is estimated in a measurement update stage of the Kalman filter; and

the third position is estimated based on the fourth position and at least one of the first position and the second position.

12. The system of claim 8, wherein the controller is configured to estimate the third position using a combination of the first position and the second position when an uncertainty of the second position in comparison to an uncertainty of the first position is within a predetermined range.

13. The system of claim 8, wherein the controller is configured to estimate the third position using one of the first position and the second position based on uncertainties associated with the first position and the second position.

14. The system of claim 8, wherein the controller is further configured to:

compare the third position and the first position; and

declare a fault with respect to the third position if the third position is not within a predetermined range of the first position.

15. A non-transitory computer-readable storage medium storing instructions for enabling a processor to execute a method of estimating position of a machine, the method comprising:

receiving, from a perception sensor, scene data describing an environment in a vicinity of the machine;

estimating a first position of the machine based on the scene data;

determining whether a first signal indicative of a location of the machine is received by the machine;

estimating a second position of the machine when it is determined that the first signal is received;

comparing the second position with the first position; and

estimating a third position of the machine using at least one of the first position and the second position,

wherein estimating the third position is performed based on a result of the comparison between the second position and the first position.

16. The non-transitory computer-readable storage medium of claim 15, wherein the first signal is a global positioning system signal.

17. The non-transitory computer-readable storage medium of claim 15, wherein the scene data is generated by the perception sensor by scanning for physical objects in the vicinity of the machine.

18. The non-transitory computer-readable storage medium of claim 15, wherein:

the method further comprises estimating a fourth position of the machine;

the fourth position is estimated in a propagation stage of a Kalman filter;

the third position is estimated in a measurement update stage of the Kalman filter; and

the third position is estimated based on the fourth position and at least one of the first position and the second position.

19. The non-transitory computer-readable storage medium of claim 15, wherein the third position is estimated using a combination of the first position and the second position when an uncertainty of the second position in comparison to an uncertainty of the first position is within a predetermined range.

20. The non-transitory computer-readable storage medium of claim 15, wherein the method further comprises:

comparing the third position and the first position; and

declaring a fault with respect to the third position if the third position is not within a predetermined range of the first position.