Automated travelling method, automated travelling system, and automated travelling program

By automatically detecting and correcting the possible position and direction deviations of the working vehicle after turning, and performing reverse correction driving, the problem of the working vehicle not being able to enter the next working route correctly is solved, and the accuracy and efficiency of the work are improved.

JP2025070050APending Publication Date: 2025-05-02YANMAR HLDG CO LTD
View PDF 1 Cites 0 Cited by

Patent Information

Application Number
JP2023180088
Authority / Receiving Office
JP · JP
Patent Type
Applications
Current Assignee / Owner
Filing Date
2023-10-19
Publication Date
2025-05-02

AI Technical Summary

Technical Problem

When the working vehicle turns on the turning path and enters the next working route, if the position accuracy is low, displacement deviations (for example, lateral displacement deviations) and direction deviations may occur, causing the working vehicle to fail to enter the working route correctly, resulting in areas where the work is not completed.

Method used

The autonomous driving method is adopted to detect whether a predetermined positioning deviation or direction deviation occurs, and if it occurs, correct driving is performed, including reversed travel, to ensure that the working vehicle correctly enters the next working route.

Benefits of technology

The working vehicle accurately enters the next working route after turning, avoids unfinished work areas due to deviations, and improves work efficiency and accuracy.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 2025070050000001_ABST
    Figure 2025070050000001_ABST
Patent Text Reader

Abstract

To provide an automated travelling method, an automated travelling program, and an automated travelling system that can cause a work vehicle to enter a work route continued to a turning route appropriately.SOLUTION: A travelling processing unit 111 causes a work vehicle 10 to travel according to a plurality of work routes included in a target route for causing the work vehicle 10 to perform predetermined work and a plurality of turning routes for connecting the work routes. When a correction processing unit 112 determines that at least either predetermined positional deviation or an azimuth deviation occurs for a target starting position of the work route continued to the turning route in the case where the work vehicle 10 travels the turning route, the correction processing unit causes the work vehicle 10 to perform correction travelling including backward travelling.SELECTED DRAWING: Figure 1
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present invention relates to a technique for automatically driving a work vehicle along a target route. [Background technology]

[0002] Conventionally, a work vehicle that automatically travels along a preset target route in a farm field is known. For example, the work vehicle performs work while traveling back and forth in an inner area in the center of the farm field, and performs work while traveling in a circling manner in an outer area (headland area) in the outer periphery of the farm field (see, for example, Patent Document 1). In addition, when working in the inner area, the work vehicle travels around a turning route when moving from one work route to the next work route. [Prior art documents] [Patent documents]

[0003] [Patent Document 1] JP 2018-147421 A Summary of the Invention [Problem to be solved by the invention]

[0004] Here, when the work vehicle turns around the turning route and enters the next work route, if the position accuracy is low, a position deviation (for example, lateral position deviation) or azimuth deviation (azimuth deviation) may occur with respect to the start point of the work route (target start position). If the work vehicle starts work in a state where the position deviation or azimuth deviation has occurred, work will not start from an appropriate position on the work route, resulting in an unworked area.

[0005] An object of the present invention is to provide an automatic driving method, an automatic driving program, and an automatic driving system that are capable of properly causing a work vehicle to enter a work path following a turning path. [Means for solving the problem]

[0006] The automatic driving method of the present invention is a method for automatically driving a work vehicle along a predetermined target route, which includes the steps of: driving the work vehicle along a plurality of work routes included in the target route, which cause the work vehicle to perform predetermined work, and a plurality of turning routes connecting the work routes; and, when the work vehicle drives along the turning routes, if it is determined that at least one of a predetermined position deviation and azimuth deviation will occur with respect to the target start position of the work route following the turning routes, causing the work vehicle to perform corrective driving including reverse driving.

[0007] The automatic driving program of the present invention is a program for automatically driving a work vehicle according to a predetermined target route, and causes the work vehicle to drive according to a plurality of work routes included in the target route, which cause the work vehicle to perform predetermined work, and a turning route connecting the plurality of work routes; and when it is determined that at least one of a predetermined position deviation and azimuth deviation will occur with respect to the target start position of the work route following the turning route, the program is executed by one or more processors to cause the work vehicle to perform corrective driving including reverse driving.

[0008] The automatic driving system according to the present invention is a system for automatically driving a work vehicle along a preset target route, and includes a driving processing unit and a correction processing unit. The driving processing unit drives the work vehicle along a plurality of work routes included in the target route, which cause the work vehicle to perform a predetermined task, and a plurality of turning routes connecting the work routes. When the correction processing unit determines that at least one of a predetermined position deviation and an orientation deviation occurs with respect to a target start position of the work route following the turning route when the work vehicle drives the turning route, the correction processing unit causes the work vehicle to perform a corrective driving including reverse driving. Effect of the Invention

[0009] According to the present invention, it is possible to provide an automatic driving method, an automatic driving program, and an automatic driving system that are capable of properly causing a work vehicle to enter a work path following a turning path. [Brief description of the drawings]

[0010] [Figure 1] FIG. 1 is a block diagram showing a configuration of an automatic driving system according to an embodiment of the present invention. [Diagram 2] FIG. 2 is an external view showing the configuration of the work vehicle according to the embodiment of the present invention. [Diagram 3] FIG. 3 is a diagram showing an example of a target route set in a farm field according to the embodiment of the present invention. [Figure 4] FIG. 4 is a diagram showing an example of a turning route included in a target route according to an embodiment of the present invention. [Diagram 5] FIG. 5 is a diagram showing a state in which a position shift and a direction shift occur due to turning in the inner region. [Figure 6A] FIG. 6A is a diagram showing an example of the correction travel according to the embodiment of the present invention. [Figure 6B] FIG. 6B is a diagram showing an example of the correction travel according to the embodiment of the present invention. [Figure 7] FIG. 7 is a diagram showing another example of the correction travel according to the embodiment of the present invention. [Figure 8] FIG. 8 is a diagram showing another example of the correction travel according to the embodiment of the present invention. [Figure 9] FIG. 9 is a diagram showing an example of a turning route included in a target route according to an embodiment of the present invention. [Figure 10] FIG. 10 is a diagram showing a state in which a position shift and a direction shift occur due to turning in a headland area. [Figure 11] FIG. 11 is a diagram showing an example of the correction travel according to the embodiment of the present invention. [Figure 12] FIG. 12 is a diagram showing an example of a menu screen displayed on the operation terminal according to the embodiment of the present invention. [Figure 13]FIG. 13 is a flowchart showing an example of a procedure of an automatic driving process executed by the automatic driving system according to the embodiment of the present invention. [Figure 14] FIG. 14 is a diagram showing an example of a driving screen displayed on the operation terminal according to the embodiment of the present invention. [Figure 15] FIG. 15 is a flowchart showing another example of the procedure of the automatic driving process executed by the automatic driving system according to the embodiment of the present invention. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0011] The following embodiment is an example of the present invention, and is not intended to limit the technical scope of the present invention.

[0012] As shown in Fig. 1, an automated driving system 1 according to an embodiment of the present invention includes a work vehicle 10 and an operation terminal 20. The work vehicle 10 and the operation terminal 20 can communicate with each other via a communication network N1. For example, the work vehicle 10 and the operation terminal 20 can communicate with each other via a mobile phone network, a packet network, or a wireless LAN.

[0013] In this embodiment, the work vehicle 10 is a tractor. In other embodiments, the work vehicle 10 may be a combine harvester, a rice transplanter, a construction machine, a snowplow, or the like. The work vehicle 10 is configured to be capable of automatically traveling within a field F (see FIG. 3) according to a preset target route R.

[0014] For example, a worker (operator) registers a field F to be worked on, and sets a target route R along which the work vehicle 10 will automatically travel through the field F. The work vehicle 10 automatically travels along a preset target route R through the field F, based on position information of the current position of the work vehicle 10 calculated by the positioning unit 16. The work vehicle 10 also performs predetermined work while automatically traveling within the field F. The field F includes an inner area Fa, which is the inner area, and an outer circumferential area (headland area Fb), which is the area surrounding the inner area Fa. An inner work route Ra, which is the travel route of the work vehicle 10, is set in the inner area Fa, and a headland work route Rb, which is the travel route of the work vehicle 10, is set in the headland area Fb.

[0015] For example, the work vehicle 10 performs a predetermined work while traveling back and forth in parallel on the inner work path Ra from the travel start position S in the inner area Fa of the field F shown in Fig. 3, and then performs a predetermined work while traveling in a spiral pattern on the headland work path Rb in the headland area Fb toward the travel end position G. The target path R is not limited to the path shown in Fig. 3, and is set appropriately depending on the work content. Also, in Fig. 3, the work vehicle 10 first travels in the inner area Fa and then travels in the headland area Fb, but the travel order of the work vehicle 10 is not limited to this. For example, the work vehicle 10 may first travel in the headland area Fb and then travel in the inner area Fa.

