Autonomous driving method, automatic driving system, and automatic driving program

The automatic driving system for work vehicles switches between GNSS-based and lidar-based modes with adjustable tolerance values to prevent stops, addressing efficiency losses from positional deviations, thereby maintaining continuous operation in crop environments.

JP7588035B2Active Publication Date: 2024-11-21YANMAR HLDG CO LTD
View PDF 6 Cites 0 Cited by

Patent Information

Application Number
JP2021091523
Authority / Receiving Office
JP · JP
Patent Type
Patents
Current Assignee / Owner
Filing Date
2021-05-31
Publication Date
2024-11-21
Estimated Expiration
2041-05-31

AI Technical Summary

Technical Problem

Existing automatic driving systems for work vehicles face efficiency losses due to frequent stopping when positional deviations exceed tolerance values, particularly in areas where crops are not planted, leading to reduced work efficiency.

Method used

The system switches between two driving modes: a target route mode using GNSS for open areas and a crop row mode using lidar for planted areas, with adjustable tolerance values to prevent unnecessary stops by allowing larger deviations during mode transitions.

Benefits of technology

This approach maintains continuous operation by allowing larger positional deviations during mode switches, preventing unnecessary stops and enhancing work efficiency by ensuring the vehicle can adapt to changing crop environments.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 0007588035000001
    Figure 0007588035000001
  • Figure 0007588035000002
    Figure 0007588035000002
  • Figure 0007588035000003
    Figure 0007588035000003
Patent Text Reader

Abstract

To provide an automatic travel method, an automatic travel system and an automatic travel program, capable of preventing work efficiency from deteriorating through inhibiting a stop operation of a work vehicle resulting from a location deviation of the work vehicle.SOLUTION: An automatic travel method executes: making a work vehicle 10 travel in a target route travel mode M1; making the work vehicle 10 travel in a crop row route travel mode M2; stopping the work vehicle 10 if a location deviation exceeds a tolerance in the target route travel mode M1, and stopping the work vehicle 10 if a location deviation exceeds a tolerance in the crop row route travel mode M2; and when switching from one travel mode of the target route travel mode M1 and the crop row route travel mode M2 to the other travel mode, changing a tolerance corresponding to the other travel mode to a second tolerance larger than a first tolerance set to the other travel mode before the travel mode is switched.SELECTED DRAWING: Figure 14
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present invention relates to an automatic driving method, an automatic driving system, and an automatic driving program for automatically driving a work vehicle along a target route in a driving area. [Background technology]

[0002] There is known a work vehicle that automatically travels along a target route while spraying a chemical solution on crops planted in a work area such as a farm or a farmer (see, for example, Patent Document 1). The target route is generated, for example, by connecting both end points of each row of multiple rows of crops (crop rows). [Prior art documents] [Patent documents]

[0003] [Patent Document 1] International Publication No. 2015 / 119266 Summary of the Invention [Problem to be solved by the invention]

[0004] For example, when the work vehicle travels in an area where crops are grown, the work vehicle travels along a crop row path set according to the position of the crops while locating the position of the work vehicle using a signal (e.g., GNSS signal) received from a satellite. On the other hand, when the work vehicle travels in an area where crops are not grown, the work vehicle travels along a preset target path while locating the position of the work vehicle using the GNSS signal. Here, a tolerance is set for each of the distance (position deviation) from the target path to the work vehicle and the distance (position deviation) from the crop row path to the work vehicle. If the position deviation exceeds the tolerance, the position accuracy of the work vehicle decreases, and the travel of the work vehicle is stopped.

[0005] For example, when a work vehicle is traveling through a crop row and is unable to detect the crop, the work vehicle travels using the GNSS signal. In this case, if the position deviation at the time when the work vehicle is unable to detect the crop is equal to or greater than the allowable value corresponding to the target route, the work vehicle stops and the work is interrupted. This causes a problem of reduced work efficiency.

[0006] An object of the present invention is to provide an automatic driving method, an automatic driving system, and an automatic driving program that are capable of preventing a decrease in work efficiency by suppressing stopping operations of a work vehicle caused by position deviation of the work vehicle. [Means for solving the problem]

[0007] The automatic driving method of the present invention is a method of executing the following steps in a driving area: driving a work vehicle in a first driving mode in which the work vehicle automatically drives along a predetermined target route based on positioning information of the work vehicle; driving the work vehicle in a second driving mode in which the work vehicle automatically drives along a work object route set in accordance with the position of a work object placed within the driving area; stopping the work vehicle in the first driving mode when a position deviation representing the distance between the current position of the work vehicle and the target route is equal to or greater than a tolerance value corresponding to the first driving mode, and stopping the work vehicle in the second driving mode when a position deviation representing the distance between the current position of the work vehicle and the work object route is equal to or greater than a tolerance value corresponding to the second driving mode; switching between the first driving mode and the second driving mode; and, when switching from one of the first driving mode and the second driving mode to the other driving mode, changing the tolerance value corresponding to the other driving mode to a second tolerance value that is greater than a first tolerance value set for the other driving mode before the driving mode is switched.

[0008] The automatic driving system according to the present invention includes a driving processing unit, a switching processing unit, and a setting processing unit. The driving processing unit drives the work vehicle in a first driving mode in which the work vehicle automatically drives along a preset target route based on positioning information of the work vehicle in a driving area, or in a second driving mode in which the work vehicle automatically drives along a work object route set according to the position of a work object placed in the driving area, and stops the work vehicle in the first driving mode when a position deviation representing the distance between the current position of the work vehicle and the target route is equal to or greater than a tolerance corresponding to the first driving mode, and stops the work vehicle in the second driving mode when a position deviation representing the distance between the current position of the work vehicle and the work object route is equal to or greater than a tolerance corresponding to the second driving mode. The switching processing unit switches between the first driving mode and the second driving mode. When the driving mode is switched from one of the first driving mode and the second driving mode to the other driving mode, the setting processing unit changes the tolerance value corresponding to the other driving mode to a second tolerance value that is greater than the first tolerance value set for the other driving mode before the driving mode was switched.

[0009] The automatic driving program of the present invention is a program for causing one or more processors to execute the following: driving a work vehicle in a first driving mode in a driving area in which the work vehicle automatically drives along a predetermined target route based on positioning information of the work vehicle; driving the work vehicle in a second driving mode in which the work vehicle automatically drives along a work object route set in accordance with the position of a work object placed within the driving area; stopping the work vehicle in the first driving mode when a position deviation representing the distance between the current position of the work vehicle and the target route is equal to or greater than a tolerance value corresponding to the first driving mode, and stopping the work vehicle in the second driving mode when a position deviation representing the distance between the current position of the work vehicle and the work object route is equal to or greater than a tolerance value corresponding to the second driving mode; switching between the first driving mode and the second driving mode; and, when switching from one of the first driving mode and the second driving mode to the other driving mode, changing the tolerance value corresponding to the other driving mode to a second tolerance value that is greater than the first tolerance value set for the other driving mode before the driving mode was switched. Effect of the Invention

[0010] According to the present invention, it is possible to provide an automatic driving method, an automatic driving system, and an automatic driving program that are capable of preventing a decrease in work efficiency by suppressing the stopping operation of a work vehicle caused by a position deviation of the work vehicle. [Brief description of the drawings]

[0011] [Figure 1] FIG. 1 is a schematic diagram showing the overall configuration of an automated driving system according to an embodiment of the present invention. [Diagram 2] FIG. 2 is a block diagram showing a configuration of an automatic driving system according to an embodiment of the present invention. [Diagram 3] FIG. 3 is an external view of the work vehicle according to the embodiment of the present invention, as viewed from the left front side. [Figure 4A]FIG. 4A is a left side external view of the work vehicle according to the embodiment of the present invention as viewed from the left side. [Figure 4B] FIG. 4B is an external view of the right side of the work vehicle according to the embodiment of the present invention as viewed from the right side. [Figure 4C] FIG. 4C is a rear external view of the work vehicle according to the embodiment of the present invention as viewed from the rear side. [Diagram 5] FIG. 5 is a diagram showing an example of a crop row according to an embodiment of the present invention. [Figure 6] FIG. 6 is a diagram showing an example of a target route according to an embodiment of the present invention. [Figure 7] FIG. 7 is a diagram for explaining an overview of a traveling method in the crop row path traveling mode according to an embodiment of the present invention. [Figure 8] FIG. 8 is a diagram showing an example of a travel route of a work vehicle when switching the travel mode according to an embodiment of the present invention. [Figure 9A] FIG. 9A is a diagram showing an example of a traveling method of the work vehicle according to the embodiment of the present invention. [Figure 9B] FIG. 9B is a diagram showing an example of a traveling method of the work vehicle according to the embodiment of the present invention. [Figure 9C] FIG. 9C is a diagram showing an example of a traveling method of the work vehicle according to the embodiment of the present invention. [Figure 10] FIG. 10 is a diagram showing an example of the tolerance information used in the automatic driving system according to the embodiment of the present invention. [Figure 11] FIG. 11 is a diagram showing an example of a travel route of a work vehicle when switching the travel mode according to an embodiment of the present invention. [Figure 12] FIG. 12 is a diagram showing an example of a traveling method of the work vehicle according to the embodiment of the present invention. [Figure 13A] FIG. 13A is a diagram for explaining a method for generating a target route according to an embodiment of the present invention. [Figure 13B] FIG. 13B is a diagram for explaining a method for generating a target route according to an embodiment of the present invention. [Figure 14]FIG. 14 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. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

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

