IP Library Granted Patent US 11,835,643
Granted Patent B2
US 11,835,643 · App. 16/982,775 · Granted Dec 5, 2023

Work machine control system, work machine, and work machine control method

Inventors: Daisuke Tanaka (Tokyo, JP); Tatsuya Shiga (Tokyo, JP)
Assignee: Komatsu Ltd.
G01S7/40G01S13/86G01S13/931G01S19/46G01S2013/932
View Patent ↗
Loading inventors, assignments & file history…
Monitor This Case
Get email alerts when status or documents change.
Order Certified Copies
Most orders are placed with the USPTO same day — all within 24 business hours.
Order via The Patent Place →
Pre-filled with this patent's details
Quick Facts
Patent No.
US 11,835,643
App. No.
16/982,775
Granted
Dec 5, 2023
Kind
B2
Abstract

A work machine control method includes: acquiring a detection position of a landmark detected by a non-contact sensor provided in a work machine in traveling of the work machine traveling on a traveling path; calculating a first relative distance between the non-contact sensor and the landmark on a basis of the detection position of the landmark; calculating a second relative distance between the non-contact sensor and the landmark on a basis of a registration position of the landmark; calculating a correction value relating to a relative distance between the non-contact sensor and the landmark on a basis of the first relative distance and the second relative distance; correcting the first relative distance on a basis of the correction value to calculate a corrected relative distance between the non-contact sensor and the landmark; and controlling a traveling state of the work machine on a basis of the corrected relative distance.

Claims (45)

1. A work machine control system comprising:

a non-contact sensor which is provided on a work machine and detects a position of a landmark;

a landmark detection position acquisition unit which acquires a detection position of the landmark detected by the non-contact sensor in traveling of the work machine;

a landmark registration position storage unit which stores a registration position of the landmark;

a first relative distance calculation unit which calculates a first relative distance between the non-contact sensor and the landmark on a basis of the detection position of the landmark;

a second relative distance calculation unit which calculates a second relative distance between the non-contact sensor and the landmark on a basis of the registration position of the landmark;

a correction value calculation unit which calculates a correction value relating to a relative distance between the non-contact sensor and the landmark on a basis of the first relative distance and the second relative distance; and

a landmark correction position calculation unit which corrects the first relative distance on a basis of the correction value and calculates a corrected relative distance between the non-contact sensor and the landmark.

2. The work machine control system according to claim 1 , comprising:

a position sensor which detects a position of the work machine traveling on a traveling path; and

a work machine detection position acquisition unit which acquires a detection position of the work machine detected by the position sensor in the traveling of the work machine, wherein

the second relative distance calculation unit calculates the second relative distance on a basis of the detection position of the work machine and the registration position of the landmark.

3. The work machine control system according to claim 1 , comprising:

a traveling control device which controls a traveling state of the work machine on a basis of the corrected relative distance.

4. The work machine control system according to claim 3 , wherein

the traveling control device corrects an estimated position of the work machine traveling by dead reckoning on the basis of the corrected relative distance.

5. The work machine control system according to claim 1 , wherein

the non-contact sensor detects an object including the landmark ahead of the work machine in a traveling direction, the work machine control system comprising:

a filter unit which outputs detection data satisfying a defined condition from detection data of the non-contact sensor to the landmark detection position acquisition unit,

the landmark detection position acquisition unit acquires the detection data satisfying the defined condition as the detection position of the landmark.

6. The work machine control system according to claim 5 , wherein

the non-contact sensor detects a reflection intensity of the object in the traveling of the work machine, and

the defined condition includes that the reflection intensity is equal to or greater than a reflection intensity threshold.

7. The work machine control system according to claim 5 , wherein

the non-contact sensor detects an absolute speed of the object in the traveling of the work machine, and

the defined condition includes that the absolute speed is less than an absolute speed threshold.

8. The work machine control system according to claim 5 , wherein

the non-contact sensor detects a position of the object in the traveling of the work machine, and

the defined condition includes that a deviation between a detection position of the object and the registration position of the landmark is less than a deviation threshold.

9. The work machine control system according to claim 5 , comprising:

a speed sensor which detects a traveling speed of the work machine in the traveling of the work machine, wherein

the non-contact sensor detects the object in the traveling of the work machine, and

the defined condition includes that the traveling speed of the work machine is less than a traveling speed threshold.

10. The work machine control system according to claim 5 , comprising:

a posture sensor which detects a posture angle of the work machine in the traveling of the work machine, wherein

the non-contact sensor detects the object in the traveling of the work machine, and

the defined condition includes that the posture angle is less than an angle threshold.

11. A work machine comprising: the work machine control system according to claim 1 .

12. A work machine control method comprising:

acquiring a detection position of a landmark detected by a non-contact sensor provided in a work machine in traveling of the work machine traveling on a traveling path;

calculating a first relative distance between the non-contact sensor and the landmark on a basis of the detection position of the landmark;

calculating a second relative distance between the non-contact sensor and the landmark on a basis of a registration position of the landmark;

calculating a correction value relating to a relative distance between the non-contact sensor and the landmark on a basis of the first relative distance and the second relative distance;

correcting the first relative distance on a basis of the correction value to calculate a corrected relative distance between the non-contact sensor and the landmark; and

controlling a traveling state of the work machine on a basis of the corrected relative distance.

Assignments (1)
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded Sep 21, 2020
From: TANAKA, DAISUKE; SHIGA, TATSUYA
To: KOMATSU LTD.
Reel/Frame 053838/0704 →
Priority Claims (1)
JP 2018-144523 · Jul 31, 2018 · national
Continuity (1)
Related Publication 20210011122A1 · Jan 14, 2021