[0016] The operation terminal 20 is a mobile terminal capable of remotely operating the work vehicle 10, and is configured, for example, as a tablet terminal, a notebook personal computer, a smartphone, or the like. The worker can perform setting operations for various setting items on the operation terminal 20. In addition, the operation terminal 20 displays information such as the work status and driving status of the work vehicle 10 during automatic driving. The worker can grasp the work status and driving status on the operation terminal 20.

[0017] Here, when work on one work path is completed, the work vehicle 10 travels around a turning path included in the target path R toward the next work path. FIG. 4 shows an example of a turning path Rs1. FIG. 4 also shows work paths R1 and R2 set in the inner area Fa. The work path R2 is the work path on which work is performed after the work path R1. The work paths R1 and R2 are connected by the turning path Rs1. When work on the work path R1 is completed, the work vehicle 10 travels around the turning path Rs1 and enters the work path R2, and performs work on the work path R2.

[0018] Specifically, the turning path Rs1 includes a straight path r1 connected to the work path R1, a turning path r2 connected to the straight path r1, a straight path r3 connected to the turning path r2, a straight path r4 connected to the straight path r3, a turning path r5 connected to the straight path r4, and a straight path r6 connected to the turning path r5 and the work path R2.

[0019] When the work vehicle 10 reaches the end p1 of the work path R1, it raises the work implement 14, temporarily stops the work, and travels straight ahead along the straight path r1 in the forward direction. Next, when the work vehicle 10 reaches the end p2 of the straight path r1 (the start end of the turning path r2), it turns along the turning path r2 in the forward direction. Next, when the work vehicle 10 reaches the end p3 of the turning path r2 (the start end of the straight path r3), it travels straight ahead along the straight path r3 in the forward direction. Next, when the work vehicle 10 reaches the end p4 of the straight path r3 (the start end of the straight path r4), it travels straight backward along the straight path r4. Next, when the work vehicle 10 reaches the end p5 of the straight path r4 (the start end of the turning path r5), it turns along the turning path r5 in the forward direction. Next, when the work vehicle 10 reaches the end p6 of the turning path r5 (the start end of the straight path r6), it travels straight ahead along the straight path r6. Finally, when the work vehicle 10 reaches the end p7 of the straight path r6 (the start end of the work path R2), it lowers the work implement 14 and enters the work path R2 to resume work. Note that position p7 is the start end of the work path R2 and corresponds to the target start position of the work path R2.

[0020] Here, in order for the work vehicle 10 to properly enter the work path R2, it is desirable that the work vehicle 10 is located within a predetermined distance from the start of the work path R2 (target start position p7) at the time when the work vehicle 10 finishes traveling the turning path r5 and the straight path r6, and the vehicle orientation is within a predetermined orientation with respect to the extension direction of the work path R2. However, due to the influence of the state of the field F (soil) and the position accuracy of the positioning unit 16, for example, as shown in FIG. 5, at the time when the work vehicle 10 finishes traveling the turning path r5 and the straight path r6, the current position P0 of the work vehicle 10 may shift laterally from the target start position p7, or the vehicle orientation may shift with respect to the work path R2. When such a position shift (position deviation) or orientation shift (orientation deviation) occurs, the work vehicle 10 starts working from a position that is shifted with respect to the work path R2, resulting in an unworked area (a gap between areas that have been worked on).

[0021] In contrast, the automated driving system 1 according to this embodiment has a configuration that allows the work vehicle 10 to appropriately enter a work path following a turning path, as will be described below.

[0022] [Work vehicle 10] 1 and 2, the work vehicle 10 includes a vehicle control device 11, a memory unit 12, a traveling device 13, a work implement 14, a communication unit 15, a positioning unit 16, etc. The vehicle control device 11 is electrically connected to the memory unit 12, the traveling device 13, the work implement 14, the positioning unit 16, etc. Note that the vehicle control device 11 and the positioning unit 16 may be capable of wireless communication.

[0023] The communication unit 15 is a communication interface that connects the work vehicle 10 to the communication network N1 either wired or wirelessly, and executes data communication with external devices (such as the operation terminal 20) via the communication network N1 in accordance with a predetermined communication protocol.

[0024] The storage unit 12 is a non-volatile storage unit such as an HDD (Hard Disk Drive) or an SSD (Solid State Drive) that stores various information. The storage unit 12 stores control programs such as an automatic driving program for causing the vehicle control device 11 to execute the automatic driving process (see Figs. 13 and 15) described later. For example, the automatic driving program is non-temporarily recorded on a computer-readable recording medium such as a CD or a DVD, and is read by a predetermined reading device (not shown) and stored in the storage unit 12. The automatic driving program may be downloaded from a server (not shown) to the work vehicle 10 via a communication network N1 and stored in the storage unit 12. The storage unit 12 also stores data of a target route R generated in the operation terminal 20, etc.

[0025] The traveling device 13 is a drive unit that causes the work vehicle 10 to travel. As shown in Fig. 2, the traveling device 13 includes an engine 131, front wheels 132, rear wheels 133, a transmission 134, a front axle 135, a rear axle 136, a handlebar 137, and the like. The front wheels 132 and the rear wheels 133 are provided on the left and right sides of the work vehicle 10, respectively. The traveling device 13 is not limited to a wheel type that includes the front wheels 132 and the rear wheels 133, but may be a crawler type that includes crawlers provided on the left and right sides of the work vehicle 10.

[0026] The engine 131 is a drive source such as a diesel engine or a gasoline engine that is driven by fuel supplied to a fuel tank (not shown). The traveling device 13 may be equipped with an electric motor as a drive source together with the engine 131 or instead of the engine 131. A generator (not shown) is connected to the engine 131, and power is supplied from the generator to the vehicle control device 11, the positioning unit 16, and other electrical components provided in the work vehicle 10, as well as to a battery. The battery is charged by the power supplied from the generator. The vehicle control device 11, the positioning unit 16, and other electrical components provided in the work vehicle 10 can be driven by the power supplied from the battery even after the engine 131 is stopped.

[0027] The driving force of the engine 131 is transmitted to front wheels 132 via a transmission 134 and a front axle 135, and to rear wheels 133 via a transmission 134 and a rear axle 136. The driving force of the engine 131 is also transmitted to the work equipment 14 via a PTO shaft (not shown). When the work vehicle 10 performs autonomous traveling, the traveling device 13 performs a traveling operation in accordance with commands from the vehicle control device 11. The traveling device 13 also decelerates or stops the work vehicle 10 in accordance with commands from the vehicle control device 11.

[0028] The working implement 14 is, for example, a cultivator, a grass cutter, a plow, a fertilizer applicator, a sprayer (chemical applicator), a tiller, or a seed sower, and can be attached to and detached from the work vehicle 10. This allows the work vehicle 10 to perform various types of work using each of the working implements 14. FIG. 2 shows a case in which the working implement 14 is a cultivator. For example, the working implement 14 is attached to the rear of the work vehicle 10. The work vehicle 10 performs cultivating work by traveling through a field F with the working implement 14 attached to the rear.

[0029] The working implement 14 may be supported by a lifting mechanism (not shown) in the work vehicle 10 so that it can be raised and lowered. The vehicle control device 11 can raise and lower the working implement 14 by controlling the lifting mechanism. For example, the vehicle control device 11 lowers the working implement 14 when the work vehicle 10 travels straight ahead in the forward direction in the inner area Fa and headland area Fb of the field F, and raises the working implement 14 when the work vehicle 10 travels straight ahead in the reverse direction and turns in the inner area Fa and headland area Fb of the field F. In addition, when the vehicle control device 11 acquires a work stop instruction, it outputs a work stop command to the working implement 14. For example, when the operator performs a stop instruction operation on the operation terminal 20, the vehicle control device 11 acquires the stop instruction from the operation terminal 20. When the vehicle control device 11 acquires a work stop instruction, it stops the driving of the PTO shaft to stop the work of the working implement 14.

[0030] The handle 137 is an operating section that is operated by an operator or the vehicle control device 11. For example, in the traveling device 13, the angle of the front wheels 132 is changed by a hydraulic power steering mechanism (not shown) or the like in response to the operation of the handle 137 by the vehicle control device 11, and the traveling direction of the work vehicle 10 is changed.