[0013] [Autonomous Driving System 1] 1 and 2, an automated driving system 1 according to an embodiment of the present invention includes a work vehicle 10, an operation terminal 20, a base station 40, and a satellite 50. 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.

[0014] In this embodiment, the work vehicle 10 will be described as a vehicle that performs spraying work to spray a chemical solution, water, etc. on a crop V (see FIG. 5) planted in a field F. The field F is an example of a traveling area of ​​the present invention, and the field F is, for example, an orchard such as a vineyard or an apple orchard. The crop V is, for example, a grape tree. The spraying work is, for example, a work of spraying a chemical solution, water, or other spray material on the crop V. In other embodiments, the work vehicle 10 may be a vehicle that performs weeding work, a vehicle that performs leaf cutting work, or a vehicle that performs harvesting work.

[0015] The crops V are arranged in multiple rows at predetermined intervals in the field F. Specifically, as shown in FIG. 5, the multiple crops V are planted linearly in a predetermined direction (direction D1), forming a crop row Vr including the multiple crops V arranged in a straight line. FIG. 5 illustrates three crop rows Vr. Each crop row Vr is arranged at a predetermined interval W1 in the row direction (direction D2). The area (space) of the interval W2 between adjacent crop rows Vr becomes a work passageway where the work vehicle 10 performs spraying work on the crops V while traveling in the direction D1.

[0016] The work vehicle 10 is also capable of automatic travel (autonomous travel) along a preset target route R. For example, as shown in FIG. 6, the work vehicle 10 automatically travels from a work start position S to a work end position G along a target route R including a work route R1 (work routes R1a to R1f) and a movement route R2. The work route R1 is a linear route along which the work vehicle 10 performs spraying work on the crop V, and the movement route R2 is a route along which the work vehicle 10 moves between the crop rows Vr without performing spraying work. The movement route R2 includes, for example, a turning route and a straight route. In the example shown in FIG. 6, a crop V consisting of crop rows Vr1 to Vr11 is arranged in a field F. In FIG. 6, the position where the crop V is planted (crop position) is represented by "Vp". Furthermore, the work vehicle 10 traveling in the field F in Fig. 6 has a vehicle body 100 having a gate-like shape (see Fig. 4C), and while traveling across one crop row Vr, sprays a chemical solution on the crops V in that crop row Vr and on the crop rows Vr adjacent to that crop row Vr. For example, as shown in Fig. 6, when the work vehicle 10 travels across a crop row Vr5, the left body (left side part 100L) of the work vehicle 10 travels on the work passage between the crop rows Vr4, Vr5, and the right body (right side part 100R) of the work vehicle 10 travels on the work passage between the crop rows Vr5, Vr6, and sprays a chemical solution on the crops V in the crop rows Vr4, Vr5, and Vr6.

[0017] The work vehicle 10 also travels automatically in a predetermined row order. For example, the work vehicle 10 travels across the crop row Vr1, then across the crop row Vr3, and then across the crop row Vr5. In this way, the work vehicle 10 travels automatically according to a preset order of the crop rows Vr. The work vehicle 10 may travel every other row in the order of the crop rows Vr, or every several rows.

[0018] The satellite 50 is a positioning satellite that constitutes a satellite positioning system such as the Global Navigation Satellite System (GNSS), and transmits a GNSS signal (satellite signal). The base station 40 is a reference point (reference station) that constitutes the satellite positioning system. The base station 40 transmits correction information to the work vehicle 10 for calculating the current position of the work vehicle 10.

[0019] The positioning device 16 mounted on the work vehicle 10 executes positioning processing to calculate the current position (latitude, longitude, altitude) and current direction of the work vehicle 10 using the GNSS signal transmitted from the satellite 50. Specifically, the positioning device 16 locates the position of the work vehicle 10 using an RTK (Real Time Kinematic) method or the like that locates the position of the work vehicle 10 based on positioning information (GNSS signals, etc.) received by two receivers (antenna 164 and base station 40) and correction information generated by the base station 40. The positioning method is a well-known technology, so a detailed description will be omitted.

[0020] Hereinafter, each of the components constituting the automated driving system 1 will be described in detail.

[0021] [Work vehicle 10] Fig. 3 is an external view of the work vehicle 10 as viewed from the left front side. Fig. 4A is an external view of the left side of the work vehicle 10 as viewed from the left side, Fig. 4B is an external view of the right side of the work vehicle 10 as viewed from the right side, and Fig. 4C is an external view of the rear of the work vehicle 10 as viewed from the rear side.

[0022] 1 to 4, the work vehicle 10 includes a vehicle control device 11, a memory unit 12, a traveling device 13, a spraying device 14, a communication unit 15, a positioning device 16, an obstacle detection device 17, etc. The vehicle control device 11 is electrically connected to the memory unit 12, the traveling device 13, the spraying device 14, the positioning device 16, the obstacle detection device 17, etc. The vehicle control device 11 and the positioning device 16 may be capable of wireless communication.

[0023] The communication unit 15 is a communication interface for connecting the work vehicle 10 to the communication network N1 by wire or wirelessly, and for executing data communication in accordance with a predetermined communication protocol with external devices such as the operation terminal 20 via the communication network N1.

