IP Library › Granted Patent US 10,604,912
Granted Patent B2
US 10,604,912 · App. 15/658,922 · Granted Mar 31, 2020

Control system for work vehicle, control method, and work vehicle

Inventors: Kazuhiro Hashimoto (Hirakata, JP); Kenjiro Shimada (Hirakata, JP); Kota Beppu (Hiratsuka, JP)
Assignee: KOMATSU LTD.
E02F9/205E02F3/847E02F9/262G05D1/0274G01C15/002G05D3/12G05D2201/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,604,912
App. No.
15/658,922
Granted
Mar 31, 2020
Kind
B2
Abstract

A current terrain acquisition device acquires current terrain information indicating a current terrain to be worked. A controller is configured to generate an inclined virtual surface extending from a current position of the work vehicle. The controller is configured to decide an estimated held soil volume of a work implement of the work vehicle when the work implement is moved along the virtual surface in the current terrain. The controller is configured to decide whether the estimated held soil volume has reached a predetermined held soil volume threshold. The controller is configured to set the virtual surface extending from the current position of the work vehicle when the estimated held soil volume has reached the held soil volume threshold as a first virtual design surface, and generate a command signal to the work implement to move the work implement along the virtual design surface.

Claims (79)

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

a current terrain acquisition device that acquires current terrain information indicating a current terrain to be worked; and

a controller configured to

generate an inclined virtual surface extending from a current cutting edge position of the work vehicle,

decide an estimated held soil volume of a work implement of the work vehicle when the work implement is moved along the virtual surface in the current terrain,

decide whether the estimated held soil volume reaches a predetermined held soil volume threshold, and

set the virtual surface extending from the current cutting edge position of the work vehicle when the estimated held soil volume reaches the held soil volume threshold as a first virtual design surface, and generate a command signal to the work implement to move the work implement along the first virtual design surface,

the held soil volume threshold when the current terrain is an uphill slope being different from the held soil volume threshold when the current terrain is a downhill slope, and when the current terrain is an uphill slope, the controller being configured to generate a command signal to the work implement to move the work implement along the first virtual design surface extending from the current cutting edge position of the work vehicle when the estimated held soil volume becomes greater than a first held soil volume threshold.

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

when the current terrain is a downhill slope, the controller is configured to generate a command signal to the work implement to move the work implement along the first virtual design surface extending from the current cutting edge position of the work vehicle when the estimated held soil volume become less than a second held soil volume threshold.

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

the controller is further configured to

determine from the current terrain information whether there is an undulation in the current terrain, and

calculate an inclination angle of the first virtual design surface when a starting condition is satisfied, the starting condition including that the current terrain is determined to have an undulation.

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

the controller is further configured to

decide a soil volume of the current terrain based on a height of the current cutting edge position of the work vehicle, and

determine that there is an undulation in the current terrain when the soil volume of the current terrain is equal to or greater than a predetermined undulation determination threshold.

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

the starting condition further includes that the controller receives a signal to move the work vehicle forward.

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

the controller is configured to

decide a current held soil volume of the work implement, and

end control of the work implement by the first virtual design surface when an ending condition is satisfied, the ending condition including that the current held soil volume is greater than a predetermined ending determination threshold.

7. A control system for a work vehicle, the system comprising:

a current terrain acquisition device that acquires current terrain information indicating a current terrain to be worked; and

a controller configured to

generate an inclined virtual surface extending from a current cutting edge position of the work vehicle,

decide an estimated held soil volume of a work implement of the work vehicle when the work implement is moved along the virtual surface in the current terrain,

decide whether the estimated held soil volume reaches a predetermined held soil volume threshold, and

set the virtual surface extending from the current cutting edge position of the work vehicle when the estimated held soil volume reaches the held soil volume threshold as a first virtual design surface, and generate a command signal to the work implement to move the work implement along the first virtual design surface,

the controller being further configured to

decide a current held soil volume of the work implement,

end control of the work implement by the first virtual design surface when an ending condition is satisfied, the ending condition including that the current held soil volume is greater than a predetermined ending determination threshold,

decide a second virtual design surface that follows along the current terrain, when the ending condition is satisfied, and

generate a command signal to the work implement to move the work implement along the second virtual design surface that follows the current terrain.

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

the second virtual design surface is a surface which is moved downward a specific amount from a terrain obtained by smoothing the height of the current terrain.

9. A method for controlling a work vehicle, the method comprising:

acquiring current terrain information indicating a current terrain to be worked;