[0031] In addition to the handlebars 137, the traveling device 13 is equipped with a shift lever, accelerator, brake, etc. (not shown) that are operated by the vehicle control device 11. In the traveling device 13, the gear of the transmission 134 is switched to a forward gear, a reverse gear, etc. in response to operation of the shift lever by the vehicle control device 11, and the traveling mode of the work vehicle 10 is switched to forward, reverse, etc. The vehicle control device 11 also operates the accelerator to control the rotation speed of the engine 131. The vehicle control device 11 also operates the brake to brake the rotation of the front wheels 132 and the rear wheels 133 using an electromagnetic brake.

[0032] The positioning unit 16 is a communication device including a positioning control unit 161, a memory unit 162, a communication unit 163, and a positioning antenna 164 (see FIG. 1). For example, as shown in FIG. 2, the positioning unit 16 is provided on the upper part of a cabin 138 in which a worker boards. The installation location of the positioning unit 16 is not limited to the cabin 138. Furthermore, the positioning control unit 161, the memory unit 162, the communication unit 163, and the positioning antenna 164 of the positioning unit 16 may be disposed in different positions in the work vehicle 10. As described above, the battery is connected to the positioning unit 16, and the positioning unit 16 can operate even when the engine 131 is stopped. Furthermore, the positioning unit 16 may be substituted with, for example, a mobile phone terminal, a smartphone, a tablet terminal, or a quantum compass.

[0033] The positioning control unit 161 is a computer system including one or more processors and storage memories such as a non-volatile memory and a RAM. The storage unit 162 is a non-volatile memory that stores a program for causing the positioning control unit 161 to execute a positioning process, and data such as positioning information and movement information. For example, the program is non-temporarily recorded on a computer-readable recording medium such as a CD or a DVD, and is read by a predetermined reading device (not shown) and stored in the storage unit 162. The program may be downloaded from a server (not shown) to the positioning unit 16 via the communication network N1 and stored in the storage unit 162.

[0034] The communication unit 163 is a communication interface for connecting the positioning unit 16 to the communication network N1 by wire or wirelessly, and for executing data communication in accordance with a predetermined communication protocol with an external device such as a base station server via the communication network N1.

[0035] The positioning antenna 164 is an antenna that receives radio waves (GNSS signals) transmitted from satellites.

[0036] The positioning control unit 161 calculates the current position of the work vehicle 10 based on the GNSS signal received by the positioning antenna 164 from a satellite. For example, when the work vehicle 10 automatically travels in the field F, when the positioning antenna 164 receives radio waves (such as transmission time and orbit information) transmitted from each of a plurality of satellites, the positioning control unit 161 calculates the distance between the positioning antenna 164 and each satellite, and calculates the current position (latitude and longitude) of the work vehicle 10 based on the calculated distance. The positioning control unit 161 may also perform positioning using a real-time kinematic method (RTK-GNSS positioning method (RTK method)) that calculates the current position of the work vehicle 10 using correction information corresponding to a base station (reference station) close to the work vehicle 10. In this way, the work vehicle 10 automatically travels using positioning information by the RTK method. The current position of the work vehicle 10 may be the same as the positioning position (for example, the position of the positioning antenna 164), or may be a position shifted from the positioning position. The positioning control unit 161 may calculate (measure) the current position of the work vehicle 10 using a quantum compass.

[0037] The vehicle control device 11 has control devices such as a CPU, a ROM, and a RAM. The CPU is a processor that executes various types of arithmetic processing. The ROM is a non-volatile storage unit in which control programs such as a BIOS and an OS for causing the CPU to execute various types of arithmetic processing are stored in advance. The RAM is a volatile or non-volatile storage unit that stores various types of information, and is used as a temporary storage memory for various types of processing executed by the CPU. The vehicle control device 11 controls the work vehicle 10 by executing various control programs stored in advance in the ROM or the storage unit 12 with the CPU.

[0038] Specifically, as shown in Fig. 1, the vehicle control device 11 includes various processing units such as a driving processing unit 111 and a correction processing unit 112. The vehicle control device 11 functions as the various processing units by executing various processes according to the automatic driving program with the CPU. Some or all of the processing units may be configured with electronic circuits. The automatic driving program may be a program for causing a plurality of processors to function as the processing units.

[0039] The driving processing unit 111 controls the driving of the work vehicle 10. For example, when the driving mode of the work vehicle 10 is automatic driving (automatic driving mode), the driving processing unit 111 automatically drives the work vehicle 10 based on position information (positioning information) indicating the current position of the work vehicle 10 measured by the positioning unit 16. For example, when the work vehicle 10 satisfies the start condition for automatic driving and acquires a work start instruction from the worker, the driving processing unit 111 starts automatic driving of the work vehicle 10 based on the positioning information. In addition, the driving processing unit 111 automatically drives the work vehicle 10 from the driving start position S to the driving end position G according to a target route R (see FIG. 3) that is generated and set in advance in the operation terminal 20. For example, the driving processing unit 111 drives the work vehicle 10 according to a plurality of work routes that cause the work vehicle 10 to perform a predetermined work and a plurality of turning routes that connect the work routes, which are included in the target route R.

[0040] When the driving mode of the work vehicle 10 is manual driving (manual driving mode), the work vehicle 10 can be manually driven based on the operation (manual steering) of the worker. For example, the driving processing unit 111 acquires operation information corresponding to driving operations such as steering, gear shifting, driving direction switching, and braking by the worker, and causes the traveling device 13 to perform a driving operation based on the operation information.

[0041] When the work vehicle 10 deviates from the target position beyond a predetermined range (tolerable range) or the orientation (vehicle orientation) of the work vehicle 10 deviates from the target orientation beyond a predetermined range (tolerable range), the correction processing unit 112 causes the work vehicle 10 to perform correction driving to correct the position deviation, orientation deviation, etc. Specifically, when the work vehicle 10 travels along a turning path, if the correction processing unit 112 determines that at least one of a predetermined position deviation and orientation deviation will occur from the target start position of the work path following the turning path, the correction processing unit 112 causes the work vehicle 10 to perform correction driving including reverse driving. The correction processing unit 112 has a function of executing a determination process to determine the position deviation and the orientation deviation.

[0042] 5, the correction processor 112 determines whether the distance between the current position P0 and the target start position p7 of the work path R2 exceeds a predetermined distance when the work vehicle 10 travels along the turning path r5 and the straight path r6. The correction processor 112 also determines whether the orientation difference between the vehicle orientation at the current position P0 and the extension direction of the work path R2 exceeds a predetermined orientation when the work vehicle 10 travels along the turning path r5 and the straight path r6.

[0043] Here, the correction processing unit 112 performs the determination process at the time when the work vehicle 10 travels the turning path r5 and the straight path r6, but in another embodiment, the correction processing unit 112 may perform the determination process before the work vehicle 10 travels the turning path r5 and the straight path r6. For example, when the work vehicle 10 reaches the start point p5 of the turning path r5, the correction processing unit 112 determines whether or not the distance between the expected arrival position P0 and the target start position p7 exceeds a predetermined distance when it is assumed that the work vehicle 10 has traveled the turning path r5 and the straight path r6, and determines whether or not the orientation difference between the expected arrival position P0 and the extension direction of the work path R2 exceeds a predetermined orientation when it is assumed that the work vehicle 10 has traveled the turning path r5 and the straight path r6.

[0044] As another embodiment, the correction processing unit 112 may execute the determination process at the time when the work vehicle 10 starts automatic traveling. As another embodiment, the correction processing unit 112 may execute the determination process while the work vehicle 10 is traveling on the turning path r5 or the straight path r6. The correction processing unit 112 may execute the determination process before the work vehicle 10 travels on the turning path r5 and the straight path r6, and at the time when the work vehicle 10 has traveled on the turning path r5 and the straight path r6. In this case, the correction processing unit 112 may set the determination threshold (the specified distance, the specified direction) to a different value at each determination timing.

[0045] In this manner, the correction processing unit 112 determines whether or not at least one of a predetermined position deviation and a predetermined orientation deviation occurs when the work vehicle 10 travels along a turning path.

[0046] When it is determined in the determination process that at least one of a predetermined position deviation and a direction deviation occurs, the correction processing unit 112 generates a path for corrected travel (corrected path Rt). The corrected path Rt includes at least a backward path for backward travel. For example, as shown in FIG. 6A, the correction processing unit 112 generates a corrected path Rt including a backward path (turning path r11) from the current position P0 (position p10) to a position p11 on an extension line of the work path R2, and a straight path r12 from the position p11 to a starting point p6 of the straight path r6. The correction processing unit 112 makes the work vehicle 10 automatically travel (corrected travel) along the corrected path Rt. Specifically, the correction processing unit 112 makes the work vehicle 10 turn along the turning path r11 in the backward direction from the current position P0 (see FIG. 6A), and when the work vehicle 10 reaches the position p11 (see FIG. 6B), makes the work vehicle 10 travel straight along the straight path r12 in the forward direction. The correction processing unit 112 may switch to straight ahead travel when the work vehicle 10 arrives within a predetermined range from the position p11.