[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 a control program such as an automatic driving program for causing the vehicle control device 11 to execute an automatic driving process (see FIG. 14) 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 route data including information on a target route R generated in the operation terminal 20. For example, the route data is transferred from the operation terminal 20 to the work vehicle 10 and stored in the storage unit 12.

[0025] Here, the work vehicle 10 is equipped with a gate-shaped vehicle body 100 that travels across crops V (fruit trees) planted in multiple rows in a farm field F. As shown in Fig. 4C, the vehicle body 100 is formed in a gate shape with a left side part 100L, a right side part 100R, and a connection part 100C that connects the left side part 100L and the right side part 100R, and a space 100S that allows the crops V to pass through is secured inside the left side part 100L, the right side part 100R, and the connection part 100C.

[0026] A crawler 101 is provided at the lower end of each of the left side 100L and right side 100R of the vehicle body 100. An engine (not shown), a battery (not shown), etc. are provided on the left side 100L. A storage tank 14A (see FIG. 4B) of the spraying device 14 and the like are provided on the right side 100R. In this way, by distributing and arranging the components on the left side 100L and right side 100R of the vehicle body 100, the work vehicle 10 is balanced left and right and has a low center of gravity. As a result, the work vehicle 10 can travel stably on slopes of the field F.

[0027] The traveling device 13 is a drive unit that drives the work vehicle 10. The traveling device 13 includes an engine, crawlers 101, and the like.

[0028] The left and right crawlers 101 are driven by power from the engine in a state where independent speed changes are possible by a hydrostatic continuously variable transmission. As a result, the vehicle body 100 is in a forward state moving straight forward in the forward direction when the left and right crawlers 101 are driven at a constant speed in the forward direction, and in a reverse state moving straight backward in the reverse direction when the left and right crawlers 101 are driven at a constant speed in the reverse direction. The vehicle body 100 is in a forward turning state where it turns while moving forward when the left and right crawlers 101 are driven at unequal speeds in the forward direction, and in a reverse turning state where it turns while moving backward when the left and right crawlers 101 are driven at unequal speeds in the reverse direction. The vehicle body 100 is in a pivot turning state when one of the left and right crawlers 101 is stopped and the other crawler 101 is driven, and in a spin turning state when the left and right crawlers 101 are driven at a constant speed in the forward direction and the reverse direction. Furthermore, the vehicle body 100 comes to a stop moving state by stopping the driving of the left and right crawlers 101. The left and right crawlers 101 may be configured as an electrically driven type driven by an electric motor.

[0029] As shown in FIG. 4C, the spraying device 14 includes a storage tank 14A for storing the chemical solution etc., a spraying pump (not shown) for pressure-pumping the chemical solution etc., an electric spraying motor (not shown) for driving the spraying pump, a belt-type transmission device (not shown) for transmitting power from the spraying motor to the spraying pump, spraying pipes 14B arranged in parallel, two on each side, in a vertical position on the back of the vehicle body 100, a total of 12 spraying nozzles 14C, three on each spraying pipe 14B, an electronically controlled valve unit (not shown) for changing the amount and pattern of spraying of the chemical solution etc., and a plurality of spraying pipes (not shown) connecting these together.

[0030] Each spray nozzle 14C is attached to the corresponding spray pipe 14B so that its position can be changed in the up-down direction. This allows each spray nozzle 14C to change the interval between adjacent spray nozzles 14C and its height position relative to the spray pipe 14B depending on the object to be sprayed (crop V). Also, each spray nozzle 14C is attached so that its height position and left-right position relative to the vehicle body 100 can be changed depending on the object to be sprayed.

[0031] In the spraying device 14, the number of spray nozzles 14C provided on each spray pipe 14B can be changed in various ways depending on the type of crop V, the length of each spray pipe 14B, and the like.

[0032] As shown in FIG. 4C, among the multiple spray nozzles 14C, the three spray nozzles 14C provided on the leftmost spray pipe 14B spray the chemical solution to the left toward the crop Va located on the left outer side of the vehicle body 100. Among the multiple spray nozzles 14C, the three spray nozzles 14C provided on the left inner spray pipe 14B adjacent to the leftmost spray pipe 14B spray the chemical solution to the right toward the crop Vb located in the space 100S in the center of the left and right of the vehicle body 100. Among the multiple spray nozzles 14C, the three spray nozzles 14C provided on the rightmost spray pipe 14B spray the chemical solution to the right toward the crop Vc located on the right outer side of the vehicle body 100. Of the multiple spray nozzles 14C, the three spray nozzles 14C provided on the right inner spray pipe 14B adjacent to the rightmost spray pipe 14B spray the chemical solution leftward toward the crop Vb located in the space 100S.

[0033] With the above-mentioned configuration, in the spraying device 14, the two spraying pipes 14B and six spraying nozzles 14C provided on the left side 100L of the vehicle body 100 function as the left spraying section 14L. Also, the two spraying pipes 14B and six spraying nozzles 14C provided on the right side 100R of the vehicle body 100 function as the right spraying section 14R. The left and right spraying sections 14L, 14R are arranged at the rear of the vehicle body 100 with a left-right interval between them that allows the crop Vb to pass through (space 100S) while spraying in the left and right directions.

[0034] In the spraying device 14, the spraying patterns produced by the spraying sections 14L, 14R include a four-way spraying pattern in which each of the spraying sections 14L, 14R sprays the chemical solution in both the left and right directions, and a directional limited spraying pattern in which the spraying direction by the spraying sections 14L, 14R is limited. The direction-limited spray patterns include a left side three-way spray pattern in which spraying part 14L sprays the chemical liquid in both the left and right directions and spraying part 14R sprays the chemical liquid only in the left direction; a right side three-way spray pattern in which spraying part 14L sprays the chemical liquid only in the right direction and spraying part 14R sprays the chemical liquid in both the left and right directions; a two-way spray pattern in which spraying part 14L sprays the chemical liquid only in the right direction and spraying part 14R sprays the chemical liquid only in the left direction; a left side one-way spray pattern in which spraying part 14L sprays the chemical liquid only in the left direction and spraying part 14R does not spray the chemical liquid; and a right side one-way spray pattern in which spraying part 14R sprays the chemical liquid only in the right direction and spraying part 14L does not spray the chemical liquid.

[0035] The vehicle body 100 is equipped with an automatic travel control unit that automatically travels the vehicle body 100 along a target route R in the field F based on positioning information acquired from the positioning device 16, an engine control unit that controls the engine, an HST (Hydro-Static Transmission) control unit that controls the hydrostatic continuously variable transmission, and an implement control unit that controls the implements such as the spraying device 14. Each control unit is constructed by an electronic control unit equipped with a microcontroller, and various information and control programs stored in a non-volatile memory (for example, an EEPROM such as a flash memory) of the microcontroller. The various information stored in the non-volatile memory may include a target route R generated in advance. In this embodiment, each control unit is collectively referred to as a "vehicle control device 11" (see FIG. 2).

[0036] The positioning device 16 is a communication device including a positioning control unit 161, a memory unit 162, a communication unit 163, and an antenna 164. The antennas 164 are provided in front and behind the ceiling (connection unit 100C) of the vehicle body 100 (see FIG. 3). Also, the ceiling of the vehicle body 100 is provided with indicator lights 102 that display the traveling state of the work vehicle 10 (see FIG. 3). The battery is connected to the positioning device 16, and the positioning device 16 can operate even when the engine is stopped.

[0037] The communication unit 163 is a communication interface for connecting the positioning device 16 to the communication network N1 in a wired or wireless manner and for executing data communication with an external device such as the base station 40 via the communication network N1 in accordance with a predetermined communication protocol.

[0038] The antenna 164 is an antenna that receives radio waves (GNSS signals) transmitted from satellites. Since the antennas 164 are provided at the front and rear of the work vehicle 10, the current position and current orientation of the work vehicle 10 can be determined with high accuracy.

[0039] The positioning control unit 161 is a computer system including one or more processors, and storage memories such as non-volatile memory and RAM. The storage unit 162 is a non-volatile memory that stores a control program for causing the positioning control unit 161 to execute positioning processing, and data such as positioning information and movement information. The positioning control unit 161 measures the current position and current orientation of the work vehicle 10 using a predetermined positioning method (such as the RTK method) based on the GNSS signal received by the antenna 164 from the satellite 50.

[0040] The obstacle detection device 17 includes a lidar sensor 171L provided on the front left side of the vehicle body 100, and a lidar sensor 171R provided on the front right side of the vehicle body 100 (see FIG. 3). Each lidar sensor measures the distance from the lidar sensor to each ranging point (measurement object) within the measurement range, for example, by a Time Of Flight (TOF) method that measures the distance to a ranging point based on the round-trip time it takes for laser light emitted by the lidar sensor to reach the ranging point and return.

[0041] The measurement range of the lidar sensor 171L is set to a predetermined range on the front left side of the vehicle body 100, and the measurement range of the lidar sensor 171R is set to a predetermined range on the front right side of the vehicle body 100. Each lidar sensor transmits measurement information such as the measured distance to each ranging point and the scanning angle (coordinates) for each ranging point to the vehicle control device 11.

[0042] The obstacle detection device 17 also includes left and right ultrasonic sensors 172F (see FIG. 3) provided on the front side of the vehicle body 100, and left and right ultrasonic sensors 172R (see FIGS. 4A to 4C) provided on the rear side of the vehicle body 100. Each ultrasonic sensor measures the distance from the ultrasonic sensor to the measurement object using a TOF method that measures the distance to a ranging point based on the round-trip time it takes for ultrasonic waves emitted by the ultrasonic sensor to reach the ranging point and return.

[0043] The front left ultrasonic sensor 172F has a measurement range set to a predetermined range on the front left side of the vehicle body 100, the front right ultrasonic sensor 172F has a measurement range set to a predetermined range on the front right side of the vehicle body 100, the rear left ultrasonic sensor 172R has a measurement range set to a predetermined range on the rear left side of the vehicle body 100, and the rear right ultrasonic sensor 172R has a measurement range set to a predetermined range on the rear right side of the vehicle body 100. Each ultrasonic sensor transmits measurement information including the measured distance to the measurement object and the direction of the measurement object to the vehicle control device 11.

[0044] The obstacle detection device 17 also includes left and right contact sensors 173F (see FIG. 3) provided on the front side of the vehicle body 100, and left and right contact sensors 173R (see FIGS. 4A and 4B) provided on the rear side of the vehicle body 100. A spraying device 14 is provided in front of each contact sensor (on the rear side of the work vehicle 10), and each contact sensor detects an obstacle by moving the spraying device 14 rearward (on the front side of the work vehicle 10) when an obstacle comes into contact with the spraying device 14. When an obstacle is detected, each contact sensor transmits a detection signal to the vehicle control device 11. Based on the measurement information on the obstacle acquired from the obstacle detection device 17, the vehicle control device 11 executes an avoidance process to avoid the obstacle when there is a possibility that the work vehicle 10 will collide with the obstacle. The vehicle control device 11 also performs an operation to detect the position deviation and orientation deviation of the work vehicle 10 and avoid a collision with the crop row Vr.

[0045] 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 (work area) for various types of processing executed by the CPU. The vehicle control device 11 controls the work vehicle 10 by executing, with the CPU, various control programs that are stored in advance in the ROM or the storage unit 12.

[0046] The vehicle control device 11 controls the traveling of the work vehicle 10. Specifically, as shown in FIG. 2, the vehicle control device 11 includes various processing units such as a traveling processing unit 111, a switching processing unit 112, and a setting processing unit 113. The vehicle control device 11 functions as the various processing units by executing various processes in accordance with the control program using the CPU. Some or all of the processing units may be configured with electronic circuits. The control program may be a program for causing multiple processors to function as the processing units.

[0047] The driving processing unit 111 executes driving processing to control the driving operation of the work vehicle 10. For example, the driving processing unit 111 drives the work vehicle 10 in a target route driving mode M1 (corresponding to the first driving mode of the present invention) that automatically drives the work vehicle 10 along the target route R based on positioning information including the position and direction of the work vehicle 10 measured by the positioning device 16. For example, when the positioning state is in a state where RTK positioning is possible in an area where the crop V is not placed (headland area, non-work area, etc.), the driving processing unit 111 starts automatic driving of the work vehicle 10 in the target route driving mode M1 based on the positioning information of the work vehicle 10 measured by the positioning device 16. As a result, the work vehicle 10 starts automatic driving along the target route R. Note that the positioning state being in a state where RTK positioning is possible (high accuracy state) is included in the conditions for the work vehicle 10 to start automatic driving (automatic driving start condition).

[0048] In this way, the travel processing unit 111 causes the work vehicle 10 to automatically travel in the target route travel mode M1 in an area (such as a headland area) where no crops V are grown in the field F. The work vehicle 10 travels along the target route R while estimating its own position using GNSS signals.

[0049] The travel processing unit 111 also causes the work vehicle 10 to travel in a crop row path travel mode M2 ​​(corresponding to the second travel mode of the present invention) in which the work vehicle 10 automatically travels along the crop row path R0 set according to the position of the crop V arranged in the field F. The crop row path travel mode M2 ​​is a travel mode in which the work vehicle 10 travels along the crop row path R0 estimated based on the measurement results of the lidar sensors 171L and 171R, for example. Specifically, the obstacle detection device 17 integrates the detection results of obstacles on the work path R1 and the measurement results of the lidar sensors 171L and 171R to estimate the work path R1 straddled by the work vehicle 10, specifically the crop row path R0 (an example of the work object path of the present invention) of the crop row (crop row Vr5 in FIG. 6). The obstacle detection device 17 also transmits the positions (coordinates) of the start and end points of the estimated crop row path R0 to the vehicle control device 11. In crop row path traveling mode M2, the traveling processing unit 111 uses GNSS signals to estimate its own position and automatically drives the work vehicle 10 along the estimated crop row path R0. In this way, in target path traveling mode M1, the traveling processing unit 111 automatically drives the work vehicle 10 along the target path R using the positioning information, while in crop row path traveling mode M2, the traveling processing unit 111 automatically drives the work vehicle 10 along the crop row path R0 using the positioning information and the detection results of the crop V.

[0050] Fig. 7 shows an overview of the driving method of the crop row path driving mode M2. In Fig. 7, R0 represents the path of the estimated crop row Vra, Ev1 represents the start point of the crop row Vra, Ev2 represents the end point of the crop row Vra, Vp represents a crop included in the crop row Vra, and Pe represents the current position of the work vehicle 10. Note that the end point Ev2 may be the same as the end point (end point) shown in Fig. 6. Also, the start point Ev1 is, for example, the position of the crop V included in the crop row Vra that is closest to the current position Pe.

[0051] The travel processing unit 111 calculates the lateral position deviation L1 and azimuth deviation θ1 of the work vehicle 10 relative to the crop row Vra, and causes the work vehicle 10 to travel from the current position Pe to the end point Ev2 while controlling the attitude of the work vehicle 10 so as to reduce the position deviation L1 and azimuth deviation θ1.

[0052] Here, since the estimation result of the crop row Vra contains errors, it is preferable to perform filtering processing using a moving average filter, a low-pass filter, etc. on the calculated position deviation L1 and azimuth deviation θ1. Then, it is preferable that the travel processing unit 111 controls the travel of the work vehicle 10 using the results of the filtering processing.

[0053] In addition, in order to improve the accuracy of estimating the crop row Vra, the results of estimating the crop row Vra in the past may be used. In this case, it is necessary to increase the number of end points of the crop row Vra, and in order to use past data, it is necessary to calculate the relative movement amount of the work vehicle 10 and convert the coordinates of the detection positions of the past crop row Vra. The calculation of the relative movement amount is performed by integrating data from a rotation speed sensor and an inertial measurement unit (IMU) attached to the crawler 101 using a known method such as a Kalman filter to estimate the movement amount of the crop row Vra. Since the distance to the end point is calculated from the positioning information (GNSS position information) every control cycle while the work vehicle 10 is traveling automatically, the travel processing unit 111 executes a process of determining whether the end point of the crop row Vra has been reached (end point Ev2) based on information on the distance to the end point before the positioning accuracy falls below a predetermined accuracy and the estimated movement amount of the work vehicle 10, and causes the work vehicle 10 to travel automatically until the end point is reached. Note that, depending on the arrangement state of the crop V, a situation may occur in which the lidar sensors 171L and 171R cannot detect the crop V. In this case, the travel processing unit 111 ends the automatic travel in the crop row path travel mode M2 ​​when an estimation error for the crop row Vra occurs a specified number of times in succession.

[0054] As described above, the travel processing unit 111 automatically drives the work vehicle 10 in the target route travel mode M1 or the crop row route travel mode M2 ​​depending on the position of the crop V in the field F.

[0055] In addition, the driving processing unit 111 stops the work vehicle 10 in the target route driving mode M1 when the position deviation representing the distance between the current position Pe of the work vehicle 10 and the target route R is equal to or greater than the tolerance corresponding to the target route driving mode M1, and stops the work vehicle 10 in the crop row route driving mode M2 ​​when the position deviation representing the distance between the current position Pe of the work vehicle 10 and the crop row route R0 is equal to or greater than the tolerance corresponding to the crop row route driving mode M2.

[0056] The switching processing unit 112 switches the travel mode of the work vehicle 10 between the target route travel mode M1 and the crop row route travel mode M2. That is, the switching processing unit 112 sets the travel mode of the work vehicle 10. For example, when the obstacle detection device 17 does not detect the crop V based on the detection results of the LIDAR sensors 171L, 171R, the switching processing unit 112 sets the travel mode of the work vehicle 10 to the target route travel mode M1. Also, when the obstacle detection device 17 detects the crop V based on the detection results of the LIDAR sensors 171L, 171R, the switching processing unit 112 sets the travel mode of the work vehicle 10 to the crop row route travel mode M2.

[0057] For example, when the work vehicle 10 enters an area where no crops V are placed while traveling in the crop row path traveling mode M2, the work vehicle 10 switches to the target path traveling mode M1 and travels. Fig. 8 shows an example of the travel path of the work vehicle 10 when switching the travel mode.

[0058] In the field F shown in FIG. 8, the crop row Vr5 through which the work vehicle 10 is traveling includes an area in which no crop V is placed. In this case, when the work vehicle 10 reaches the area (current position Pe in FIG. 8) by automatically traveling through the crop row Vr5 in the crop row path traveling mode M2, the obstacle detection device 17 no longer detects the crop V ahead. As a result, the work vehicle 10 is no longer able to travel along the crop row path R0 corresponding to the crop row Vr5, so the switching processing unit 112 switches the traveling mode from the crop row path traveling mode M2 ​​to the target path traveling mode M1. As a result, the work vehicle 10 switches from automatic traveling along the crop row path R0 to automatic traveling along the target path R (work path R1) using the GNSS signal.

[0059] When the travel mode is switched from the crop row path travel mode M2 ​​to the target path travel mode M1, the following problems may occur.

[0060] FIG. 9A shows the work vehicle 10 automatically traveling along the crop row path R0. Here, the setting processing unit 113 sets the tolerance Tw1 corresponding to the target path traveling mode M1 and the tolerance Tw0 corresponding to the crop row path traveling mode M2. FIG. 10 shows an example of the tolerance information F1 including information on the tolerance corresponding to each traveling mode. For example, in the crop row path traveling mode M2, the traveling processing unit 111 automatically travels the work vehicle 10 when the distance W0 (position deviation) from the current position Pe to the crop row path R0 is less than the tolerance Tw0 (for example, 15 cm), and stops the work vehicle 10 when the distance W0 is equal to or greater than the tolerance Tw0. In the state shown in FIG. 9A, since the distance W0 is less than the tolerance Tw0, the traveling processing unit 111 automatically travels the work vehicle 10 in the crop row path traveling mode M2. That is, the work vehicle 10 automatically travels along the crop row path R0 while using the GNSS signal.

[0061] Here, when the obstacle detection device 17 is unable to detect the crops V ahead (see FIG. 8), the switching processing unit 112 switches the driving mode of the work vehicle 10 to the target route driving mode M1. In this case, the driving processing unit 111 automatically drives the work vehicle 10 when the distance W1 (position deviation) from the current position Pe to the target route R is less than the allowable value Tw1 (for example, 15 cm), and stops the work vehicle 10 when the distance W1 is equal to or greater than the allowable value Tw1. Here, as shown in FIG. 9B, the distance W1 is equal to or greater than the allowable value Tw1, so the driving processing unit 111 stops the work vehicle 10. In this way, if the position deviation of the work vehicle 10 (distances W0, W1 in FIG. 9A) is equal to or greater than the allowable value corresponding to the driving mode to which the mode is switched (allowable values ​​Tw0, Tw1 in FIG. 9A) when the driving mode is switched, the work vehicle 10 stops, causing a problem of interrupting work.

[0062] Therefore, when the driving mode is switched from one of the target route driving mode M1 and the crop row route driving mode M2 ​​to the other, the setting processing unit 113 according to the present embodiment changes the tolerance corresponding to the other driving mode to a second tolerance value that is greater than the first tolerance value set for the other driving mode before the driving mode is switched. In the example shown in FIG. 9B, when the driving mode is switched from the crop row route driving mode M2 ​​to the target route driving mode M1, the setting processing unit 113 changes the tolerance corresponding to the target route driving mode M1 to a tolerance value Tw1' (e.g., 25 cm) that is greater than the preset tolerance value Tw1 (15 cm). Note that the tolerance value Tw1' set when the driving mode is switched may be registered in advance in the tolerance value information F1 (see FIG. 10). The setting processing unit 113 changes (sets) the tolerance corresponding to the target route driving mode M1 to the tolerance value Tw1' (25 cm) by referring to the tolerance value information F1. The tolerance Tw1' (25 cm) is, for example, a value obtained by adding a tolerance (10 cm) for position deviation (position deviation) with respect to the crop row path R0 to a preset tolerance Tw1 (15 cm). The tolerance Tw1 (15 cm) is an example of a first tolerance of the present invention, and the tolerance Tw1' (25 cm) is an example of a second tolerance of the present invention.

[0063] When the tolerance value corresponding to the target route driving mode M1 is changed to the tolerance value Tw1', as shown in Fig. 9B, the distance W1 becomes less than the tolerance value Tw1', and the driving processing unit 111 is therefore able to cause the work vehicle 10 to automatically drive in the target route driving mode M1 without stopping the work vehicle 10. That is, the work vehicle 10 performs automatic driving along the target route R while using the GNSS signal. In addition, the driving processing unit 111 causes the work vehicle 10 to drive along the target route R while controlling the attitude of the work vehicle 10 so that the distance W1 (position deviation) is small.

[0064] When the driving mode is switched to the target route driving mode M1 and the work vehicle 10 drives along the target route R and the distance W1 falls below a preset tolerance value Tw1 (15 cm) as shown in Fig. 9C, the setting processing unit 113 changes the tolerance value corresponding to the target route driving mode M1 from the tolerance value Tw1' (25 cm) to the tolerance value Tw1 (15 cm). When the tolerance value corresponding to the target route driving mode M1 is changed to the tolerance value Tw1, the work vehicle 10 continues automatic driving using the tolerance value Tw1.

[0065] The timing at which the setting processing unit 113 changes the allowable value corresponding to the target route travel mode M1 from the allowable value Tw1' to the allowable value Tw1 is not limited to the above embodiment. As another embodiment, for example, the setting processing unit 113 may change the allowable value Tw1' (25 cm) to the allowable value Tw1 (15 cm) when the distance W1 (position deviation) becomes less than a predetermined value (e.g., 10 cm) smaller than the allowable value Tw1 (15 cm) after the travel mode is switched from the crop row route travel mode M2 ​​to the target route travel mode M1 and the work vehicle 10 starts traveling in the target route travel mode M1. This makes it possible to reliably suppress the position deviation of the work vehicle 10 to be less than the allowable value, thereby preventing the work vehicle 10 from stopping immediately after the travel mode is switched.

[0066] In another embodiment, for example, the setting processing unit 113 may change the tolerance Tw1' (25 cm) to the tolerance Tw1 (15 cm) when a predetermined time has elapsed since the driving mode is switched from the crop row path driving mode M2 ​​to the target path driving mode M1 and the work vehicle 10 starts traveling in the target path driving mode M1. The predetermined time is set, for example, to the time required for the distance W1 (position deviation) to become smaller than the tolerance Tw1 (15 cm). This ensures that the position deviation of the work vehicle 10 is kept below the tolerance, thereby preventing the work vehicle 10 from stopping immediately after the driving mode is switched.

[0067] However, it is conceivable that the position deviation of the work vehicle 10 will be equal to or greater than the changed tolerance value when the driving mode is switched. In this case, the position accuracy of the work vehicle 10 cannot be guaranteed, so automatic driving is interrupted and the work vehicle 10 is stopped. For example, in FIG. 9B, if the distance W1 is equal to or greater than the tolerance value Tw1' when the driving mode is switched to the target route driving mode M1 or when the tolerance value is changed to the tolerance value Tw1', the driving processing unit 111 stops the work vehicle 10. In this case, the vehicle control device 11 may notify the operation terminal 20 of abnormality information.

[0068] 8 and 9A to 9C illustrate an example of a configuration in which the switching processing unit 112 switches from the crop row path traveling mode M2 ​​to the target path traveling mode M1. In contrast, FIGS. 11 and 12 illustrate an example of a configuration in which the switching processing unit 112 switches from the target path traveling mode M1 to the crop row path traveling mode M2. For example, when the work vehicle 10 enters an area where crops V are arranged while traveling in the target path traveling mode M1 and the obstacle detection device 17 detects the crops V ahead (see FIG. 11), the traveling processing unit 111 estimates the crop row path R0. In addition, the switching processing unit 112 switches the traveling mode of the work vehicle 10 from the target path traveling mode M1 to the crop row path traveling mode M2.

[0069] Furthermore, the setting processing unit 113 changes the tolerance corresponding to the crop row path travel mode M2 ​​to a tolerance Tw0' (25 cm) that is greater than the preset tolerance Tw0 (15 cm) (see Figs. 10 and 12). The tolerance Tw0' (25 cm) is, for example, a value obtained by adding a tolerance (10 cm) of a position deviation (positional deviation) with respect to the crop row path R0 to the preset tolerance Tw0 (15 cm). The tolerance Tw0 (15 cm) is an example of a first tolerance of the present invention, and the tolerance Tw0' (25 cm) is an example of a second tolerance of the present invention. The tolerance Tw0 and the tolerance Tw1 may be the same value or different values. The tolerance Tw0' and the tolerance Tw1' may be the same value or different values.

[0070] When the tolerance value corresponding to the crop row path travel mode M2 ​​is changed to the tolerance value Tw0', as shown in Fig. 12, the distance W0 becomes less than the tolerance value Tw0', and the travel processing unit 111 is able to automatically travel the work vehicle 10 in the crop row path travel mode M2 ​​without stopping the work vehicle 10. That is, the work vehicle 10 performs automatic travel along the crop row path R0 while using the GNSS signal. In addition, the travel processing unit 111 causes the work vehicle 10 to travel along the crop row path R0 while controlling the attitude of the work vehicle 10 so that the distance W0 (position deviation) is small.

[0071] As described above, the switching processing unit 112 switches the driving mode M1 for the target route to the driving mode M2 ​​for the crop row route when the work vehicle 10 detects a crop V (work object) while traveling in the driving mode M1 for the target route, and switches the driving mode M2 ​​for the crop row route to the driving mode M1 for the target route when the work vehicle 10 is unable to detect a crop V while traveling in the driving mode M2 ​​for the crop row route.

[0072] In addition, the driving processing unit 111 automatically drives the work vehicle 10 in a driving mode M1 for a target route in areas of the field F where crops V are not planted, and automatically drives the work vehicle 10 in a driving mode M2 ​​for a crop row route in areas of the field F where crops V are planted.

[0073] When the driving processing unit 111 receives a driving stop instruction from the operation terminal 20, it stops the automatic driving of the work vehicle 10. For example, when the operator presses the stop button on the operation screen of the operation terminal 20, the operation terminal 20 outputs the driving stop instruction to the work vehicle 10. When the driving processing unit 111 receives the driving stop instruction from the operation terminal 20, it stops the automatic driving of the work vehicle 10. As a result, the work vehicle 10 stops the automatic driving and the spraying work by the spraying device 14 stops.

[0074] The above-mentioned configuration of the work vehicle 10 is one example of the configuration of the work vehicle of the present invention, and the present invention is not limited to the above-mentioned configuration. The above-mentioned work vehicle 10 is a vehicle that can perform a spraying operation of spraying a spraying material on the first crop row Vr and the second crop rows Vr on the left and right sides of the first crop row Vr while traveling across the first crop row Vr. As another embodiment, the work vehicle 10 may have a normal shape in which the vehicle body 100 does not have a gate-shaped shape, but the entire vehicle body 100 travels between the crop rows Vr (work passage). In this case, the work vehicle 10 automatically travels through each work passage in order without straddling the crop rows Vr. In addition, the spraying device 14 has one spraying unit, and performs a spraying operation by switching between a spraying pattern in which the chemical solution is sprayed in both the left and right directions, a spraying pattern in which the chemical solution is sprayed only in the left direction, and a spraying pattern in which the chemical solution is sprayed only in the right direction.

[0075] [Operation terminal 20] 2, the operation terminal 20 is an information processing device including a 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.

[0076] 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.

[0077] 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 operator 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 operator can also operate the operation unit to give instructions to the work vehicle 10 to start work and stop traveling. Furthermore, the operator can grasp the traveling state, work situation, and surrounding situation of the work vehicle 10 that automatically travels in the field F according to the target route R from the traveling trajectory and the surrounding image of the vehicle body 100 displayed on the operation terminal 20 at a location away from the work vehicle 10.

[0078] The storage unit 22 is a non-volatile storage unit such as an HDD or SSD that stores various information. The storage unit 22 stores control programs such as an automatic driving program for causing the control unit 21 to execute an automatic driving process (see FIG. 14) described later. For example, the automatic driving 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 automatic driving 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.

[0079] The control unit 21 has control devices such as a CPU, a ROM, and a RAM. The CPU is a processor that executes various 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 arithmetic processing 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 control unit 21 controls the operation terminal 20 by executing, by the CPU, various control programs stored in advance in the ROM or the storage unit 22.

[0080] As shown in Fig. 2, the control unit 21 includes various processing units such as a setting processing unit 211, a route generation processing unit 212, and an output processing unit 213. The 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.

[0081] The setting processing unit 211 sets and registers information about the work vehicle 10 (hereinafter referred to as work vehicle information), information about the field F (hereinafter referred to as field information), and information about work (here, spraying work) (hereinafter referred to as work information).

[0082] In the process of setting the work vehicle information, the setting processing unit 211 sets information such as the model of the work vehicle 10, the position where the antenna 164 is attached on the work vehicle 10, the type of work implement (here, the spraying device 14), the size and shape of the work implement, the position of the work implement relative to the work vehicle 10, the vehicle speed and engine RPM of the work vehicle 10 while working, and the vehicle speed and engine RPM of the work vehicle 10 while turning, by the operator performing an operation to register the information on the operation terminal 20. In this embodiment, information related to the spraying device 14 is set as the information on the work implement.

[0083] In the field information setting process, the setting processing unit 211 sets information such as the position and shape of the field F, the work start position S where work begins and the work end position G where work ends (see FIG. 6), the work direction, etc., by the operator 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 performing spraying work with the spraying device 14 in the work area, which is the area of ​​the field F excluding non-work areas such as headland.

[0084] Information on the position and shape of the field F can be automatically acquired, for example, by an operator manually driving the work vehicle 10 around the perimeter of the field F and recording the transition of the position information of the antenna 164 at that time. The position and shape of the field F can also be acquired based on a polygon obtained by the operator operating the operation terminal 20 while a map is displayed on the map and specifying 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).

