IP Library › Granted Patent US 10,767,341
Granted Patent B2
US 10,767,341 · App. 15/579,982 · Granted Sep 8, 2020

Control system for work vehicle, and method for setting trajectory of work implement

Inventor: Kazuhiro Hashimoto (Tokyo, JP)
Assignee: KOMATSU LTD.
E02F3/43E02F3/815E02F3/84E02F9/20G05D1/0274G05D2201/0202
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 10,767,341
App. No.
15/579,982
Granted
Sep 8, 2020
Kind
B2
Abstract

A control system includes a controller. The controller acquires current terrain data that indicates the current terrain to be worked. The controller decides on a target design terrain that is displaced vertically from the current terrain by referring to target displacement data. The target displacement data indicates the target displacement of a work implement according to the amount of movement from a work start position. The controller generates a command signal to move the work implement toward the target design terrain.

Claims (91)

1. A control system for a work vehicle including a work implement, the control system comprising:

a controller programmed to

acquire current terrain data indicating current terrain to be worked,

decide a target design terrain displaced vertically from the current terrain by referring to target displacement data indicating target displacement of the work implement according to an amount of movement from a work start position, and

generate a command signal to move the work implement toward the target design terrain.

2. The control system for a work vehicle according to claim 1 , wherein

the target displacement data includes a first region and a second region,

the first region is a region that begins when the amount of movement is smaller than in the second region, and

in the first region, the target displacement is defined to be greater than in the second region.

3. The control system for a work vehicle according to claim 2 , wherein

the target displacement data includes a transitional region located between the first region and the second region, and

in the transitional region, the target displacement is defined to decrease gradually according to increase in the amount of movement.

4. The control system for a work vehicle according to claim 2 , wherein

the target displacement data includes a digging start region located between the first region and a digging start position, and

in the digging start region, the target displacement is defined to increase gradually according to increase in the amount of movement.

5. The control system for a work vehicle according to claim 2 , wherein

the target displacement is constant at a first target value in the first region, and

the target displacement is constant at a second target value in the second region, with the second target value being less than the first target value.

6. The control system for a work vehicle according to claim 2 , wherein

with the target displacement data, the first region ends when the amount of movement is a first end value, and

the controller is further programmed to

acquire a current held soil volume of the work implement,

acquire the amount of movement of the work vehicle at a point when the current held soil volume exceeds a specific threshold, as an updated value for the first end value, and

update the first end value to the updated value when the updated value is less than a current value of the first end value.

7. The control system for a work vehicle according to claim 1 , wherein

the controller is further programmed to

acquire a current held soil volume of the work implement,

determine whether the current held soil volume is greater than a specific threshold, and

update the target displacement data based on a result of determining whether the current held soil volume is greater than the specific threshold.

8. The control system for a work vehicle according to claim 1 , wherein

the controller is further programmed to

accept a control mode selected from a plurality of control modes, and

change the target displacement according to the selected control mode.

9. The control system for a work vehicle according to claim 1 , wherein

the controller is further programmed to

perform smoothing of the current terrain, and

decide the target design terrain displaced vertically by the target displacement from the smoothed current terrain.

10. The control system for a work vehicle according to claim 1 , wherein

the work implement includes a blade, and

the amount of movement from the work start position is an amount of movement of the blade.

11. A method for setting a trajectory of a work implement of a work vehicle, the method comprising:

acquiring current terrain data indicating current terrain to be worked;

deciding a target design terrain displaced vertically from the current terrain by referring to target displacement data indicating target displacement of the work implement according to an amount of movement from a work start position;

setting the target design terrain as the trajectory of the work implement and

generating a command signal to move the work implement toward the target design terrain.

12. The method for setting the trajectory of a work implement according to claim 11 , wherein

the target displacement data includes a first region and a second region,

the first region is a region that begins when the amount of movement is smaller than in the second region, and

in the first region, the target displacement is defined to be greater than in the second region.

13. The method for setting the trajectory of a work implement according to claim 12 , wherein

the target displacement data includes a transitional region located between the first region and the second region, and

in the transitional region, the target displacement is defined to decrease gradually according to increase in the amount of movement.

14. The method for setting the trajectory of a work implement according to claim 11 , further comprising:

acquiring a current held soil volume of the work implement,

determining whether the current held soil volume is greater than a specific threshold, and

updating the target displacement data based on a result of determining whether the current held soil volume is greater than the specific threshold.

15. The method for setting the trajectory of a work implement according to claim 11 , further comprising:

accepting a control mode selected from a plurality of control modes, and

changing the target displacement according to the selected control mode.

16. The method for setting the trajectory of a work implement according to claim 11 , further comprising:

performing smoothing of the current terrain; and

deciding the target design terrain displaced vertically by the target displacement from the smoothed current terrain.

17. A control system for a work vehicle including a work implement, the control system comprising:

a controller programmed to

acquire current terrain data indicating current terrain to be worked,

decide a target design terrain displaced vertically from the current terrain by referring to a target load parameter that defines relation between an amount of movement from a work start position and a target load parameter that defines a load on the work implement, and

generate a command signal to move the work implement toward the target design terrain.

18. The control system for a work vehicle according to claim 17 , wherein

the target design terrain is displaced vertically with respect to the current terrain, and

the controller is further programmed to decide a target displacement between the current terrain and the target design terrain according to a magnitude of the target load parameter.

19. The control system for a work vehicle according to claim 17 , wherein

the target load parameter indicates a target soil volume of the work implement.

20. The control system for a work vehicle according to claim 17 , wherein

the target design terrain is displaced vertically with respect to the current terrain, and

the target load parameter indicates the target displacement between the current terrain and the target design terrain.

21. The control system for a work vehicle according to claim 17 , wherein

the target load parameter includes a first region and a second region,

the first region is a region that begins when the amount of movement is smaller than in the second region, and

in the first region, the target load parameter is defined to be greater than in the second region.

22. The control system for a work vehicle according to claim 21 , wherein

the target load parameter includes a transitional region located between the first region and the second region, and

in the transitional region, the target load parameter is defined to decrease gradually according to increase in the amount of movement.

23. The control system for a work vehicle according to claim 17 , wherein

the controller is further programmed to

acquire a current held soil volume of the work implement,

determine whether the current held soil volume is greater than a specific threshold, and

update the target load parameter data based on a result of determining whether the current held soil volume is greater than the specific threshold.

24. The control system for a work vehicle according to claim 17 , wherein

the controller is further programmed to

accept a control mode selected from a plurality of control modes, and

change the target load parameter according to the selected control mode.

Assignments (1)
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded Dec 6, 2017
From: HASHIMOTO, KAZUHIRO
To: KOMATSU LTD.
Reel/Frame 044311/0266 →
Continuity (1)
Related Publication 20190218745A1 · Jul 18, 2019
Cited By (2)
US 12,203,243 US 12,523,004