[0047] In this way, when the correction processing unit 112 determines that the position deviation will occur, it causes the work vehicle 10 to make a corrective drive so that the distance (position deviation) from the target start position p7 of the work route R2 to the position of the work vehicle 10 becomes equal to or less than a predetermined distance. Also, when the correction processing unit 112 determines that the orientation deviation will occur, it causes the work vehicle 10 to make a corrective drive so that the orientation deviation of the work vehicle 10 with respect to the extension direction of the work route R2 becomes equal to or less than a predetermined orientation.

[0048] Furthermore, the correction processing unit 112 causes the work vehicle 10 to travel forward in a straight line toward the target start position p7 after the corrected travel, thereby enabling the work vehicle 10 to enter the work route R2 in a straight line.

[0049] In this way, when the correction processing unit 112 determines that at least one of a predetermined position deviation and orientation deviation will occur, it generates a correction route Rt that is different from the preset target route R, and causes the work vehicle 10 to automatically drive (corrective driving) along the correction route Rt so that the position deviation and orientation deviation are suppressed.

[0050] Here, in the correction travel, it is desirable that the correction processing unit 112 travels the work vehicle 10 in a backward travel so that the position deviation and the orientation deviation fall within a predetermined range. For example, in FIG. 6B, it is desirable that the work vehicle 10 is located on the extension line of the work route R2 when the work vehicle 10 reaches the position p11, and the vehicle orientation coincides with the extension direction of the work route R2. Therefore, as shown in FIG. 7, the correction processing unit 112 may set the end (position p11) of the path (turning route r11) on which the work vehicle 10 travels backward near the edge of the field F. Note that the distance L1 shown in FIG. 7 is a minimum distance considering a safety margin to prevent the work vehicle 10 from jumping out of the field. According to the above configuration, since the distance of the backward travel (turning route r11) can be secured long, it becomes easier to correct the position deviation and the orientation deviation by the backward travel, and it becomes possible to reliably keep the position deviation and the orientation deviation within a predetermined range at the position p11.

[0051] As another embodiment, the correction processing unit 112 may end the backward running and switch to forward running (straight running) when the position shift and the orientation shift fall within a predetermined range before the set position p11 during backward running. As another embodiment, the correction processing unit 112 may correct the position shift and the orientation shift during backward running, and may also correct the position shift and the orientation shift during forward running after backward running.

[0052] In another embodiment, for example, when the headland area Fb is narrow, the correction processing unit 112 may repeatedly execute the correction traveling multiple times. For example, as shown in FIG. 8, when the work vehicle 10 travels backward from the position p10 on the turning path r11, travels forward on the straight path r12 at the position p11, and at least one of the position deviation and the azimuth deviation still exceeds a predetermined range at the position p12, the correction processing unit 112 executes the correction traveling again. Specifically, the correction processing unit 112 causes the work vehicle 10 to travel backward on the turning path r13 from the position p12, and switches to forward traveling at the position p13 to cause the work vehicle 10 to travel forward on the straight path r14. The correction processing unit 112 repeatedly executes the correction traveling until the position deviation and the azimuth deviation after the correction traveling fall within a predetermined range with respect to the target start position p7.

[0053] In another embodiment, the vehicle control device 11 may receive an operation from the operator to select whether or not to permit a part of the vehicle body to jump out of the boundary line considering the safety margin or the edge (outline) of the field F when the work vehicle 10 runs backward in the corrected running. For example, the operator may perform the selection operation when generating the target route R, or may perform the selection operation while the work vehicle 10 is running automatically. Note that even if the operator sets the setting to permit the jumping out, it is desirable that the wheels of the work vehicle 10 do not jump out of the field F (for example, do not run onto the ridge). In addition, when the operator sets the setting to permit the jumping out, the vehicle control device 11 may control the running so as to ignore the boundary line or the edge of the field F. Alternatively, the operation control unit 21 may automatically extend the safety margin to the outside of the field F when generating the target route R, or may prompt the operator to extend the safety margin. For example, the operator may input the distance from the ridge to the boundary line (width of the safety margin) on the setting screen.

[0054] Also, it may be possible to select whether or not to permit jumping out for each side of the outline of the field F, or it may be set so that jumping out is forcibly prohibited only for the side where the outside of the field F corresponds to a dangerous position such as a roadway (for example, a route is generated in which a part of the body of the work vehicle 10 does not jump out). Also, when a route is generated in which a part of the body of the work vehicle 10 jumps out, the worker may manually drive the work vehicle 10 when the work vehicle 10 travels through a position corresponding to the jumping out route. Even in a situation in which jumping out of the work vehicle 10 is forcibly prohibited, in the case of a manned automatic driving mode in which a worker is required to board the work vehicle 10, the work vehicle 10 may be automatically driven based on the jumping out route.

[0055] Also, for normal headland turning (such as a U-turn or a fishtail turn), a route for the headland turning may be generated by selecting and setting the jump-out in the same manner as described above.

[0056] In the above example, the correction travel in the inner area Fa has been described, but the same applies to the headland area Fb. Fig. 9 shows the work paths R21, R22 and the turning path Rs2 set in the headland area Fb. The work path R22 is the work path that is worked on next after the work path R21. The work paths R21 and R22 are connected by the turning path Rs2. When the work vehicle 10 finishes work on the work path R21, it travels along the turning path Rs2 and enters the work path R22, and performs work on the work path R22.

[0057] Specifically, the turning path Rs2 includes a straight path r21 connected to the working path R21, a turning path r22 connected to the straight path r21, and a straight path r23 connected to the turning path r22.

[0058] When the work vehicle 10 reaches the end p21 of the work path R21, the work vehicle 10 raises the work implement 14, temporarily stops the work, and travels straight ahead along the straight path r21 in the forward direction. Next, when the work vehicle 10 reaches the end p22 of the straight path r21 (the start end of the turning path r22), the work vehicle 10 turns along the turning path r22 in the backward direction. Next, when the work vehicle 10 reaches the end p23 of the turning path r22 (the start end of the straight path r23), the work vehicle 10 travels straight ahead along the straight path r23 in the forward direction. Then, when the work vehicle 10 reaches the end of the straight path r23 (the start end of the work path R22), the work vehicle 10 lowers the work implement 14 and enters the work path R22 to resume work. Note that position p21 is the start end of the work path R22 and corresponds to the target start position of the work path R22.

[0059] Here, in order for the work vehicle 10 to properly enter the work path R22, it is desirable that the work vehicle 10 is located within a predetermined distance from the start of the work path R22 (target start position p21) at the time when the work vehicle 10 finishes traveling the turning path r22 and the straight path r23, and the vehicle orientation is within a predetermined orientation with respect to the extension direction of the work path R22. However, due to the influence of the state of the field F (soil) and the position accuracy of the positioning unit 16, for example, as shown in FIG. 10, at the time when the work vehicle 10 finishes traveling the turning path r22 and the straight path r23, the current position P0 of the work vehicle 10 may shift laterally from the target start position p21, or the vehicle orientation may shift with respect to the extension direction of the work path R22. As with the inner area Fa, an unworked area may occur when the work vehicle 10 starts working from a position that is shifted from the work path R2.

[0060] Therefore, even in the headland area Fb, the correction processor 112 judges whether or not at least one of a predetermined position shift and orientation shift occurs when the work vehicle 10 travels along a turning path, and when it is judged that at least one of a predetermined position shift and orientation shift occurs, generates a corrected path that corrects the position shift and orientation shift, and causes the work vehicle 10 to perform the corrected travel. For example, as shown in Fig. 11, the correction processor 112 generates a corrected path Rt that includes a turning path r31 from the current position P0 (position p30) to a position p31 on an extension line of the work path R22, and a straight path r32 from the position p31 to a start point p23 of the straight path r23. The correction processor 112 causes the work vehicle 10 to automatically travel (corrected travel) along the corrected path Rt. Specifically, the correction processing unit 112 causes the work vehicle 10 to turn in the turning path r31 in the backward direction from the current position P0, and when the work vehicle 10 reaches position p31, causes the work vehicle 10 to travel straight in the forward direction along the straight path r32. The correction processing unit 112 may switch to straight travel when the work vehicle 10 reaches within a predetermined range (predetermined accuracy) from position p31. In this way, the correction processing unit 112 corrects the travel of the work vehicle 10 so that the distance from the target start position p21 of the work path R22 to the position of the work vehicle 10 is equal to or less than a predetermined distance, and the orientation of the work vehicle 10 relative to the extension direction of the work path R22 is equal to or less than a predetermined orientation.

