The present invention relates to an agricultural field work vehicle capable of traveling autonomously along a target travel path.
An agricultural field work vehicle configured to travel autonomously along a target travel path may be required to suspend work for any of various reasons and to move off the target travel path. An agricultural field work vehicle is required to move off a target travel path while performing work for lack of fuel or due to a limit on the work capacity (such as a limit on the harvest capacity or addition of an agent to be supplied to the agricultural field). The agricultural field work vehicle moves to a particular place to overcome a circumstance that required the agricultural field work vehicle to move off the target travel path, and then returns to the position at which the agricultural field work vehicle moved off the target travel path. At that position, the agricultural field work vehicle resumes performing work during autonomous travel.
Japanese Unexamined Patent Application Publication, Tokukai, No. 2018-116613 discloses a work vehicle configured to, when the work vehicle suspends work travel, record suspension information on the work travel that was suspended. When the work vehicle resumes the work travel that was suspended, a monitor displays the position at which the work vehicle suspended the work travel (which position is recorded in the suspension information) as a work resumption position together with a travel path set for the agricultural field. The work resumption position, which is indicated in resumption information, is either a point at which the work vehicle suspended the previous work travel or an end of a linear portion of the travel path extending through the point.
The work vehicle disclosed in Japanese Unexamined Patent Application Publication, Tokukai, No. 2018-116613 is, when resuming work travel after suspending it and moving off a travel path, manually driven to a work resumption position displayed on the monitor, and the work vehicle starts autonomous travel at the work resumption position. The work vehicle will, however, not start autonomous travel even when it has come to a position near the work resumption position if the controller of the work vehicle fails at that position to detect the travel path as a target for autonomous travel. Further, even if the controller has detected the target travel path, and the work vehicle is to resume autonomous travel, the work vehicle may, depending on the positional relationship between the travel path and the work vehicle, be steered by a large amount when resuming autonomous travel, which may damage the agricultural field.
Preferred embodiments of the present invention provide agricultural field work vehicles each capable of, after suspending agricultural field work during autonomous travel and moving off a target travel path, resuming autonomous travel smoothly at a desired work resumption position.
An agricultural field work vehicle according to a preferred embodiment of the present invention includes a vehicle position calculator to calculate, as a vehicle position, a position of a vehicle body of the agricultural field work vehicle in an agricultural field, an autonomous travel controller to steer the vehicle body so that the vehicle body travels autonomously along a target travel path, a move-off recorder to record, as move-off information, either or both of a move-off position and a move-off travel path, the move-off information being information related to the vehicle body having moved off the target travel path while performing agricultural field work during autonomous travel, the move-off position being the vehicle position at a time when the vehicle body moved off the target travel path, the move-off travel path being the target travel path off which the vehicle body moved, and a work return manager to (i) select a resumption travel path based on the move-off information, the resumption travel path being the target travel path on which the agricultural field work vehicle, after the vehicle body moved off the target travel path, resumes performing the agricultural field work during the autonomous travel, and (ii) manage a return of the vehicle body to the resumption travel path or a return of the vehicle body to the move-off position, wherein the work return manager includes a determiner to determine, while the agricultural field work vehicle is being manually driven for the vehicle body to return to the resumption travel path, whether the agricultural field work vehicle is able to transition from manual travel to autonomous travel.
With the above arrangement, if the agricultural field work vehicle has moved off a target travel path for refueling or rest of the driver or other reason, the agricultural field work vehicle records either or both of the move-off position and the move-off travel path as move-off information. When resuming the agricultural field work, the agricultural field work vehicle selects, based on the move-off information, an initial target travel path (resumption travel path) on which the agricultural field work vehicle will resume traveling autonomously. When the agricultural field work vehicle has been driven manually to a position near the selected target travel path, the determiner determines whether the agricultural field work vehicle is able to transition smoothly from manual travel to autonomous travel. The determiner determines, for instance, whether the autonomous travel controller has located the resumption travel path and/or whether the agricultural field work vehicle will be able to travel autonomously along the resumption travel path without a steering operation so large as to damage the agricultural field. Thus, if the determiner has determined that the agricultural field work vehicle will be able to travel autonomously, the agricultural field work vehicle will transition smoothly from manual travel to autonomous travel.
A preferred embodiment of the present invention further includes a manual operation tool to start autonomous travel by the vehicle body, wherein after the determiner has determined that the agricultural field work vehicle is able to perform the transition, the manual operation tool is operated to cause the autonomous travel controller to start the autonomous travel by the vehicle body. This preferred embodiment is configured or programmed to transition from manual travel to autonomous travel under a transition condition of whether the determiner has determined that the agricultural field work vehicle is able to transition to autonomous travel and a transition condition of whether the manual operation tool has been operated. As a result, the determiner ensures smooth transition. If the driver performs a manual operation for a command to transition from manual travel to autonomous travel, it will not cause the agricultural field work vehicle to damage the agricultural field. Further, since a person such as the driver causes the agricultural field work vehicle to start traveling autonomously, the driver will not be surprised by a sudden start of autonomous travel.
A preferred embodiment of the present invention is further configured or programmed such that in a case where the determiner has determined that the agricultural field work vehicle is able to perform the transition, the determiner transmits to a notifier a notification command to notify a driver that the transition is allowable. This preferred embodiment is configured or programmed to, if the determiner has determined that the agricultural field work vehicle is able to transition from manual travel to autonomous travel, notify the driver that the agricultural field work vehicle is allowed to travel autonomously. This allows the driver to be ready for automatic transition to autonomous travel. Further, in a case where the driver definitively selects to cause the agricultural field work vehicle to transition to autonomous travel, the driver can cause the agricultural field work vehicle at a desired time point to transition smoothly to autonomous travel because the control device ensures that the agricultural field work vehicle is able to transition to autonomous travel.
Smooth transition from manual travel to autonomous travel depends on a plurality of conditions, one of which is whether the vehicle body is close to a resumption travel path, that is, that target travel path on which the agricultural field work vehicle will travel autonomously. If the vehicle body is close enough to a resumption travel path for the controller to accurately locate the resumption travel path, the controller can calculate a positional deviation of the vehicle body from the resumption travel path. After calculating a positional deviation, the controller generates a steering signal intended to reduce the positional deviation. This allows the vehicle body to travel autonomously along the resumption travel path. If the vehicle body is excessively distanced from a resumption travel path, the controller is unable to locate the resumption travel path. The controller is able to locate a resumption travel path within an experimentally or theoretically calculated zone. A preferred embodiment of the present invention is thus further configured or programmed such that in response to the vehicle body having entered a zone set near the resumption travel path, the determiner determines that the agricultural field work vehicle is able to perform the transition.
In a case where the agricultural field work vehicle has suspended autonomous travel along a target travel path and moved off the target travel path partway, the agricultural field work vehicle may resume the autonomous travel not at the move-off position but at the travel starting end of the target travel path. In such a case, the agricultural field work vehicle performs no work or redundant work from the resumption position to the move-off position. The agricultural field work vehicle may resume the autonomous travel at the travel starting end of the target travel path because the agricultural field work vehicle is more likely to transition smoothly to autonomous travel in the case where the vehicle body enters the target travel path at the travel starting end than in the case where the vehicle body enters the target travel path at the intermediate, move-off position. A preferred embodiment of the present invention is thus further configured or programmed such that in response to the vehicle body having entered a zone set near a travel starting end of the resumption travel path, the determiner determines that the agricultural field work vehicle is able to perform the transition.
If the agricultural field work vehicle has partially moved off a target travel path, the agricultural field work vehicle is able to enter the target travel path (resumption travel path) at the move-off position from a side of the target travel path. A preferred embodiment of the present invention is further configured or programmed such that in response to the vehicle body having entered a zone set near the move-off position, the determiner determines that the agricultural field work vehicle is able to perform the transition.
The agricultural field work vehicle is able to enter a resumption travel path more smoothly when the direction of the vehicle body (that is, its front-back direction) is closer to the direction of the resumption travel path (that is, the direction in which the resumption travel path extends). The determiner preferably further uses a determination condition about the direction of the vehicle body in determining whether the agricultural field work vehicle is able to transition from manual travel to autonomous travel. A preferred embodiment of the present invention is thus further configured or programmed such that the determiner further determines, as a condition for determining whether the agricultural field work vehicle is able to transition, whether the vehicle body has a directional deviation from the resumption travel path which directional deviation is within an allowable deviation range.
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.
The description below deals with, as preferred embodiments of the present invention, agricultural field work vehicles configured or programmed to travel autonomously along a target travel path.
The panel unit 23 includes a manual operation tool group and a monitor 25 provided with a touch screen.
The description below deals with a basic travel process during the tillage work. To start tillage work, the driver manually drives the tractor to position the vehicle body 1 at a teaching start point close to a ridge of the agricultural field, and then presses the teaching operation tool 24b. The driver manually drives the tractor to cause the vehicle body 1 to travel from the teaching start point linearly along the ridge to a teaching end point present on the opposite side and close to the ridge, and then presses the teaching operation tool 24b again. This allows a teaching path TL to be calculated from the position coordinates of the vehicle body 1 at the teaching start point and the position coordinate of the vehicle body 1 at the teaching end point, the teaching path TL connecting the teaching start point with the teaching end point.
After the teaching path TL has been set, the driver causes the tractor to perform 180-degree turn travel (U-turn travel) to move to the first target travel path LM(1), which is adjacent to the teaching path TL.
Before or after the end of the turn travel, the tractor checks whether the vehicle body 1 is directed suitably for subsequent tillage work, that is, the vehicle body 1 has a travel deviation relative to the target travel path LM(1) which travel deviation is within an acceptable range. If the travel deviation is within the acceptable range, the driver is notified that the tractor is able to travel autonomously along the target travel path LM(1). In response to the notification, the driver operates the autonomous travel start operation tool 24a. This causes the tractor to start autonomous travel with the target travel path LM(1) set as a target.
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 LM 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 (U-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) and present on the side of an unworked region and that extends from a starting point position Ls(2). Subsequently, the tractor repeats setting a target travel path LM and performing work travel in the order of target travel paths LM(3), LM(4), LM(5), and LM(6) with turn travel in-between.
As illustrated in
The description below deals with functional sections of a controller of the tractor with reference to
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, an operation device group 60, a state detector group 70, and the manual operation tool group 24. The positioning unit 8 is connected to the control device 5 over an in-vehicle LAN. The monitor 25 as a notification device includes a liquid crystal panel, and is configured or programmed to display various information items based on a notification signal from a notification unit 72 configured or programmed to control notification. The notification unit 72 is also connected to the control device 5 over the in-vehicle LAN.
The operation device group 60 includes a steering motor 14, a travel operation device 61 (which is a travel-related operation device), and a work operation device 62 (which is a work-related operation device).
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 such as a lifting/lowering mechanism.
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 travel deviation calculating section 55, a move-off recording section 56, and a work return management section 57.
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 of the 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 direction calculating section 81 may alternatively calculate the travel direction based on measurement data from the inertial positioning module 8b.
The travel control section 51 transmits a steering control signal to the steering motor 14, and also transmits, for example, a speed change control signal and a braking control signal to a travel operation device 61 such as a transmission (not illustrated in the drawings). The travel control section 51 includes an autonomous travel control section 511, a manual travel control section 512, and a travel mode management section 513 in order for the tractor to selectively travel autonomously or be driven manually.
The work control section 52 controls various work operation devices 62 each configured or programmed to lift and lower the work device 30 or transmit 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 through the procedure described above with reference to
The travel deviation calculating section 55 calculates (i) a lateral deviation that the vehicle body 1 has at a vehicle position calculated by the vehicle position calculating section 80 and (ii) a directional deviation that the vehicle body 1 has at the vehicle position. A 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 vehicle position and a target travel path set by the path setting section 54. A directional deviation refers to the angle defined by the travel direction of the vehicle body 1 calculated by the travel direction calculating section 81 and the target travel path.
The tractor may be 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 computes, based on a lateral deviation and a directional deviation from the travel deviation calculating section 55, a steering control amount intended to reduce the lateral deviation and the directional deviation. The steering motor 14 is driven (that is, the front wheels 11 are steered) based on the steering control amount.
The move-off recording section 56 records move-off information when the tractor has moved off the target travel path while performing agricultural field work during autonomous travel and headed for a parking area PA as illustrated in
The work return management section 57 selects a resumption travel path, that is, a target travel path that the tractor having moved off a travel path will use when it resumes performing agricultural field work during autonomous travel. The work return management section 57 obtains data on a resumption travel path by reading move-off information from the move-off recording section 56. The work return management section 57 also manages return information, which is for use to guide the vehicle body 1 to the selected resumption travel path or move-off position. The return travel is performed manually. The resumption travel path or move-off position in the agricultural field is preferably shown on the monitor 25 for the driver. The return information includes such information for the monitor 25 to display as (i) image information on an agricultural field map with the resumption travel path and move-off position marked and (ii) text information indicative of the date and time of the moving off and/or the like.
The work return management section 57 includes a determining section 571 configured or programmed to determine, while the agricultural field work vehicle is being manually driven for the vehicle body 1 to return to the resumption travel path, whether the agricultural field work vehicle is able to transition from manual travel to autonomous travel. The determining section 571 uses, as a condition for the transition to autonomous travel, a determination rule that corresponds to the current situation. The description below deals with example transition rules. The determining section 571 selectively uses the transition rules below to determine whether the agricultural field work vehicle is able to transition to autonomous travel. The description below of the example transition rules uses the same terms and reference signs as those in
If the benchmark point (indicated as “BP” in
If the benchmark point (indicated as “BP” in
If the benchmark point (indicated as “BP” in
Under the fourth determination rule, which is similar to Determination Rule b, the move-off position Pb2 coincides with the travel ending end (indicated as “Re” in
The above-described determination rules to which the determining section 571 refers are each intended to determine whether the vehicle body 1 is present within a predetermined zone, that is, whether the vehicle body 1 is present within a predetermined distance from the position at which the vehicle body 1 will resume autonomous travel. For the vehicle body 1 to enter a travel path, however, the direction of the vehicle body 1 is also an important factor. The present preferred embodiment is thus configured or programmed such that the above-described determination rules each further involve a determination condition of whether the deviation of the direction of the vehicle body 1 from the direction of the resumption travel path (that is, the direction in which the resumption travel path extends) is within an allowable deviation range. Whether a deviation is within the allowable deviation range means whether the crossing angle defined by a line indicative of the vehicle body direction and a line indicative of the direction of the resumption travel path is not larger than an allowable angle. The allowable angle is an angle within which the vehicle body 1 is able to enter a resumption travel path through autonomous steering smoothly without damaging the agricultural field.
When the determining section 571 has determined that the agricultural field work vehicle is able to transition from manual travel to autonomous travel to enter the resumption travel path, the work return management section 57 transmits to the notification unit 72 a notification command to notify the driver of the determination result. In response to the notification command, the notification unit 72 generates a notification signal to, for example, (i) cause the monitor 25 to display information indicating that the agricultural field work vehicle is able to transition to autonomous travel, (ii) turn on a lamp (not illustrated in the drawings), and/or (iii) cause a loudspeaker (not illustrated in the drawings) to emit a sound.
The present preferred embodiment is configured or programmed such that after the determining section 571 has determined that the agricultural field work vehicle is able to transition from manual travel to autonomous travel to enter the resumption travel path, the driver operates the autonomous travel start operation tool 24a to start autonomous travel so that the front wheels 11 are controlled autonomously. The present preferred embodiment may alternatively be configured or programmed to allow autonomous travel to be started automatically, that is, without the operation of the autonomous travel start operation tool 24a.
(1) The preferred embodiments described above use front wheels 11 to steer a vehicle body 1 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 are 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 of the present invention 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. The preferred embodiments 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-238893 | Dec 2018 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2019/048370 | 12/11/2019 | WO | 00 |