[0085] In the process of setting the work information, the setting processing unit 211 is configured to be able to set, as work information, the skip number, which is the number of work routes that the work vehicle 10 skips when turning on the headland, the width of the headland, etc.

[0086] The route generation processing unit 212 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 route from a work start position S to a work end position G (see FIG. 6). The target route R shown in FIG. 6 includes a linear work route R1 for spraying a chemical solution on the crops V in an area where the crops V are planted, and a movement route R2 for moving between the crop rows Vr without performing spraying work.

[0087] An example of a method for generating the target route R will be described with reference to Figs. 13A and 13B. Fig. 13A shows a schematic diagram of a crop row Vr. First, the operator manually drives the work vehicle 10 along the outer periphery of the crop row Vr (see Fig. 13A). The work vehicle 10 detects an end point E1 on one side (lower side of Fig. 13A) and an end point E2 on the other side (upper side of Fig. 13A) of each crop row Vr while driving, and acquires position information (coordinates) of each end point E1, E2. The end points E1, E2 may be the positions of the crops V that have already been planted, or may be the positions of targets indicating the positions of the crops V to be planted in the future. When the path generation processing unit 212 acquires the position information (coordinates) of each end point E1, E2 from the work vehicle 10, it sets a line L1 (see Fig. 13B) connecting the corresponding end points E1, E2 to the work route of the crop row Vr, and generates a target route R including a plurality of work routes and movement routes (turning routes). The method of generating the target route R is not limited to the above-mentioned method. The route generation processing unit 212 may store the generated target route R in the storage unit 22.