[0061] Furthermore, the correction processing unit 112 causes the work vehicle 10 to travel forward in a straight line toward the target start position p21 after the corrected travel. This enables the work vehicle 10 to enter the work route R22 in a straight line.

[0062] Incidentally, even in the headland region Fb, the correction processing unit 112 may set the end point (position p31) of the path (turning path r31) for reverse traveling near the edge of the field F. Furthermore, the correction processing unit 112 may end the reverse traveling and switch to forward traveling (straight traveling) when the position deviation and azimuth deviation fall within a predetermined range before the set position p31. Furthermore, the correction processing unit 112 may repeatedly execute the correction traveling multiple times.

[0063] [Operation terminal 20] 1, the operation terminal 20 is an information processing device including an operation control unit 21, a storage unit 22, an operation display unit 23, and a communication unit 24. The operation terminal 20 may be configured as a mobile terminal such as a tablet terminal or a smartphone.

[0064] The communication unit 24 is a communication interface for connecting the operation terminal 20 to the communication network N1 via a wired or wireless connection, and for performing data communication in accordance with a predetermined communication protocol with external devices such as one or more work vehicles 10 via the communication network N1.

[0065] The operation display unit 23 is a user interface equipped with a display unit such as a liquid crystal display or an organic EL display that displays various information, and an operation unit such as a touch panel, a mouse, or a keyboard that accepts operations. The worker can operate the operation unit to register various information (such as work vehicle information, field information, and work information described below) on the operation screen displayed on the display unit. The worker can also operate the operation unit to give instructions to the work vehicle 10 to start work and stop traveling. The worker can also grasp the traveling state of the work vehicle 10, which automatically travels in the field F according to the target route R, from the traveling trajectory displayed on the operation terminal 20 and the images captured by the camera, from a location away from the work vehicle 10.

[0066] The storage unit 22 is a non-volatile storage unit such as an HDD or SSD that stores various types of information. A control program for causing the operation control unit 21 to execute various control processes is stored in the storage unit 22. For example, the control program is non-temporarily recorded on a computer-readable recording medium such as a CD or DVD, and is read by a predetermined reading device (not shown) and stored in the storage unit 22. The control program may be downloaded from a server (not shown) to the operation terminal 20 via the communication network N1 and stored in the storage unit 22.

[0067] The operation control unit 21 has control devices such as a CPU, a ROM, and a RAM. The CPU is a processor that executes various arithmetic processes. The ROM is a non-volatile storage unit in which control programs such as a BIOS and an OS for causing the CPU to execute various arithmetic processes are stored in advance. The RAM is a volatile or non-volatile storage unit that stores various information, and is used as a temporary storage memory (work area) for various processes executed by the CPU. The operation control unit 21 controls the operation terminal 20 by executing various control programs stored in advance in the ROM or the storage unit 22 by the CPU.

[0068] As shown in Fig. 1, the operation control unit 21 includes various processing units such as a setting processing unit 211 and an output processing unit 212. The operation control unit 21 functions as the various processing units by executing various processes according to the control program with the CPU. Some or all of the processing units may be configured with electronic circuits. The control program may be a program for causing a plurality of processors to function as the processing units.

[0069] The setting processing unit 211 sets various setting information for causing the work vehicle 10 to perform automatic traveling. Specifically, the setting processing unit 211 sets information relating to the work vehicle 10 (hereinafter referred to as work vehicle information). The setting processing unit 211 sets information such as the type (model) of the work vehicle 10, the position where the positioning antenna 164 is attached on the work vehicle 10, the type of the work implement 14, the size and shape of the work implement 14, the position of the work implement 14 relative to the work vehicle 10, the vehicle speed and engine speed of the work vehicle 10 during work, and the vehicle speed and engine speed of the work vehicle 10 while turning, by having the worker perform an operation to register the information on the operation terminal 20.

[0070] For example, the setting processing unit 211 causes the operation display unit 23 to display the menu screen D1 shown in Fig. 12. The worker registers the work machine information related to the work machine 14 by selecting, for example, "Work machine registration" on the menu screen D1.

[0071] The setting processing unit 211 also sets information about the field F (hereinafter referred to as field information). The setting processing unit 211 sets information such as the position and shape of the field F, the travel start position S where work begins and the travel end position G where work ends (see FIG. 3), the work direction, etc., by performing an operation to register the information on the operation terminal 20. Note that the work direction means the direction in which the work vehicle 10 travels while working with the work implement 14 in the work area excluding the non-work area of ​​the field F. For example, the worker registers the field information by selecting "Field registration" on the menu screen D1.

[0072] Information on the position and shape of the field F can be automatically acquired, for example, by an operator getting on board the work vehicle 10 and driving it around the perimeter of the field F, and recording the transition of the position information of the positioning antenna 164 at that time. The position and shape of the field F can also be acquired based on a polygon obtained by an operator operating the operation terminal 20 while a map is displayed on the map to specify multiple points on the map. The area specified by the acquired position and shape of the field F is the area in which the work vehicle 10 can be driven (travel area).

[0073] Furthermore, the setting processing unit 211 sets information relating to how the work is to be performed specifically (hereinafter referred to as work information). The setting processing unit 211 is configured to be able to set, as work information, the presence or absence of cooperative work between an unmanned work vehicle 10 and a manned work vehicle 10, the skip number which is the number of work routes to skip when the work vehicle 10 turns on the headland, the width of the headland, and the width of the non-cultivated land, etc. For example, the worker registers work information by selecting "Work registration" on the menu screen D1.

[0074] Further, the setting processing unit 211 generates a target route R, which is a route along which the work vehicle 10 will automatically travel, based on each of the setting information. The target route R is, for example, a work route from a travel start position S to a travel end position G (see FIG. 3). The target route R shown in FIG. 3 includes a straight work route along which the work vehicle 10 travels back and forth in parallel in the inner area Fa of the field F, and a turning route connecting the work routes, and includes a straight work route along which the work vehicle 10 travels in a circle in the headland area Fb, and a turning route connecting the work routes. The setting processing unit 211 generates and stores the target route R for the work vehicle 10 based on each of the setting information. For example, the worker selects "Route Creation" on the menu screen D1 to instruct the generation of the target route R. The setting processing unit 211 is capable of generating and storing a plurality of target routes R according to the work content for one field F.

[0075] The output processing unit 212 outputs route data of the target route R to the work vehicle 10. For example, when a worker selects a desired target route R on the operation screen and issues a work start instruction, the output processing unit 212 outputs the route data of the selected target route R to the work vehicle 10.

[0076] The work vehicle 10 is configured such that route data of the target route R generated in the operation terminal 20 is transferred to the work vehicle 10 and stored in the memory unit 12, and the work vehicle 10 is capable of autonomously traveling along the target route R while detecting the current position of the work vehicle 10 by the positioning antenna 164. The current position of the work vehicle 10 normally coincides with the position of the positioning antenna 164.

[0077] When a predetermined start condition is met and a work start command is given by the worker pressing a work start button on the operation screen, the work vehicle 10 starts automatic driving by the driving processing unit 111 and starts work by the work implement 14 (see FIG. 2). For example, the operation control unit 21 permits automatic driving of the work vehicle 10 on the condition that the current position of the work vehicle 10 is within a predetermined distance from the driving start position S and the vehicle direction is within a predetermined direction. Note that the start condition for permitting automatic driving of the work vehicle 10 is not limited to the above conditions.

[0078] The driving processing unit 111 of the work vehicle 10 automatically drives the work vehicle 10 from the driving start position S to the driving end position G according to the target route R acquired from the operation terminal 20.

[0079] Furthermore, when the operation control unit 21 acquires a detection result indicating that an obstacle has been detected from the work vehicle 10, it may cause the operation terminal 20 to display the detected position of the obstacle on an image captured by the camera.

[0080] The operation terminal 20 may be able to access a website (agricultural support site) of an agricultural support service provided by a server (not shown) via the communication network N1. In this case, the operation terminal 20 can function as an operation terminal for the server by executing a browser program by the operation control unit 21. The server includes the above-mentioned processing units and executes each process.

[0081] [Automatic driving processing] Hereinafter, an example of the automatic driving process executed by the automatic driving system 1 will be described with reference to FIG.

[0082] The present invention can be understood as an invention of an automatic driving method that executes one or more steps included in the automatic driving process. One or more steps included in the automatic driving process described here may be omitted as appropriate. The steps in the automatic driving process may be executed in a different order as long as the same action and effect is achieved. Furthermore, although an example is described here in which the vehicle control device 11 executes each step in the automatic driving process, another embodiment can also be an automatic driving method in which one or more processors execute each step in the automatic driving process in a distributed manner.

