Control device for work vehicle configured to travel autonomously

Patent metadata

Field	Value
Publication number	US-11937526-B2
Application number	US-201917297526-A
Country	US
Kind code	B2
Filing date	Dec 9, 2019
Priority date	Dec 20, 2018
Publication date	Mar 26, 2024
Grant date	Mar 26, 2024

Abstract

A control device for a work vehicle configured or programmed to travel autonomously includes a vehicle position calculator to calculate a vehicle position, a travel direction calculator to calculate a travel direction that is a front-back direction of the vehicle body, a steering state detector to obtain data on a steering state, a vehicle position estimator to calculate an estimated vehicle position at which the work vehicle is to be present after performing predetermined travel from the vehicle position of the work vehicle, a deviation calculator to calculate a deviation of the work vehicle at the estimated vehicle position from the target travel path, a target steering amount calculator to calculate a target steering amount based on the deviation, and an autonomous travel controller to control steering based on the target steering amount.

First claim

The invention claimed is:

1. A control device for a work vehicle configured to travel autonomously along a target travel path, the control device comprising:
a processor configured or programmed to define and function as:
a vehicle position calculator to calculate a vehicle position of the work vehicle;
a travel direction calculator to calculate a travel direction of the work vehicle, the travel direction being a front-back direction of a vehicle body of the work vehicle;
a steering state detector to obtain data on a steering state of the work vehicle;
a vehicle position estimator to calculate an estimated vehicle position at which the work vehicle is to be present after performing predetermined travel from the vehicle position of the work vehicle;
a deviation calculator to calculate a deviation of the work vehicle at the estimated vehicle position from the target travel path;
an estimated lateral deviation calculator to calculate an estimated lateral deviation, the estimated lateral deviation being a distance between the estimated vehicle position and the target travel path in a direction perpendicular or substantially perpendicular to a direction of the target travel path;
an estimated directional deviation calculator to calculate an estimated directional deviation, the estimated directional deviation being an angle defined by an estimated travel direction of the work vehicle at the estimated vehicle position and the target travel path;
a target steering amount calculator to calculate a target steering amount based on the estimated lateral deviation and the estimated directional deviation; and
an autonomous travel controller to control steering of the work vehicle based on the target steering amount.

2. The control device according to claim 1 , wherein
the processor is configured or programmed to define and functions as a vehicle speed calculator to calculate a vehicle speed of the work vehicle; and
the vehicle position estimator calculates, as the estimated vehicle position, a position at which the work vehicle is to be present after traveling at the vehicle speed for a predetermined time length in the travel direction calculated by the travel direction calculator.

3. The control device according to claim 1 , wherein
the processor is configured or programmed to define and function as a vehicle speed calculator to calculate a vehicle speed of the work vehicle; and
the vehicle position estimator calculates, as the estimated vehicle position, a position at which the work vehicle is to be present after traveling at the vehicle speed in the steering state for a predetermined time length.

4. The control device according to claim 2 , wherein
the predetermined time length is selectable by a user.

5. The control device according to claim 2 , wherein
the predetermined time length is selected automatically according to a work state of the work vehicle.

6. The control device according to claim 1 , wherein the vehicle position estimator calculates, as the estimated vehicle position, a position at which the work vehicle is to be present after traveling over a predetermined distance in the travel direction calculated by the travel direction calculator.

7. The control device according to claim 1 , wherein the vehicle position estimator calculates, as the estimated vehicle position, a position at which the work vehicle is to be present after traveling over a predetermined distance in the steering state.

8. The control device according to claim 6 , wherein the predetermined distance is selectable by a user.

9. The control device according to claim 6 , wherein the predetermined distance is selected automatically according to a work state of the work vehicle.

Assignees

• Kubota Kk

Inventors

• Suga Hiroki
• Miyashita Shunsuke

Classifications

• A01B69/008 Primary

  automatic · CPC title

• A01D41/1278

  for automatic steering · CPC title

• G05D1/0219

  ensuring the processing of the whole working surface · CPC title

• G05D1/0223

  involving speed control of the vehicle (vehicle fittings for automatically controlling, i.e. preventing speed from exceeding an arbitrarily established velocity or maintaining speed at a particular velocity, as selected by the vehicle operator B60K31/00) · CPC title

• G05D1/0278

  using satellite positioning signals, e.g. GPS · CPC title