[0088] The output processing unit 213 outputs route data including information on the target route R generated by the route generation processing unit 212 to the work vehicle 10. The output processing unit 213 may output the route data to a server (not shown). The server stores and manages the multiple route data acquired from each of the multiple operation terminals 20 in association with the operation terminals 20 and the work vehicle 10.

[0089] In addition to the above-mentioned processing, the control unit 21 executes processing for displaying various information on the operation display unit 23. For example, the control unit 21 causes the operation display unit 23 to display a registration screen for registering work vehicle information, field information, work information, etc., an operation screen for generating a target route R, an operation screen for causing the work vehicle 10 to start automatic traveling, a display screen for displaying the traveling state of the work vehicle 10, etc.

[0090] The control unit 21 also accepts various operations from the operator. Specifically, the control unit 21 accepts from the operator a work start instruction to cause the work vehicle 10 to start work, a travel stop instruction to cause the work vehicle 10 to stop traveling during automatic traveling, etc. When the control unit 21 accepts each of the instructions, it outputs each of the instructions to the work vehicle 10.

[0091] When the vehicle control device 11 of the work vehicle 10 receives a work start instruction from the operation terminal 20, it starts the automatic traveling and spraying work of the work vehicle 10. In addition, when the vehicle control device 11 receives a traveling stop instruction from the operation terminal 20, it stops the automatic traveling and spraying work of the work vehicle 10.