[0083] In step S1, the vehicle control device 11 determines whether the work vehicle 10 is in a state capable of autonomous driving. When the work vehicle 10 satisfies the conditions for starting autonomous driving (S1: Yes), the vehicle control device 11 shifts the process to step S2. The vehicle control device 11 waits until the work vehicle 10 satisfies the conditions for starting autonomous driving (S1: No).

[0084] In step S2, the vehicle control device 11 causes the work vehicle 10 to start automatic traveling. For example, when the worker issues a work start instruction on the operation screen of the operation terminal 20, the operation control unit 21 outputs the work start instruction to the work vehicle 10. When the vehicle control device 11 acquires the work start instruction from the operation terminal 20, it causes the work vehicle 10 to start automatic traveling. As a result, the work vehicle 10 starts automatic traveling in the field F according to the target route R (see FIG. 3), and starts work by the work implement 14.

[0085] In step S3, the vehicle control device 11 determines whether or not at least one of a predetermined position deviation and orientation deviation occurs for the work vehicle 10 relative to the target start position. For example, the vehicle control device 11 determines whether or not the deviation (position deviation) of the work vehicle 10 relative to the target start position, which is the start point of the work path, exceeds a predetermined range, and determines whether or not the deviation (orientation deviation) of the vehicle orientation of the work vehicle 10 at the target start position relative to the extension direction of the work path exceeds a predetermined range. The vehicle control device 11 executes the determination process for the start points (target start positions) of the work paths in each of the inner area Fa and the headland area Fb. In addition, the vehicle control device 11 may perform the judgment process based on the positional relationship between the current position and the target start position when the work vehicle 10 actually travels toward the work path, or may perform the judgment process based on the positional relationship between the predicted arrival position and the target start position before the work vehicle 10 travels toward the work path.

[0086] When the vehicle control device 11 determines that at least one of a predetermined positional deviation and orientation deviation occurs for the work vehicle 10 relative to the target start position, i.e., that at least one of the positional deviation and orientation deviation exceeds a predetermined range (S3: Yes), the process proceeds to step S4. On the other hand, when the vehicle control device 11 determines that at least one of the positional deviation and orientation deviation occurs for the work vehicle 10 relative to the target start position, i.e., that both the positional deviation and orientation deviation are within a predetermined range (S3: No), the process proceeds to step S7.

[0087] In step S4, the vehicle control device 11 generates a correction route Rt for correcting the position deviation and the orientation deviation. When only the position deviation is detected, the vehicle control device 11 generates a correction route Rt for correcting the position deviation, when only the orientation deviation is detected, the vehicle control device 11 generates a correction route Rt for correcting the orientation deviation, and when both the position deviation and the orientation deviation are detected, the vehicle control device 11 generates a correction route Rt for correcting both the position deviation and the orientation deviation.

[0088] For example, in the inner area Fa (see FIG. 5), when the positional deviation of the current position P0 from the target start position p7 of the work path R2 exceeds a predetermined range and the azimuth deviation exceeds a predetermined range in the extension direction of the work path R2, the vehicle control device 11 generates a corrected path Rt (see FIGS. 6A, 7, and 8) including a reverse path. Also, for example, the vehicle control device 11 sets a position (p11, etc.) at which reverse traveling and forward traveling are switched so that the positional deviation and the azimuth deviation are within a predetermined range when traveling straight toward the work path R2.

[0089] For example, in the headland area Fb (see Figure 10), when the positional deviation of the current position P0 relative to the target start position p21 of the work path R22 exceeds a predetermined range and the azimuth deviation exceeds a predetermined range in the extension direction of the work path R2, the vehicle control device 11 generates a corrected path Rt (see Figure 11) including a reverse path.

[0090] Next, in step S5, the vehicle control device 11 causes the work vehicle 10 to automatically travel (corrected travel) along the corrected route Rt.

[0091] For example, in the example shown in Figures 6A and 6B, the vehicle control device 11 causes the work vehicle 10 to turn in a reverse direction from the current position P0 (position p10) along a turning path r11, and when the work vehicle 10 reaches position p11 or within a predetermined range (predetermined accuracy) from position p11, causes the work vehicle 10 to travel straight ahead along a straight path r12 in a forward direction.

[0092] In the example shown in FIG. 11, the vehicle control device 11 causes the work vehicle 10 to turn in the reverse direction from the current position P0 (position p30) along a turning path r31, and when the work vehicle reaches position p31, causes the work vehicle 10 to travel straight ahead along a straight path r32.

[0093] Next, in step S6, the vehicle control device 11 determines whether the position deviation and orientation deviation of the work vehicle 10 from the target start position are both within a predetermined range. If the vehicle control device 11 determines that the deviation (position deviation) of the work vehicle 10 from the target start position, which is the start point of the work route, is less than a predetermined distance and that the deviation (orientation deviation) of the vehicle orientation of the work vehicle 10 at the target start position from the extension direction of the work route is less than a predetermined orientation (S6: Yes), the process proceeds to step S7.

[0094] In contrast, if the vehicle control device 11 determines that the deviation (position deviation) of the work vehicle 10 from the target start position, which is the start point of the work route, exceeds a predetermined distance, or that the deviation (orientation deviation) of the vehicle orientation of the work vehicle 10 at the target start position from the extension direction of the work route exceeds a predetermined orientation (S6: No), the process proceeds to step S4. When proceeding to step S4, the vehicle control device 11 executes the corrective driving again. For example, the vehicle control device 11 generates a corrected route Rt again and executes the corrective driving of the work vehicle 10 (see FIG. 8). The vehicle control device 11 repeatedly executes the corrective driving until both the position deviation and the orientation deviation fall within a predetermined range (S6: No).

[0095] When both the position deviation and the orientation deviation fall within a predetermined range, in step S7, the vehicle control device 11 determines whether or not the work vehicle 10 has finished work. For example, when the work vehicle 10 reaches the travel end position G (see FIG. 3), the vehicle control device 11 determines that the work vehicle 10 has finished work (S7: Yes) and ends the automatic driving process. The vehicle control device 11 repeatedly executes the above-mentioned process until the work vehicle 10 reaches the travel end position G (S7: No). In this manner, the vehicle control device 11 executes the automatic driving process.

[0096] In addition, when the vehicle control device 11 generates the corrected path Rt in advance, the vehicle control device 11 may generate the corrected path Rt that does not include a path for moving backward from the position of the position deviation and the azimuth deviation. For example, in the example shown in FIG. 5 and FIG. 6A, it may be difficult to identify the position p10 of the position deviation in advance before the work vehicle 10 turns along the turning path r5. For this reason, when the vehicle control device 11 generates the corrected path Rt in advance, the vehicle control device 11 sets a position p11 at which the work vehicle 10 switches from backward traveling to straight traveling, and generates a path connecting the position p11 and the target start position p7 as the corrected path Rt. Then, the vehicle control device 11 determines whether or not to travel the corrected path Rt based on the position at the time when the work vehicle 10 turns along the turning path r5. In this way, the corrected path Rt does not need to include a path for moving backward from the position of the position deviation and the azimuth deviation.

[0097] As described above, the automatic driving system 1 according to this embodiment is a system that automatically drives the work vehicle 10 according to a preset target route R. The automatic driving system 1 also drives the work vehicle 10 according to a plurality of work routes that cause the work vehicle 10 to perform a predetermined task, and a plurality of turning routes that connect the work routes, which are included in the target route R. When the automatic driving system 1 determines that at least one of a predetermined position deviation and an orientation deviation occurs with respect to the target start position of the work route that follows the turning route when the work vehicle 10 drives the turning route, the automatic driving system 1 causes the work vehicle 10 to perform corrective driving, including reverse driving.

[0098] For example, when the automatic driving system 1 determines that the position deviation will occur, it corrects the driving of the work vehicle 10 so that the distance of the position deviation from the target start position is less than a predetermined distance, and when it determines that the orientation deviation will occur, it corrects the driving of the work vehicle 10 so that the orientation deviation with respect to the extension direction of the work path following the turning path is less than a predetermined orientation.

[0099] According to the above configuration, for example, when the work vehicle 10 moves from the work path R1 to the next work path R2, if it cannot properly reach the start point (target start position p7) of the work path R2 (see FIG. 5), the automatic travel according to the target path R is switched to the corrective travel according to the corrective path Rt, and the position deviation and the azimuth deviation are corrected by reverse travel (see FIG. 6A and FIG. 6B). For example, the position deviation and the azimuth deviation can be easily corrected by setting the reverse travel path to be long or repeating forward and backward travel on the reverse travel path. This allows the work vehicle 10 to properly enter the next work path R2, and therefore makes it possible to perform appropriate work from the start point of the work path R2. Thus, according to the above configuration of the present invention, it is possible to properly allow the work vehicle 10 to enter the work path following the turning path.

