The present invention relates to a control device for a work vehicle configured to travel autonomously along a target travel path.
Japanese Unexamined Patent Application Publication, Tokukai, No. 2002-182741 discloses an agricultural work vehicle configured to travel autonomously along a preset target travel path. The agricultural work vehicle includes a steering mechanism controllable such that a vehicle position calculated with use of a GPS moves to a target point set on a target travel path. The steering mechanism is controlled to, in a case involving a larger lateral separation distance between the target travel path and a front portion of the vehicle body, further reduce the distance between the front portion and the target point.
Japanese Unexamined Patent Application Publication, Tokukai, No. 2016-155491 discloses a work vehicle configured to compute a target steering amount from a positional deviation and directional deviation from a target travel path so that a steering drive signal is outputted based on the target steering amount. Specifically, the target steering amount is computed from a first steering value and a second steering value, the first steering value being computed based on a lateral positional deviation, the second steering value being computed based on a value obtained by adjusting, with use of a weighting factor, a computed value derived from a directional deviation, the weighting factor being intended to reduce the computed value further in a case involving a larger positional deviation.
The respective work vehicles of Japanese Unexamined Patent Application Publication, Tokukai, No. 2002-182741 and Japanese Unexamined Patent Application Publication, Tokukai, No. 2016-155491 are each controlled to be steered based on a steering angle calculated at the time of detection of a positional deviation from a target travel path to overcome the positional deviation. Thus, even if the vehicle body is moving toward a target travel path at the time of detection of a positional deviation, the work vehicle will be steered at a large steering angle if the positional deviation is large at that time. This will cause the work vehicle to be steered by an excessively large amount and to thereby be unstable in autonomous travel. Further, if the vehicle body is moving away from a target travel path at the time of detection of a positional deviation, the work vehicle will be steered at a small steering angle if the positional deviation is small at that time. This will cause the work vehicle to be steered by an excessively small amount and to thereby be unstable in autonomous travel.
The above circumstances have led to a demand for a control device for a work vehicle configured or programmed to travel autonomously which control device has been improved to be capable of, if the vehicle body has moved off a target travel path during autonomous travel, causing the vehicle body to return to the target travel path appropriately.
According to a preferred embodiment of the present invention, a control device for a work vehicle to travel autonomously along a target travel path includes 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 pat, a target steering amount calculator to calculate a target steering amount based on the deviation; and an autonomous travel controller to control steering of the work vehicle based on the target steering amount.
With the above arrangement, the control device, in order for the vehicle body to be steered autonomously along a target travel path, calculates not the current vehicle position but an estimated vehicle position and controls the steering of the vehicle body based on the estimated vehicle position, the estimated vehicle position being a vehicle position at which the work vehicle will be present after performing predetermined travel from the current vehicle position. The control device predicts a vehicle position to serve as a basis for steering control and thus prevents the vehicle body from being steered by an excessively small amount or an excessively large amount for appropriate autonomous travel.
A work vehicle may be deviated from its target travel path in the form of a lateral deviation. A lateral deviation refers to a positional deviation of the work vehicle in the direction orthogonal to the direction of its target travel path. Reducing the lateral deviation allows the work vehicle to travel accurately along the target travel path while performing work. A preferred embodiment of the present invention thus further includes 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 orthogonal to a direction of the target travel path, wherein the deviation calculator uses the estimated lateral deviation as the deviation of the work vehicle.
A work vehicle may be deviated from its target travel path in the form of a directional deviation. A directional deviation refers to an angular deviation of the travel direction of the work vehicle from the direction in which its target travel path extends. A work vehicle provided with a ground work device will be unable to perform appropriate ground work if the work vehicle has a large directional deviation. A preferred embodiment of the present invention thus further includes 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, wherein the deviation calculator uses the estimated directional deviation as the deviation of the work vehicle. Controlling the steering to reduce the lateral deviation will basically reduce the directional deviation as well, but can increase the directional deviation. The most suitable measure is to appropriately combine steering control for reduction of the directional deviation with steering control for reduction of the lateral deviation.
The vehicle position estimator can calculate an estimated vehicle position (that is, a vehicle position at which the work vehicle will be present after performing predetermined travel) based on the current vehicle position specifically by, as an example, calculating as the estimated vehicle position a position at which the work vehicle will be present after traveling in the current travel direction at a certain speed for a predetermined time length. A preferred embodiment of the present invention for such a calculation includes a vehicle speed calculator to calculate a vehicle speed of the work vehicle, wherein 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. The predetermined time length may be selectable by a user or selected automatically according to a work state of the work vehicle.
The vehicle position estimator can calculate an estimated vehicle position (that is, a vehicle position at which the work vehicle will be present after performing predetermined travel) based on the current vehicle position specifically by, as another example, calculating as the estimated vehicle position a position at which the work vehicle will be present after traveling in the current steering state at a certain speed for a predetermined time length. A preferred embodiment of the present invention for such a calculation includes a vehicle speed calculator to calculate a vehicle speed of the work vehicle, wherein 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. The predetermined time length may be selectable by a user or selected automatically according to a work state of the work vehicle.
The vehicle position estimator can calculate an estimated vehicle position (that is, a vehicle position at which the work vehicle will be present after performing predetermined travel) based on the current vehicle position specifically by, as another example, calculating as the estimated vehicle position a position spaced away from the current vehicle position over a predetermined distance on a line extending in the current travel direction. A preferred embodiment of the present invention for such a calculation is configured or programmed such that 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. The predetermined distance may be selectable by a user or selected automatically according to a work state of the work vehicle.
The vehicle position estimator can calculate an estimated vehicle position (that is, a vehicle position at which the work vehicle will be present after performing predetermined travel) based on the current vehicle position specifically by, as another example, calculating as the estimated vehicle position a position spaced away from the current vehicle position over a predetermined distance on an expected travel pathway based on the current steering state. A preferred embodiment of the present invention for such a calculation is configured or programmed such that 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. The predetermined distance may be selectable by a user or selected automatically according to a work state of the work vehicle.
The above and other elements, features, steps, characteristics and advantages of the present invention will become more apparent from the following detailed description of the preferred embodiments with reference to the attached drawings.
With reference to drawings, the description below deals with example work vehicles each including a control device according to preferred embodiments of the present invention and configured or programmed to travel autonomously along a target travel path.
The description below deals with a travel process during the tillage work. To start tillage work, the driver manually drives the tractor to position the vehicle body 1 at a starting point position Ts close to a ridge of the agricultural field, and then operates a manual operation tool 90 (see
After the teaching path TL has been set, the driver causes the tractor to perform 180-degree turn travel to move to the starting point position Ls(1) of the first target travel path LM(1), which is adjacent to the teaching path TL.
After the turn travel ends, and the vehicle body 1 has become directed suitably for subsequent tillage work, operating the manual operation tool 90 causes the path setting section 54 to set a target travel path LM(1). When the path setting section 54 sets a target travel path LM(1), the control device checks whether the manual operation tool 90 was operated at a position suitable for tillage work. Such a suitable position is typically away from the position at which the tractor suspended tillage work over a distance of an integral multiple of the work width. The control device, in other words, checks whether the vehicle body 1 has a travel deviation within an acceptable range. If the travel deviation is within the acceptable range, the vehicle body 1 resumes performing autonomous travel along the target travel path LM(1) set as a target. If the travel deviation is outside the acceptable range, the vehicle body 1 does not resume autonomous travel: the driver manually steers the tractor so that the travel deviation of the vehicle body 1 will be within the acceptable range.
After starting autonomous travel, the tractor steers itself autonomously so that the vehicle body 1 remains along the target travel path LM(1). The target travel path LM(1) is a target travel path along which the vehicle body 1 performs work travel first after teaching travel. When the autonomous travel along the target travel path LM(1) has ended, the driver drives the tractor along a turn travel path. Then, the tractor sets a subsequent target travel path LM(2) that is adjacent to the previous target travel path LM(1) on the side of an unworked region and that extends from a starting point position Ls(2). Through a similar process, the tractor repeats setting a target travel path and performing work travel in the order of target travel paths LM(3), LM(4), LM(5), and LM(6) extending from respective starting point positions Ls(3), Ls(4), Ls(5), and Ls(6) with turn travel in-between.
With reference to
The tractor includes a satellite positioning module 8a and an inertial positioning module 8b as included in the positioning unit 8. The satellite positioning module 8a has a satellite positioning function: it is capable of determining the position of the vehicle body 1 with use of a global positioning system (GPS), which is based on well-known art, as an example of a global navigation satellite system (GNSS) configured or programmed to receive a radio wave from a satellite and detect the position of the vehicle body 1. The present preferred embodiment uses a differential GPS for satellite positioning, but may alternatively use a different GPS such as a real-time kinematic GPS (RTK-GPS). The inertial positioning module 8b includes a triaxial gyro sensor and a triaxial acceleration sensor.
The inertial positioning module 8b includes, for example, a gyro sensor and an acceleration sensor, and is thus capable of detecting the angular velocity of a turn of the vehicle body 1 (see
The control device 5 includes an input-output processing section 50 as an input-output interface. The input-output processing section 50 is connected to, for example, a state detector group 70 and various manual operation tools 90. The functional block diagram shows that the above-described positioning unit 8 is connected to the control device 5 over an in-vehicle LAN. The notification unit 72 is connected to a liquid crystal display 48 as a notification device. The liquid crystal display 48 is configured or programmed to display various information items based on a notification signal transmitted from a notification control section 720 incorporated in the notification unit 72. The notification unit 72 is connected to the control device 5 over the in-vehicle LAN.
The state detector group 70 includes various sensors, switches, and the like such as a travel device state detector 74 and a work device state detector 75. The travel device state detector 74 includes travel state detecting sensors such as a vehicle speed sensor, a steering angle sensor, an engine rotation speed sensor, a brake pedal detecting sensor, and a parking brake detecting sensor (not illustrated in the drawings). The work device state detector 75 includes sensors to detect the respective states of various mechanisms included in the work device 30 (see
The manual operation tools 90 are a general name for tools such as a lever, a switch, a button, and a volume control. The manual operation tools 90 are each operable by the driver for transmission of a control command to the control device 5.
The control device 5 includes a vehicle position calculating section 80, a travel direction calculating section 81, a travel control section 51, a work control section 52, a teaching management section 53, a path setting section 54, a vehicle speed calculating section 55, a steering state obtaining section 56, and a steering amount computing unit 6.
The vehicle position calculating section 80 calculates the map coordinates of the vehicle body 1 (that is, the vehicle position) based on satellite positioning data transmitted sequentially from the positioning unit 8. During the calculation, the vehicle position calculating section 80 converts the position calculated directly from satellite positioning data into a benchmark point on the vehicle body 1 (for example, the position of the vehicle body center or work center of the work device 30). The travel direction calculating section 81 processes data on vehicle positions (calculated by the vehicle position calculating section 80) over time to calculate the travel direction of the vehicle body 1, that is, its front-back direction.
The travel control section 51 transmits a steering control signal to the steering motor 14 (see
The tractor is set to an autonomous travel mode to drive itself autonomously or a manual travel mode to be driven manually. These travel modes are managed by the travel mode management section 513. When the tractor is in the autonomous travel mode, the autonomous travel control section 511 receives autonomous steering data (that is, data on a target steering amount) from the steering amount computing unit 6.
The work control section 52 controls lifting and lowering of the work device 30 and transmission of power to the work device 30 while the vehicle body 1 is traveling.
The teaching management section 53 calculates data on a teaching path TL (such as map coordinates) based on the teaching travel described above. The path setting section 54 sets a target travel path as a target of autonomous travel (for the present preferred embodiment, a path for straight, autonomously steered travel) through the procedure described above with reference to
The vehicle speed calculating section 55 calculates the speed of the tractor based on a signal from a vehicle speed sensor or the amount of change of the vehicle position over time. The steering state obtaining section 56 obtains data on the steering state of the tractor (such as the steering angle) based on a signal from a steering sensor configured to detect the state of a steering device.
The steering amount computing unit 6 determines an estimated vehicle position, that is, a position at which the tractor will be present after performing predetermined travel from the current vehicle position. The steering amount calculating unit 6 then calculates a target steering amount based on a deviation(s) (namely, either or both of a positional deviation and a directional deviation) calculated based on the estimated vehicle position. The steering amount calculating unit 6 transmits data on the target steering amount to the autonomous travel control section 511.
The steering amount computing unit 6 includes a vehicle position estimating section 61, a deviation calculating section 62, and a target steering amount calculating section 63 as illustrated in
The vehicle position estimating section 61 calculates an estimated vehicle position by, for example, any of the methods described below with reference to
(1) Calculate, as an estimated vehicle position, the position (indicated as “P1” in
(2) Calculate, as an estimated vehicle position, the position (indicated as “P2” in
(3) Calculate, as an estimated vehicle position, the position (indicated as “P3” in
(4) Calculate, as an estimated vehicle position, the position (indicated as “P4” in
The vehicle position estimating section 61 calculates an estimated vehicle position by at least one of the estimated vehicle position calculating methods described above and any methods similar thereto. The vehicle position estimating section 61 may use a plurality of estimated vehicle position calculating methods so that one of the estimated vehicle positions calculated is selected by a person or automatically according to the work state of the tractor. Further, the above predetermined distance and predetermined time length for use in the calculation by the vehicle position estimating section 61 may be selected by a person, automatically without a condition, or automatically according to the work state of the tractor. The vehicle position estimating section 61 also calculates an estimated travel direction, that is, the travel direction of the vehicle body 1 at the estimated vehicle position.
The deviation calculating section 62 calculates (i) an estimated lateral deviation, that is, the lateral deviation of the vehicle body 1 at the estimated vehicle position calculated, and (ii) an estimated directional deviation, that is, the directional deviation of the vehicle body 1 at the estimated vehicle position. An estimated lateral deviation refers to the distance in the direction orthogonal to the direction of the target travel path between the benchmark point on the vehicle body 1 at the estimated vehicle position and a target travel path. An estimated directional deviation refers to the angle defined by the estimated travel direction and the target travel path.
The deviation calculating section 62 for the present preferred embodiment includes an estimated lateral deviation calculating section 621, an estimated directional deviation calculating section 622, and a computing element 623. The estimated lateral deviation calculating section 621 calculates an estimated lateral deviation.
The computing element 623 receives, as input parameters, data on an estimated lateral deviation calculated by the estimated lateral deviation calculating section 621 and data on an estimated directional deviation calculated by the estimated directional deviation calculating section 622. The computing element 623 then, for example, weights the input parameters and outputs the resulting deviation data. The deviation calculating section 62 may alternatively include only either the estimated lateral deviation calculating section 621 or the estimated directional deviation calculating section 622. Further alternatively, the estimated lateral deviation calculating section 621 and the estimated directional deviation calculating section 622 may be used selectively.
The deviation data outputted by the deviation calculating section 62 is received by the target steering amount calculating section 63 as an input parameter. The target steering amount calculating section 63 may alternatively receive, instead of the deviation data outputted by the deviation calculating section 62, the data on an estimated lateral deviation and the data on an estimated directional deviation as input parameters. The target steering amount calculating section 63 may be in the form of, for example, a PI controller or PID controller.
(1) The preferred embodiments described above use front wheels 11 to steer a vehicle body and a steering motor 14 as a steering device. If a preferred embodiment of the present invention instead uses crawler-type travel devices as a steering system, the autonomous travel control section 511 will control devices configured or programmed to change the respective speeds of the left and right crawlers.
(2) The preferred embodiments described above involve linear target travel paths. The target travel paths may alternatively each extend in a curve with a large radius of curvature.
(3) The preferred embodiments described above is configured or programmed such that the driver performs teaching travel first and that the path setting section 54 then sets target travel paths based on a teaching path calculated as a result of the teaching travel. A preferred embodiment may alternatively be configured or programmed such that the driver does not perform teaching travel and that the path setting section 54 generates and sets all target travel paths automatically based on, for example, the shape of the agricultural field.
(4) The functional sections shown in
(5) The control device 5 is not necessarily provided for the vehicle body 1; part or all of the control device 5 may alternatively be present outside the vehicle body 1 in such a state as to be capable of data communication with the vehicle body 1. A preferred embodiment described above may alternatively be configured or programmed, for instance, such that the control device 5 is mounted on a communication terminal or management computer and that the communication terminal or management computer transmits and receives necessary information to and from the vehicle body 1.
(6) The control device 5 may have any configuration as long as it allows functions and processes similar to those described above to be performed. The functions and processes may be achieved by hardware or software. If the functions and processes are to be achieved by software, the programs are stored in a storage section and executed by a processor such as a CPU or an ECU included in, for example, the control device 5.
(7) The preferred embodiments described above of the present invention are tractors each provided with a control device according to a preferred embodiment of the present invention. The control device may alternatively be mounted on other agricultural field work vehicles such as combines and rice transplanters for preferable performance of autonomous travel.
Preferred embodiments of the present invention are applicable to any agricultural field work vehicle configured or programmed to travel autonomously along a target travel path in an agricultural field.
While preferred embodiments of the present invention have been described above, it is to be understood that variations and modifications will be apparent to those skilled in the art without departing from the scope and spirit of the present invention. The scope of the present invention, therefore, is to be determined solely by the following claims.
Number | Date | Country | Kind |
---|---|---|---|
2018-238895 | Dec 2018 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2019/048044 | 12/9/2019 | WO | 00 |