[0092] The operation terminal 20 may be able to access a website (agricultural support site) of an agricultural support service provided by the server 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 control unit 21.

[0093] [Automatic driving processing] Hereinafter, an example of the automatic driving process executed by the vehicle control device 11 of the work vehicle 10 will be described with reference to FIG.

[0094] 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.

[0095] In step S1, the vehicle control device 11 determines whether or not a work start instruction has been acquired from the operation terminal 20. For example, when the operator presses the start button on the operation terminal 20, the operation terminal 20 outputs a work start instruction to the work vehicle 10. When the vehicle control device 11 acquires a work start instruction from the operation terminal 20 (S1: Yes), the process proceeds to step S2. The vehicle control device 11 waits until it acquires a work start instruction from the operation terminal 20 (S1: No).

[0096] In step S2, the vehicle control device 11 starts automatic driving in a predetermined driving mode. For example, when the vehicle control device 11 receives a work start instruction from the operation terminal 20, detects the crop V, and estimates the crop row path R0, it sets the driving mode to a crop row path driving mode M2. Then, the vehicle control device 11 starts automatic driving along the crop row path R0 based on the positioning information (RTK positioning information) of the work vehicle 10. The vehicle control device 11 also causes the spraying device 14 to start a spraying operation to spray a chemical solution on the crop row Vr.