[0100] [Other embodiments] The present invention is not limited to the above-described embodiment, and other embodiments of the present invention will be described below.

[0101] When the vehicle control device 11 determines that the corrective travel is necessary for each of a predetermined number of work routes, it may notify the worker of that fact. For example, when corrective travel is performed for each of the work routes R1 and R2, and it is determined that at least one of a predetermined position deviation and orientation deviation will occur on the subsequent work route R3, the vehicle control device 11 transmits a message to the operation terminal 20 indicating that corrective travel is being performed frequently. When the worker checks the message, he or she checks the state of the field, the positioning state of the positioning unit 16 of the work vehicle 10, etc.

[0102] As another embodiment of the present invention, the vehicle control device 11 may adjust the travel speed during the correction travel. For example, when the vehicle control device 11 performs the correction travel of the work vehicle 10, the vehicle control device 11 performs the turning travel at a speed slower than the turning speed of the reverse turn set in advance. The vehicle control device 11 may set the speeds of both the turning travel and the forward travel included in the correction travel to a low speed, or may set only the turning travel to a low speed. The vehicle control device 11 may also set the vehicle speed during the correction travel according to the amount of deviation (distance difference) of the position deviation and the amount of deviation (azimuth difference) of the azimuth deviation. For example, the vehicle speed during the correction travel may be slower as the amount of deviation is larger. By adjusting the vehicle speed during the correction travel, the position deviation and the azimuth deviation are easily corrected.

[0103] As another embodiment of the present invention, the vehicle control device 11 may adjust the turning radius during the corrective travel. For example, when the vehicle control device 11 causes the work vehicle 10 to perform the corrective travel, the vehicle control device 11 causes the work vehicle 10 to perform the corrective travel with a turning radius smaller than a preset turning radius. The vehicle control device 11 may also set the turning radius during the corrective travel in accordance with the amount of deviation (distance difference) of the position deviation and the amount of deviation (azimuth difference) of the azimuth deviation. For example, the turning radius during the corrective travel may be made smaller as the amount of deviation increases. By adjusting the turning radius during the corrective travel, the position deviation and the azimuth deviation can be easily corrected, and the corrective route can be shortened.

[0104] In the above embodiment, for example, when the headland area Fb is narrow and a single correction run does not bring the position deviation and orientation deviation within a predetermined range, the correction processing unit 112 is configured to repeatedly execute the correction run multiple times (see FIG. 8). However, if the condition of the field F is poor or the position accuracy is low, it is possible that the position deviation and orientation deviation will not fall within the predetermined range even if the correction run is executed multiple times. Repeating the correction run unnecessarily many times can cause problems such as the field being damaged or work efficiency decreasing.

[0105] Therefore, as another embodiment, the upper limit number of the number of the correction travels may be set in advance. For example, the worker sets the upper limit number of the number of the correction travels on a setting screen (not shown) of the operation terminal 20. When the upper limit number is set, the vehicle control device 11 stops the correction travel when the number of the correction travels reaches the upper limit number and notifies the worker. For example, as shown in FIG. 14, when the number of the correction travels reaches the upper limit number, the vehicle control device 11 stops the automatic travel and transmits a message to the effect that the automatic travel has been stopped ("The number of the position adjustment travels has reached the upper limit, so the automatic travel will be stopped. Please confirm.") to the operation terminal 20 and displays it. The operation control unit 21 of the operation terminal 20 displays the message on the travel screen D2 that displays the travel status. When the worker confirms the message, he or she goes to the place where the work vehicle 10 has stopped to check the state of the field or switches to manual travel. For example, the worker switches to manual travel and moves the work vehicle 10 to the start of the next work route to resume automatic travel.

[0106] In another embodiment, the vehicle control device 11 may execute a specific process different from the correction driving when at least one of the position deviation and the azimuth deviation occurs with respect to the target start position at the time when the number of correction driving reaches the upper limit number.

[0107] The specific processing is, for example, processing to make the inner area Fa smaller (narrower). For example, when the area for performing the correction travel cannot be sufficiently secured because the preset headland area Fb is narrow, and the number of times of the correction travel reaches the upper limit number, the vehicle control device 11 executes processing to narrow the inner area Fa and widen the headland area Fb. In this way, when the position shift and the orientation shift occur, for example, the work vehicle 10 can correct the position shift and the orientation shift by performing the correction travel a small number of times. Note that the vehicle control device 11 may make the change (reduction) of the range of the inner area Fa a conditional on the permission of the worker. If the worker gives permission, the vehicle control device 11 narrows the inner area Fa and performs the correction travel, and if the worker refuses, the vehicle control device 11 stops the correction travel without changing the inner area Fa.

[0108] An example of an automatic driving process having a function for executing the specific process is shown in Fig. 15. In Fig. 15, steps S1 to S7 are the same as steps S1 to S7 in Fig. 13, with steps S21 and S22 being added.

[0109] Specifically, when the vehicle control device 11 determines that the deviation (position deviation) of the work vehicle 10 from the target start position, which is the start point of the work route, exceeds a predetermined range, or the deviation (orientation deviation) of the vehicle orientation of the work vehicle 10 at the target start position from the extension direction of the work route exceeds a predetermined range (S6: No), the vehicle control device 11 determines whether the number of correction travels has reached the upper limit number of times in step S21. When the vehicle control device 11 determines that the number of correction travels has reached the upper limit number of times (S21: Yes), the vehicle control device 11 shifts the process to step S22. On the other hand, when the vehicle control device 11 determines that the number of correction travels has not reached the upper limit number of times (S21: No), the vehicle control device 11 shifts the process to step S4 and executes the correction travel again. When the position deviation and the orientation deviation are not within the predetermined range (S6: No), the vehicle control device 11 repeatedly executes the correction travel until the number of correction travels reaches the upper limit number of times (S21: No).

[0110] In step S22, the vehicle control device 11 executes the specification process. For example, the vehicle control device 11 executes a process of narrowing the inner area Fa and widening the headland area Fb. After executing the specification process, the vehicle control device 11 shifts the process to step S7. If the work is to be continued after the specification process (S7: No), the vehicle control device 11 executes a process of determining the position deviation and the azimuth deviation (S3), a process of correcting the deviation (S4, S5), and the like in the narrowed inner area Fa.

[0111] According to the above configuration, by performing corrective driving while dynamically changing the size of the working area, it is possible to perform automatic driving and work while correcting the position deviation and the azimuth deviation.

[0112] Here, in the same field F, the work vehicle 10 may perform a plurality of different tasks in sequence. For example, in the field F, the work vehicle 10 may perform plowing (first task) and then ridge making (second task), or perform ridge making (first task) and then sowing and transplanting (second task). In this way, when the work vehicle 10 is made to perform the first task and the second task in the field F, the vehicle control device 11 may make the work vehicle 10 perform the second task based on the information of the specific processing. For example, when the vehicle control device 11 narrows the inner area Fa during the first task, during the second task, the vehicle control device 11 makes the work vehicle 10 perform automatic travel, work, corrective travel, and the like in the inner area Fa narrowed during the first task.

[0113] In another embodiment, the vehicle control device 11 may omit the second work for the area of ​​the work area of ​​the first work that is located outside the narrowed work area. For example, when the work vehicle 10 performs a ridge-making work and then performs a seeding work in the narrowed area of ​​the inner area Fa, the vehicle control device 11 executes the seeding work while ignoring the worked area where the ridges have been made in the area outside the narrowed inner area Fa. In this case, seeds are not sown or transplanted in the ridge portion located outside the inner area Fa. Note that if there is no effect even if the ridges located outside the inner area Fa are stepped on, the ridges outside the inner area Fa may be stepped on in a later work. Also, it may be possible to set sowing and transplanting to be performed on the ridges located outside the narrowed inner area Fa.

[0114] In addition, for any portion where the work position of the previous job (first job) and the planned work position of the subsequent job (second job) do not overlap, the work vehicle 10 may ignore the non-overlapping portion and perform the subsequent job.

[0115] As another embodiment of the present invention, information on corrected travel may be registered in association with a location in the field. For example, the vehicle control device 11 registers a corrected route Rt (see FIGS. 6A and 6B) in association with the headland region Fb (two opposing sides) of the field F, and registers a corrected route Rt (see FIG. 11) in association with the corners (four corners) of the field F. In this case, the vehicle control device 11 may cause the work vehicle 10 to perform corrected travel based on the information on the corrected route Rt registered in advance.