acquiring a current cutting edge position of the work vehicle;

generating an inclined virtual surface extending from the current cutting edge position of the work vehicle;

deciding an estimated held soil volume of a work implement of the work vehicle when the work implement is moved along the virtual surface;

repeatedly generating the virtual surface and deciding the estimated held soil volume while moving the work vehicle, and determining whether the estimated held soil volume reaches a predetermined held soil volume threshold; and

setting the virtual surface at a position of the work vehicle when the estimated held soil volume reaches the held soil volume threshold as a virtual design surface and starting movement of the work implement along the virtual design surface,

the held soil volume threshold when the current terrain is an uphill slope being different from the held soil volume threshold when the current terrain is a downhill slope, and when the current terrain is an uphill slope, the controller being configured to generate a command signal to the work implement to move the work implement along the first virtual design surface extending from the current cutting edge position of the work vehicle when the estimated held soil volume becomes greater than a first held soil volume threshold.

10. A work vehicle comprising:

a work implement; and

a controller configured to

decide an inclined virtual surface extending from a current cutting edge position of the work vehicle,

decide an estimated held soil volume of the work implement when the work implement is moved along the virtual surface in a current terrain to be worked, and

set the virtual surface extending from the current cutting edge position of the work vehicle when the estimated held soil volume reaches a predetermined held soil volume threshold as a virtual design surface and move the work implement along the virtual design surface,

the held soil volume threshold when the current terrain is an uphill slope being different from the held soil volume threshold when the current terrain is a downhill slope, and when the current terrain is an uphill slope, the controller being configured to generate a command signal to the work implement to move the work implement along the virtual design surface extending from the current cutting edge position of the work vehicle when the estimated held soil volume becomes greater than a first held soil volume threshold.

11. The work vehicle according to claim 10 , wherein

the current terrain to be worked is a terrain of a region that follows along a travel direction of the work vehicle from the current cutting edge position of the work vehicle.

12. The work vehicle according to claim 10 , further comprising

a position sensing device that senses a position and a travel direction of the work vehicle and outputs position information and travel direction information about the work vehicle to the controller,

the current terrain is decided based on the position information and the travel direction information.

13. A method for controlling a work vehicle, the method comprising:

acquiring current terrain information indicating a current terrain to be worked;

acquiring a current cutting edge position of the work vehicle;

generating an inclined virtual surface extending from the current cutting edge position of the work vehicle;

deciding an estimated held soil volume of a work implement of the work vehicle when the work implement is moved along the virtual surface;

repeatedly generating the virtual surface and deciding the estimated held soil volume while moving the work vehicle, and determining whether the estimated held soil volume reaches a predetermined held soil volume threshold;

setting the virtual surface at a position of the work vehicle when the estimated held soil volume reaches the held soil volume threshold as a virtual design surface and starting movement of the work implement along the virtual design surface;

deciding a current held soil volume of the work implement,

ending control of the work implement by the first virtual design surface when an ending condition is satisfied, the ending condition including that the current held soil volume is greater than a predetermined ending determination threshold,

deciding a second virtual design surface that follows along the current terrain, when the ending condition is satisfied, and

generating a command signal to the work implement to move the work implement along the second virtual design surface that follows the current terrain.

14. A work vehicle comprising:

a work implement; and

a controller configured to

decide an inclined virtual surface extending from a current cutting edge position of the work vehicle,

decide an estimated held soil volume of the work implement when the work implement is moved along the virtual surface in a current terrain to be worked,

set the virtual surface extending from the current cutting edge position of the work vehicle when the estimated held soil volume reaches a predetermined held soil volume threshold as a virtual design surface and move the work implement along the virtual design surface,

decide a current held soil volume of the work implement,

end control of the work implement by the first virtual design surface when an ending condition is satisfied, the ending condition including that the current held soil volume is greater than a predetermined ending determination threshold,

decide a second virtual design surface that follows along the current terrain, when the ending condition is satisfied, and

generate a command signal to the work implement to move the work implement along the second virtual design surface that follows the current terrain.

Assignments (1)
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded Jul 26, 2017
From: HASHIMOTO, KAZUHIRO; SHIMADA, KENJIRO; BEPPU, KOTA
To: KOMATSU LTD.
Reel/Frame 043102/0928 →
Priority Claims (1)
JP 2016-152265 · Aug 2, 2016 · national
Continuity (1)
Related Publication 20180038070A1 · Feb 8, 2018
Cited By (1)
US 12,523,004