[0097] Next, in step S3, the vehicle control device 11 determines whether the position deviation of the work vehicle 10 is equal to or greater than a preset allowable value corresponding to a predetermined travel mode. Here, the vehicle control device 11 determines whether the position deviation (distance W0) of the work vehicle 10 (see FIG. 9A) is equal to or greater than the allowable value Tw0 (15 cm) (see FIG. 10) corresponding to the crop row path travel mode M2. If the position deviation is equal to or greater than the predetermined allowable value (S3: Yes), the process proceeds to step S31. On the other hand, if the position deviation is less than the predetermined allowable value (S3: No), the process proceeds to step S4.

[0098] In step S4, the vehicle control device 11 determines whether or not to switch the driving mode. For example, when the vehicle control device 11 stops detecting the crop V while traveling in the crop row path driving mode M2 ​​while detecting the crop V, the vehicle control device 11 determines to switch the driving mode to the target route driving mode M1. If the vehicle control device 11 determines to switch the driving mode (S4: Yes), the process proceeds to step S5. On the other hand, if the vehicle control device 11 determines not to switch the driving mode (S4: No), the process proceeds to step S11.

[0099] In step S5, the vehicle control device 11 determines whether the position deviation of the work vehicle 10 is equal to or greater than the tolerance of the destination driving mode. For example, the vehicle control device 11 determines whether the position deviation (distance W1) of the work vehicle 10 (see FIG. 9A) is equal to or greater than the tolerance Tw1 (15 cm) (see FIG. 10) of the destination driving mode M1 for the target route. If the position deviation of the work vehicle 10 is equal to or greater than the tolerance of the destination driving mode (S5: Yes), the process proceeds to step S6. On the other hand, if the position deviation of the work vehicle 10 is less than the tolerance of the destination driving mode (S5: No), the process proceeds to step S8.

[0100] In step S6, the vehicle control device 11 changes the tolerance of the driving mode to a tolerance greater than the tolerance set for the driving mode before the driving mode is switched. For example, the vehicle control device 11 changes the tolerance corresponding to the target route driving mode M1 to a tolerance Tw1' (25 cm) (see FIGS. 9 and 10) greater than the preset tolerance Tw1 (15 cm).

[0101] Next, in step S7, the vehicle control device 11 determines whether the position deviation of the work vehicle 10 is less than the allowable value after the change to the destination driving mode. For example, the vehicle control device 11 determines whether the position deviation (distance W1) of the work vehicle 10 (see FIG. 9B) is less than the allowable value Tw1' (25 cm) (see FIG. 10) after the change to the target route driving mode M1. If the position deviation of the work vehicle 10 is less than the allowable value after the change to the destination driving mode (S7: Yes), the process proceeds to step S8. On the other hand, if the position deviation of the work vehicle 10 is equal to or greater than the allowable value after the change to the destination driving mode (S7: No), the process proceeds to step S31.

[0102] In step S8, the vehicle control device 11 continues the automatic driving in the switched driving mode. For example, the vehicle control device 11 continues the automatic driving of the work vehicle 10 in the target route driving mode M1.

[0103] Next, in step S9, the vehicle control device 11 determines whether the position deviation of the work vehicle 10 is less than the allowable value before the change of the driving mode to be switched to. For example, the vehicle control device 11 determines whether the position deviation (distance W1) of the work vehicle 10 (see FIG. 9B) has become less than the allowable value Tw1 (15 cm) (see FIG. 10) before the change of the target route driving mode M1. If the position deviation of the work vehicle 10 has become less than the allowable value before the change of the target route driving mode (S9: Yes) (see FIG. 9C), the process proceeds to step S10. The vehicle control device 11 continues automatic driving in the target route driving mode M1 until the position deviation of the work vehicle 10 becomes less than the allowable value before the change of the target route driving mode (S9: No).

[0104] Next, in step S10, the vehicle control device 11 changes the tolerance of the destination driving mode from the changed tolerance to the tolerance before the change. For example, the vehicle control device 11 changes the tolerance corresponding to the target route driving mode M1 from the tolerance Tw1' (25 cm) to a preset tolerance Tw1 (15 cm) (see FIG. 9C).

[0105] In step S11, the vehicle control device 11 determines whether the work vehicle 10 has finished work. The vehicle control device 11 determines that work has been completed when the position of the work vehicle 10 coincides with the work end position G (see FIG. 6). If the work vehicle 10 has finished work (S11: Yes), the automatic driving process ends.

[0106] The vehicle control device 11 repeats the processing of steps S3 to S10 until the work vehicle 10 finishes the work (S11: No). For example, if the vehicle control device 11 detects a crop V while the work vehicle 10 is traveling in the target route travel mode M1 (see FIG. 12), the vehicle control device 11 switches the travel mode to the crop row route travel mode M2 ​​(S3, S4). In addition, the vehicle control device 11 changes the tolerance corresponding to the crop row route travel mode M2 ​​to a tolerance Tw0' (25 cm) that is greater than a preset tolerance Tw0 (15 cm), and the work vehicle 10 continues to travel automatically in the crop row route travel mode M2 ​​(S5 to S8). In addition, when the position deviation (distance W0) (see Figure 12) of the work vehicle 10 becomes less than the pre-change tolerance Tw0 (15 cm) (see Figure 10) of the crop row path driving mode M2, the vehicle control device 11 changes the tolerance corresponding to the crop row path driving mode M2 ​​from the tolerance Tw0' (25 cm) to a preset tolerance Tw0 (15 cm) (S9, S10).

[0107] In step S31, the vehicle control device 11 stops the work vehicle 10 and ends the automatic driving process. The vehicle control device 11 also notifies the operation terminal 20 of warning information.

[0108] As described above, the automatic driving system 1 according to this embodiment drives the work vehicle 10 in a driving area (for example, a field F) in a target route driving mode M1 (first driving mode) in which the work vehicle 10 automatically drives along a preset target route R based on the positioning information of the work vehicle 10, and drives the work vehicle 10 in a crop row route driving mode M2 ​​(second driving mode) in which the work vehicle 10 automatically drives along a work object route (crop row route R0) set according to the position of a work object (crop V) placed within the driving area. In addition, the automatic driving system 1 stops the work vehicle 10 in the first driving mode when a position deviation representing a distance W0 between the current position Pe of the work vehicle 10 and the target route R is equal to or greater than a tolerance Tw0 corresponding to the first driving mode, and stops the work vehicle 10 in the second driving mode when a position deviation representing a distance W1 between the current position Pe of the work vehicle 10 and the work object route is equal to or greater than a tolerance Tw1 corresponding to the second driving mode. Furthermore, the automated driving system 1 switches between the first driving mode and the second driving mode. When the automated driving system 1 switches from one of the first driving mode and the second driving mode to the other driving mode, the automated driving system 1 changes the permissible value corresponding to the other driving mode to a second permissible value that is greater than the first permissible value set for the other driving mode before the driving mode is switched.

[0109] Furthermore, the automatic driving method according to this embodiment includes the steps of: driving the work vehicle 10 in a first driving mode in a driving area in which the work vehicle 10 automatically drives along a preset target route based on positioning information of the work vehicle 10; driving the work vehicle 10 in a second driving mode in which the work vehicle 10 automatically drives along a work object route set in accordance with the position of a work object placed within the driving area; and, when a position deviation indicating a distance between the current position of the work vehicle 10 and the target route is equal to or greater than a tolerance value corresponding to the first driving mode in the first driving mode, causing the work vehicle 10 to automatically drive. the first driving mode and the second driving mode when a position deviation indicating a distance between the current position of the work vehicle 10 and the work object path is equal to or greater than a tolerance corresponding to the second driving mode; switching between the first driving mode and the second driving mode; and, when switching from one of the first driving mode and the second driving mode to the other driving mode, changing the tolerance corresponding to the other driving mode to a second tolerance value that is greater than the first tolerance value set for the other driving mode before the driving mode is switched.