[0116] Incidentally, in order for the work vehicle 10 to properly enter the work path, it is necessary that the position deviation and the orientation deviation are within a predetermined range (tolerance range) at a predetermined position before the target start position. In other words, the work vehicle 10 can properly (for example, straight) enter the work path if the position deviation and the orientation deviation are within a predetermined range at least at the predetermined position. That is, the predetermined position is a deadline (position to be determined) for determining whether the work vehicle 10 can properly enter the work path. For this reason, the vehicle control device 11 executes the determination process when the work vehicle 10 actually reaches the determination position, or executes the determination process assuming that the work vehicle 10 has reached the determination position.

[0117] Here, the distance to the target start position may differ depending on the type of work vehicle 10, the type of work implement 14, the mounting position of the work implement 14, etc. For example, when the work implement 14 is mounted at the front of the work vehicle 10 (such as a combine harvester), the distance from the work implement 14 to the target start position is shorter than when the work implement 14 is mounted at the rear of the work vehicle 10 (such as a tractor or rice transplanter). The shorter the distance from the work implement 14 to the target start position, the more difficult it becomes to correct the position deviation and the orientation deviation.

[0118] Therefore, the vehicle control device 11 may be configured to set the determination target position depending on the mounting position of the work implement 14, the type of the work implement 14, the type of the work vehicle 10, etc. For example, when the work implement 14 is mounted at the front of the work vehicle 10, the vehicle control device 11 sets the determination target position further forward (at a position farther from the target start position) compared to when the work implement 14 is mounted at the rear of the work vehicle 10. This makes it possible to cause the work vehicle 10 to appropriately enter the work path regardless of the mounting position of the work implement 14, the type of the work implement 14, or the type of the work vehicle 10.

[0119] [Notes on the invention] The following will provide an overview of the invention extracted from the above-described embodiments. Note that the configurations and processing functions described in the following supplementary notes can be selected and combined as desired.

[0120] <Appendix 1> An automatic driving method for automatically driving a work vehicle along a preset target route, comprising: causing the work vehicle to travel along a plurality of work paths that are included in the target route and that cause the work vehicle to perform a predetermined work, and a plurality of turning paths that connect the work paths; When the work vehicle travels along the turning path, when it is determined that at least one of a predetermined position deviation and an orientation deviation occurs with respect to a target start position of the work path following the turning path, the work vehicle is caused to perform a corrective travel including a reverse travel. An automated driving method that performs the above.

[0121] <Appendix 2> When it is determined that the position deviation will occur, the work vehicle is caused to travel in a corrective manner so that the distance of the position deviation from the target start position becomes equal to or less than a predetermined distance. When it is determined that the orientation deviation will occur, the work vehicle is caused to travel in a corrective manner so that the orientation deviation with respect to the extension direction of the work path following the turning path is equal to or smaller than a predetermined orientation. 2. An automated driving method as described in appendix 1.

[0122] <Appendix 3> After the corrected travel, the work vehicle is caused to travel forward in a straight line toward the target start position. 2. An automated driving method as described in appendix 2.

[0123] <Appendix 4> generating a corrected route different from the target route when it is determined that at least one of the position deviation and the orientation deviation will occur, and causing the work vehicle to travel in a corrected manner according to the corrected route; 4. The automatic driving method according to claim 1,

[0124] <Appendix 5> The upper limit number of times the work vehicle is caused to travel for correction can be set in advance. 5. The automatic driving method according to any one of claims 1 to 4.

[0125] <Appendix 6> When the position deviation and the orientation deviation do not fall within a predetermined range at the time when the number of times the work vehicle is made to make the corrective travel reaches the upper limit number of times, a specific process different from the corrective travel is executed. 6. The automated driving method according to claim 5.

[0126] <Appendix 7> The specification process is a process of reducing a working area located inside an area in which the turning path is set. 7. The automated driving method according to claim 6.

[0127] <Appendix 8> When causing the work vehicle to perform a first task and a second task subsequent to the first task in a work area, causing the work vehicle to perform the second task based on information of the specified processing. 8. The automated driving method according to claim 6 or 7.

[0128] <Appendix 9> When the work vehicle is caused to perform a first task and a second task subsequent to the first task in a working area, the second task is omitted in an area of ​​the working area of ​​the first task that is located outside the working area obtained by reducing the first task. 8. The automated driving method according to claim 7.

[0129] <Appendix 10> when the position deviation and the orientation deviation fall within a predetermined range midway through the corrected path while the work vehicle is performing the corrected traveling according to the corrected path, the corrected traveling is terminated and the work vehicle is caused to travel forward in a straight line toward the target start position. 5. The automated driving method according to claim 4. [Explanation of symbols]

[0130] 1:Autonomous driving system 10: Work vehicle 11: Vehicle control device 12: Storage section 13: Running gear 14: Work equipment 15: Communications Department 16: Positioning unit 20: Operation terminal 21: Operation control section 22: Storage section 23: Operation display section 24: Communications Department 111: Driving processing unit 112: Correction processing unit F: Field Fa: inner area Fb: Headland area R: Target route R1: Work path R2: Working route Ra: Inner working path Rb: Headland work route Rs1: Turning path Rs2: Turning path Rt: Correction path p7 :Target start position p21:Target start position

Claims

1. An automatic driving method for automatically driving a work vehicle along a preset target route, comprising: causing the work vehicle to travel along a plurality of work paths that are included in the target route and that cause the work vehicle to perform a predetermined work, and a plurality of turning paths that connect the work paths; When the work vehicle travels along the turning path, when it is determined that at least one of a predetermined position deviation and an orientation deviation occurs with respect to a target start position of the work path following the turning path, the work vehicle is caused to perform a corrective travel including a reverse travel. An automated driving method that performs the above.

2. When it is determined that the position deviation will occur, the work vehicle is caused to travel in a corrective manner so that the distance of the position deviation from the target start position becomes equal to or less than a predetermined distance. When it is determined that the orientation deviation will occur, the work vehicle is caused to travel in a corrective manner so that the orientation deviation with respect to the extension direction of the work path following the turning path is equal to or smaller than a predetermined orientation. The automatic driving method according to claim 1.

3. After the corrected travel, the work vehicle is caused to travel forward in a straight line toward the target start position. The automatic driving method according to claim 2.

4. generating a corrected route different from the target route when it is determined that at least one of the position deviation and the orientation deviation will occur, and causing the work vehicle to travel in a corrected manner according to the corrected route; The automatic driving method according to claim 1.

5. The upper limit number of times the work vehicle is caused to travel for correction can be set in advance. The automatic driving method according to claim 1.

6. When the position deviation and the orientation deviation do not fall within a predetermined range at the time when the number of times the work vehicle is made to make the corrective travel reaches the upper limit number of times, a specific process different from the corrective travel is executed. The automatic driving method according to claim 5.

7. The specification process is a process of reducing a working area located inside an area in which the turning path is set. The automatic driving method according to claim 6.

8. When causing the work vehicle to perform a first task and a second task subsequent to the first task in a work area, causing the work vehicle to perform the second task based on information of the specific processing. The automatic driving method according to claim 6 or 7.

9. When the work vehicle is caused to perform a first task and a second task subsequent to the first task in a working area, the second task is omitted in an area of ​​the working area of ​​the first task that is located outside a working area obtained by reducing the working area of ​​the first task. The automatic driving method according to claim 7.

10. when the position deviation and the orientation deviation fall within a predetermined range midway through the corrected path while the work vehicle is performing the corrected traveling according to the corrected path, the corrected traveling is terminated and the work vehicle is caused to travel forward in a straight line toward the target start position. The automatic driving method according to claim 4.

11. An automatic driving program for automatically driving a work vehicle along a preset target route, causing the work vehicle to travel along a plurality of work paths that are included in the target route and that cause the work vehicle to perform a predetermined work, and a turning path that connects the plurality of work paths; When the work vehicle travels along the turning path, when it is determined that at least one of a predetermined position deviation and an orientation deviation occurs with respect to a target start position of the work path following the turning path, the work vehicle is caused to perform a corrective travel including a reverse travel. An automated driving program for executing the above on one or more processors.

12. An automatic driving system that automatically drives a work vehicle according to a preset target route, a travel processing unit that causes the work vehicle to travel along a plurality of work routes that are included in the target route and that cause the work vehicle to perform a predetermined work, and a plurality of turning routes that connect the work routes; a correction processing unit that, when it is determined that at least one of a predetermined position deviation and an orientation deviation occurs with respect to a target start position of the work path following the turning path when the work vehicle travels along the turning path, causes the work vehicle to perform a correction travel including reverse travel; An automated driving system equipped with

Citation Information

Patent Citations

  • Route production system

    JP2018147421A