Control device for work vehicle configured to travel autonomously
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.
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.