[0110] According to the above configuration, when the driving mode of the work vehicle 10 is switched, the allowable value of the driving mode to be switched to is changed to a value larger than a preset allowable value, so that the position deviation of the work vehicle 10 can be made less than the allowable value of the driving mode to be switched to. This makes it possible to avoid a situation in which the work vehicle 10 stops due to the position deviation of the work vehicle 10 exceeding the allowable value. For example, when the work vehicle 10 enters an area in which the crop V is not arranged while automatically traveling (driving mode M2 ​​for crop row path) along the crop row path R0 while detecting the crop V, the work vehicle 10 can avoid stopping due to the position deviation of the work vehicle 10 with respect to the target path R, and can continue automatic traveling by switching to the driving mode M1 for the target path in which the work vehicle 10 travels along the target path R. Therefore, it is possible to prevent a decrease in work efficiency by suppressing the stopping operation of the work vehicle 10 due to the position deviation of the work vehicle 10.

[0111] The present invention is not limited to the above-described embodiment. As another embodiment of the present invention, the setting processing unit 113 may change the preset tolerance value as follows. Specifically, the setting processing unit 113 sets the tolerance value Tw0' based on the distance W0 (position deviation) between the current position Pe of the work vehicle 10 and the crop row path R0, which is included in the conditions for setting the crop row path R0 according to the position of the crop V. For example, when the distance W0 exceeds a predetermined distance, the travel processing unit 111 cannot accurately estimate the crop row path R0. In this case, the setting processing unit 113 sets the predetermined distance to the tolerance value Tw0'. For example, when the predetermined distance is 25 cm, the setting processing unit 113 sets the tolerance value Tw0' to 25 cm.

[0112] In another embodiment of the present invention, the setting processing unit 113 may set the tolerance values ​​Tw0, Tw0' corresponding to the crop row path traveling mode M2 ​​to values ​​smaller than the tolerance values ​​Tw1, Tw1' corresponding to the target path traveling mode M1. This makes it possible to increase the position accuracy of the work vehicle 10 in the crop row path traveling mode M2 ​​more than the position accuracy of the work vehicle 10 in the target path traveling mode M1.

[0113] In addition, the setting processing unit 113 may set the tolerances Tw0, Tw0', Tw1, Tw1' based on the size of the work vehicle 10, the type and size of the work implement, the condition of the field F (slope, soil, etc.), the travel speed of the work vehicle 10, etc. [Explanation of symbols]

[0114] 1:Autonomous driving system 10: Work vehicle 11: Vehicle control device 111: Driving processing unit 112: Switching processing unit 113: Setting processing section 14: Spraying device 16: Positioning device 17: Obstacle detection device 20: Operation terminal 211: Setting processing section 212: Route generation processing unit 213: Output processing section 40:Base station 50:Satellite F: Field (travel area) R: Target route R0: Crop row path V: Crops (work objects) Vr: Crop row Pe:Current position M1: Driving mode for target route (first driving mode) M2: Crop row path driving mode (second driving mode) W0: Distance (position deviation) (from the crop row path) W1: Distance (position deviation) (from the target path) Tw0: Tolerance (first tolerance) Tw0´: Tolerance (second tolerance) Tw1: Tolerance (first tolerance) Tw1´: Tolerance (second tolerance)

Claims

1. In the travel area, the work vehicle is caused to travel in a first travel mode in which the work vehicle automatically travels along a preset target route based on positioning information of the work vehicle; running the work vehicle in a second travel mode in which the work vehicle automatically travels along a work object path that is set according to the position of a work object placed within the travel area; In the first traveling mode, when a position deviation representing a distance between the current position of the work vehicle and the target route is equal to or greater than a tolerance value corresponding to the first traveling mode, stopping the work vehicle, and in the second traveling mode, when a position deviation representing a distance between the current position of the work vehicle and the work object route is equal to or greater than a tolerance value corresponding to the second traveling mode, stopping the work vehicle. Switching between the first driving mode and the second driving mode; when a driving mode is switched from one of the first driving mode and the second driving mode to the other driving mode, changing the tolerance value corresponding to the other driving mode to a second tolerance value that is greater than a first tolerance value set for the other driving mode before the driving mode is switched; An automated driving method that performs the above.

2. when the position deviation becomes less than the first allowable value after the driving mode is switched from the one to the other driving mode and the work vehicle starts traveling in the other driving mode, the allowable value corresponding to the other driving mode is changed from the second allowable value to the first allowable value. The automatic driving method according to claim 1.

3. when the position deviation becomes less than a predetermined value smaller than the first allowable value after the driving mode is switched from the one driving mode to the other driving mode and the work vehicle starts traveling in the other driving mode, the allowable value corresponding to the other driving mode is changed from the second allowable value to the first allowable value. The automatic driving method according to claim 2.

4. when a predetermined time has elapsed since the driving mode was switched from the one to the other and the work vehicle started traveling in the other driving mode, the tolerance value corresponding to the other driving mode is changed from the second tolerance value to the first tolerance value. The automatic driving method according to any one of claims 1 to 3.

5. stopping the work vehicle when the position deviation is equal to or greater than the second allowable value at a time when the driving mode is switched from the one driving mode to the other driving mode; The automatic driving method according to any one of claims 1 to 4.

6. the second tolerance is set based on the position deviation between the current position of the work vehicle and the work object, the position deviation being included in a condition for setting the work object path in accordance with the position of the work object. The automatic driving method according to any one of claims 1 to 5.

7. when the work vehicle detects the work object while traveling in the first traveling mode, the first traveling mode is switched to the second traveling mode; When the work vehicle is unable to detect the work object while traveling in the second traveling mode, the second traveling mode is switched to the first traveling mode. The automatic driving method according to any one of claims 1 to 6.

8. causing the work vehicle to automatically travel in the first travel mode in an area of ​​the travel area in which the work object is not located; causing the work vehicle to automatically travel in the second travel mode in an area of ​​the travel area in which the work object is located; The automatic driving method according to any one of claims 1 to 7.

9. The work vehicle is a vehicle capable of performing a spraying operation in which a spraying material is sprayed on a first work object and on second work objects to the left and right of the first work object while traveling across the first work object. The automatic driving method according to any one of claims 1 to 8.

10. In a travel area, the work vehicle is driven in a first travel mode in which the work vehicle automatically travels along a preset target route based on positioning information of the work vehicle, or in a second travel mode in which the work vehicle automatically travels along a work object route that is set in accordance with the position of a work object placed in the travel area, and a travel processing unit that, in the first travel mode, stops the work vehicle when a position deviation representing the distance between the current position of the work vehicle and the target route is equal to or greater than a tolerance corresponding to the first travel mode, and that, in the second travel mode, stops the work vehicle when a position deviation representing the distance between the current position of the work vehicle and the work object route is equal to or greater than a tolerance corresponding to the second travel mode; A switching processing unit that switches between the first driving mode and the second driving mode; a setting processing unit that, when a driving mode is switched from one of the first driving mode and the second driving mode to the other driving mode, changes the tolerance value corresponding to the other driving mode to a second tolerance value that is greater than a first tolerance value that was set for the other driving mode before the driving mode was switched; An automated driving system equipped with

11. In the travel area, the work vehicle is caused to travel in a first travel mode in which the work vehicle automatically travels along a preset target route based on positioning information of the work vehicle; running the work vehicle in a second travel mode in which the work vehicle automatically travels along a work object path that is set in accordance with the position of a work object placed within the travel area; In the first traveling mode, when a position deviation representing a distance between the current position of the work vehicle and the target route is equal to or greater than a tolerance value corresponding to the first traveling mode, stopping the work vehicle, and in the second traveling mode, when a position deviation representing a distance between the current position of the work vehicle and the work object route is equal to or greater than a tolerance value corresponding to the second traveling mode, stopping the work vehicle. Switching between the first driving mode and the second driving mode; when a driving mode is switched from one of the first driving mode and the second driving mode to the other driving mode, changing the tolerance value corresponding to the other driving mode to a second tolerance value that is greater than a first tolerance value set for the other driving mode before the driving mode is switched; An automated driving program for executing the above on one or more processors.

Citation Information

Patent Citations

  • Operation mode switching method and device, electronic equipment, system and storage medium

    CN112578774A

  • Field work machine

    JP2015112069A

  • Traveling work machine and automatic steering system used therein

    JP2016024540A

  • Automatic travel system for work vehicle

    JP2021002171A

  • Robotic agricultural system and method

    US20190090472A1