Autonomous driving method, automatic driving system, and automatic driving program
By dynamically adjusting the positional deviation threshold based on the inclination angle, the system improves the efficiency of work vehicles on sloped terrain by reducing unnecessary deceleration and stopping, thus maintaining consistent operation.
Patent Information
- Application Number
- JP2021091526
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2021-05-31
- Publication Date
- 2024-11-06
- Estimated Expiration
- 2041-05-31
Smart Images

Figure 0007578543000002 
Figure 0007578543000003 
Figure 0007578543000004
Abstract
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 system that automatically drives a work vehicle along a preset target route in a work area such as a farm field, a farmer's garden, etc. In addition, in the above system, a technology has been proposed that slows down or stops the work vehicle when the position deviation (position deviation) of the work vehicle from the target route exceeds a threshold value (for example, see Patent Document 1). [Prior art documents] [Patent documents]
[0003] [Patent Document 1] JP 2018-041359 A Summary of the Invention [Problem to be solved by the invention]
[0004] In the conventional system, the threshold value is set to a fixed value across the board. Therefore, for example, when the field is inclined, the position deviation of the work vehicle increases and frequently exceeds the threshold value, causing repeated execution of limiting operations such as deceleration and stopping. This causes a problem of reduced efficiency in work by the work vehicle.
[0005] An object of the present invention is to provide an automatic driving method, an automatic driving system, and an automatic driving program that can improve the work efficiency of work performed by a work vehicle that automatically drives on an inclined driving area. [Means for solving the problem]
[0006] The automatic driving method of the present invention is a method of automatically driving a work vehicle according to a target route in a driving area, executing a restriction operation to restrict the automatic driving of the work vehicle when a position deviation of the work vehicle from the target route exceeds a threshold value, and setting the threshold value based on the left-right inclination angle with respect to the direction of travel of the work vehicle in the driving area.
[0007] The automated driving system according to the present invention includes a driving processing unit, a restriction processing unit, and a setting processing unit. The driving processing unit automatically drives a work vehicle along a target route in a driving area. The restriction processing unit executes a restriction operation that restricts the automated driving of the work vehicle when a position deviation of the work vehicle from the target route exceeds a threshold. The setting processing unit sets the threshold based on a lateral tilt angle with respect to a traveling direction of the work vehicle in the driving area.
[0008] The automatic driving program of the present invention is a program for causing one or more processors to execute the following operations: automatically driving a work vehicle according to a target route in a driving area; executing a restriction operation to restrict the automatic driving of the work vehicle when the position deviation of the work vehicle from the target route exceeds a threshold value; and setting the threshold value based on the left-right inclination angle with respect to the direction of travel of the work vehicle in the driving area. Effect of the Invention
[0009] According to the present invention, it is possible to provide an automatic driving method, an automatic driving system, and an automatic driving program that can improve the work efficiency of work performed by a work vehicle that automatically drives on an inclined driving area. [Brief description of the drawings]
[0010] [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 7A] FIG. 7A is a diagram for explaining a method for generating a target route according to an embodiment of the present invention. [Figure 7B] FIG. 7B is a diagram for explaining a method for generating a target route according to an embodiment of the present invention. [Figure 8] FIG. 8 is a diagram showing a travel route of the work vehicle according to the embodiment of the present invention. [Figure 9] FIG. 9 is a diagram showing an example of the position deviation and the orientation deviation of the work vehicle according to the embodiment of the present invention. [Figure 10] FIG. 10 is a diagram showing an example of a farm field according to an embodiment of the present invention. [Figure 11] FIG. 11 is a diagram showing an example of a work path according to an embodiment of the present invention. [Figure 12] FIG. 12 is a diagram showing an example of position deviation information used in the automatic driving system according to the embodiment of the present invention. [Figure 13] FIG. 13 is a diagram showing an example of position correction information used in the automatic driving system according to the embodiment of the present invention. [Figure 14] FIG. 14 is a diagram illustrating an example of threshold information used in the automatic driving system according to the embodiment of the present invention. [Figure 15]FIG. 15 is a diagram illustrating a relationship between the position threshold and the deceleration according to the embodiment of the present invention. [Figure 16] FIG. 16 is a diagram showing an example of deceleration information used in the automated driving system according to the embodiment of the present invention. [Figure 17] FIG. 17 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
[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] [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.
[0013] 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.
[0014] 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) to form 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 along which the work vehicle 10 performs spraying work on the crops V while traveling in the direction D1 (corresponding to the traveling direction of the present invention).
[0015] 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.
[0016] 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.
[0017] 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.
[0018] 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.
[0019] Hereinafter, each of the components constituting the automated driving system 1 will be described in detail.
[0020] [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.
[0021] 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.
[0022] 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.
[0023] 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. 17) 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 and threshold information F3 (described later) for deviations (position deviation and orientation deviation) of the work vehicle 10. For example, the route data is transferred from the operation terminal 20 to the work vehicle 10 and stored in the storage unit 12.
[0024] 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.
[0025] 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 detection processing unit 112, a restriction processing unit 113, a correction processing unit 114, and a setting processing unit 115. 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.
[0026] The driving processing unit 111 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 becomes a state in which RTK positioning is possible and the operator presses a start button on the operation screen of the operation terminal 20, the operation terminal 20 outputs a work start instruction to the work vehicle 10. When the driving processing unit 111 acquires the work start instruction from the operation terminal 20, it starts automatic driving of the work vehicle 10 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, and starts spraying work by the spraying device 14 in the work passage.
[0027] Furthermore, the driving processing unit 111 stops the automatic driving of the work vehicle 10 when it receives a driving stop instruction from the operation terminal 20. 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 stops the spraying work by the spraying device 14. The driving processing unit 111 is an example of a driving processing unit of the present invention.
[0028] 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.
[0029] 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.
[0030] 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.
[0031] 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.
[0032] 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 pressurizing the chemical solution etc., an electric spraying motor (not shown) for driving 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 spraying pattern of the chemical solution etc., and a plurality of spraying pipes (not shown) connecting these together.
[0033] 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.
[0034] 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.
[0035] 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.
[0036] 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.
[0037] 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.
[0038] 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).
[0039] 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.
[0040] 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.
[0041] 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.
[0042] 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.
[0043] 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.
[0044] 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.
[0045] 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.
[0046] 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.
[0047] 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. The contact sensor 173F on the front side of the vehicle body 100 detects an obstacle when the obstacle comes into contact with the contact sensor 173F. The spraying device 14 is provided in front of the contact sensor 173R on the rear side of the vehicle body 100 (the rear side of the work vehicle 10), and when an obstacle comes into contact with the spraying device 14, the contact sensor 173R detects the obstacle by moving the spraying device 14 backward (the front side of the work vehicle 10). Each contact sensor transmits a detection signal to the vehicle control device 11 when it detects an obstacle.
[0048] The vehicle control device 11 executes an avoidance process for avoiding an obstacle when there is a possibility that the work vehicle 10 will collide with the obstacle, based on measurement information relating to the obstacle obtained from the obstacle detection device 17.
[0049] Furthermore, the vehicle control device 11 detects the position deviation and orientation deviation of the work vehicle 10 and performs operations (limiting operations and correcting operations) to avoid collision with the crop row Vr.
[0050] For example, the travel processing unit 111 moves the work vehicle 10 from the work path R1 of the crop row Vra to the work path R1 of the crop row Vrb according to the target path R shown in FIG. 8. When the work vehicle 10 reaches the end point P0 of the crop row Vra, it stops spraying, moves straight along the straight path r1, and starts turning at the turning start position P1. When the work vehicle 10 starts turning, it moves along the turning path r2, the straight path r3, and the turning path r4, moves straight along the straight path r5 from the turning end position P4, moves to the end point P0 of the crop row Vrb, which is the next work path R1, and resumes spraying. In FIG. 8, the symbol C1 indicates the turning center of the turning path r2, and the symbol C2 indicates the turning center of the turning path r4. The turning radii of the turning paths r2 and r4 are the same.
[0051] The detection processing unit 112 of the vehicle control device 11 detects the position deviation and orientation deviation of the automatically traveling work vehicle 10. Specifically, the detection processing unit 112 detects the position deviation and orientation deviation of the work vehicle 10 with respect to the target route R based on the positioning information (current position, current orientation) from the positioning device 16.
[0052] The restriction processing unit 113 of the vehicle control device 11 judges whether or not the position deviation detected by the detection processing unit 112 exceeds a preset threshold value (position threshold value). Then, when the position deviation exceeds the position threshold value, the restriction processing unit 113 executes a restriction operation (decelerating, stopping, etc.) that restricts the traveling operation of the work vehicle 10. Furthermore, the restriction processing unit 113 judges whether or not the orientation deviation detected by the detection processing unit 112 exceeds a preset threshold value (orientation threshold value). Then, when the orientation deviation exceeds the orientation threshold value, the restriction processing unit 113 executes a restriction operation that restricts the traveling operation (decelerating, stopping, etc.) of the work vehicle 10. The position threshold value and the orientation threshold value are set in advance in, for example, the operation terminal 20. The position threshold value is an example of a threshold value of the present invention. The restriction processing unit 113 is an example of a restriction processing unit of the present invention. The restriction operation will be described in detail later.
[0053] The correction processing unit 114 of the vehicle control device 11 executes a correction operation to correct the position deviation when the position deviation detected by the detection processing unit 112 exceeds the position threshold value. Also, the correction processing unit 114 executes a correction operation to correct the orientation deviation when the orientation deviation detected by the detection processing unit 112 exceeds the orientation threshold value. The correction processing unit 114 executes the correction operation after the restriction processing unit 113 executes the restriction operation.
[0054] Here, an example of the correction operation will be described with reference to Fig. 9. Fig. 9 shows a part of the target route R including the turning route r4 and the straight route r5 shown in Fig. 8. For example, when the work vehicle 10 deviates from the turning route r4 of the target route R and the position deviation exceeds the position threshold, the work vehicle 10 decelerates and stops at a position P5 at a distance m1 (position deviation) from the target turning end position P4. When the position deviation m1 exceeds the position threshold and the orientation deviation θa exceeds the orientation threshold at the position P5, the correction processing unit 114 executes the following correction operation. First, the correction processing unit 114 spins the work vehicle 10 at the position P5 (pilot turning) until the orientation deviation θa of the work vehicle 10 with respect to the direction of the straight line connecting the position P5 and the position P6 on the extension line of the straight route r5 becomes equal to or less than the orientation threshold.
[0055] Next, the correction processing unit 114 reverses the work vehicle 10 until the work vehicle 10 reaches position P6 or until the position deviation m1 of the work vehicle 10 with respect to the extension line of the straight path r5 becomes equal to or less than the position threshold value. The target position of position P6 is a position at a distance m2 (e.g., 2 m) from the turning end position P4.
[0056] Next, the correction processing unit 114 spins (pilots) the work vehicle 10 at, for example, position P6 until the heading deviation of the work vehicle 10 from the direction of the extension line of the straight path r5 becomes equal to or less than the heading threshold value. Next, the correction processing unit 114 causes the work vehicle 10 to travel straight from position P6 along the extension line of the straight path r5 to the turning end position P4. Thereafter, the travel processing unit 111 causes the work vehicle 10 to travel straight along the straight path r5 and enter the work path R1 of the crop row Vrb from the end point P0.
[0057] The work vehicle 10 executes the limiting action (decelerating, stopping) and the correcting action, for example, every time the position deviation exceeds the position threshold value. For this reason, if the position threshold value is fixed uniformly as in the conventional method, for example, when the field F is inclined, the position deviation frequently exceeds the position threshold value, causing the limiting action and the correcting action to be repeatedly executed. This causes a problem of reduced efficiency in spraying work by the work vehicle 10.
[0058] Fig. 10 shows an example of a tilted field F. The field F shown in Fig. 10 is tilted at an angle θf (tilt angle) in the left-right direction (D2 direction) relative to the traveling direction (D1 direction) of the work vehicle 10 in the field F. The tilt angle θf is calculated by the following formula using the end points n0 (x0, y0, z0) and n1 (x1, y1, z1) of the crop row Vr shown in Fig. 10. That is, the vehicle control device 11 calculates the tilt angle θf based on the latitude, longitude, and altitude of multiple points that specify the travel area of the work vehicle 10 in the field F.
number
[0059] FIG. 11 shows the rear view of the work vehicle 10 traveling along the work passage in the sloping field F shown in FIG. 10. In FIG. 11, the reference point d0 indicates a reference point that indicates the current position of the work vehicle 10. That is, the reference point d0 is a position (a position in the global coordinate system (NED coordinate system)) that indicates the latitude, longitude, and altitude of the work vehicle 10 measured by the positioning device 16. The reference point d0 is set at a height that is half the total height of the work vehicle 10 (an example of the predetermined height of the present invention) from the ground of the field F. In addition, the position of the reference point d0 in the front-rear direction when the work vehicle 10 is viewed in a plan view is a position that is half the total length of the work vehicle 10. That is, the reference point d0 is set at the center of the work vehicle 10 in the XYZ directions.
[0060] Also, in Fig. 11, the symbol d1 indicates a position (target position) on the target route R, that is, the position of the crop Vc. Here, since the work vehicle 10 automatically travels along the target route R, for example, when the field F or the work route R1 is not inclined (θf = 0 degrees), the reference point d0 and the target position d1 approximately coincide. However, as shown in Fig. 11, when the field F or the work route R1 is inclined, the position (latitude, longitude) of the reference point d0 will deviate from the target position d1. That is, the distance dx from the target position d1 to a point d2 vertically below the reference point d0 is the position deviation caused by the inclination angle θf.
[0061] In this way, even when the work vehicle 10 is automatically traveling appropriately in the work passage along the target route R, the position deviation dx increases due to the influence of the inclination angle θf. The position deviation dx becomes larger as the inclination angle θf increases. Therefore, the position deviation dx increases due to the influence of the inclination angle θf and is more likely to exceed the position threshold value. This causes a problem that the limiting operation and the correcting operation are more likely to be performed in the work vehicle 10, resulting in a decrease in work efficiency. Note that the inclination angle θf is not limited to the inclination angle of the entire field F (see FIG. 10), but may be the inclination angle of each work path R1 (work passage). That is, the inclination angle of the present invention may be the inclination angle of the field F or the inclination angle of the work path R1. Each of the field F and the work path R1 is an example of a travel area of the present invention.
[0062] In contrast, according to the work vehicle 10 of this embodiment, as will be described below, it is possible to improve the work efficiency of the work performed by the work vehicle 10 automatically traveling in an inclined traveling area (field F or work path R1).
[0063] Specifically, the setting processing unit 115 of the vehicle control device 11 sets a position threshold value for the position deviation dx of the work vehicle 10 with respect to the target route R based on the inclination angle θf. That is, the setting processing unit 115 sets the position threshold value taking into consideration the inclination state of the field F and the work route R1. The setting processing unit 115 is an example of a setting processing unit of the present invention.
[0064] For example, the setting processing unit 115 sets the position threshold value based on the travel history information of the work vehicle 10. Specifically, first, the setting processing unit 115 sets an initial value (position initial value) of the position deviation for the work path R1. Next, the travel processing unit 111 causes the work vehicle 10 to perform a spraying operation while automatically traveling along the target path R in a field F (see FIG. 10) having an inclination angle θf. The detection processing unit 112 calculates and records the maximum change amount Pm of the position deviation from the position initial value within the work path R1 for each of a plurality of work paths R1a to R1f (see FIG. 6) included in the target path R while the work vehicle 10 is traveling automatically. In addition, the detection processing unit 112 calculates a position deviation tolerance level Lp corresponding to the maximum change amount Pm for each work path R1. The position deviation tolerance level Lp is an index that indicates a level (stage) at which the position deviation can be tolerated and does not require the deceleration operation and the correction operation for the work path R1.
[0065] The detection processing unit 112 executes automatic traveling and spraying work, and stores position deviation information F1 in which the maximum amount of change Pm and the position deviation allowable level Lp are associated with each other for each work route R1 in the storage unit 12. Fig. 12 is a diagram showing an example of the position deviation information F1.
[0066] The setting processing unit 115 changes the preset position threshold value based on the past position deviation information F1 recorded by the detection processing unit 112. Specifically, the setting processing unit 115 determines a position offset amount Op for the position threshold value for each work path R1. The position offset amount Op is correction information for the preset position threshold value. The storage unit 12 prestores position correction information F2 (see FIG. 13) indicating the position offset amount Op corresponding to the position deviation tolerance level Lp. The setting processing unit 115 determines the position offset amount Op for the position threshold value for each work path R1 by referring to the position correction information F2.
[0067] Then, the setting processing unit 115 sets a value obtained by adding or subtracting the position offset amount Op to the previously set position threshold as the position threshold for the next spraying operation. For example, the setting processing unit 115 acquires a position deviation tolerance level Lp1 of the work path P1a by referring to position deviation information F1, which is travel history information from the previous time the work vehicle 10 traveled, acquires a position offset amount Op1 corresponding to the position deviation tolerance level Lp1 by referring to position correction information F2, and changes the previously set position threshold by the position offset amount Op1. The setting processing unit 115 stores threshold information F3 (see FIG. 14) indicating the changed position threshold in the memory unit 12. Position threshold values Pt1 to Pt6 corresponding to each of the work paths R1a to R1f are registered in the threshold information F3.
[0068] In addition, since the position threshold is calculated using driving history information, in addition to the element of the inclination angle θf of the field F or the work path R1, elements such as the road surface condition of each work path R1 are included, and therefore a different position threshold may be calculated for each work path R1.
[0069] As described above, the setting processing unit 115 changes the position threshold for each work path R1 based on the position deviation for each work path R1 with respect to the work path R1, which is included in the travel history information in the field F or work path R1 having the inclination angle θf. The setting processing unit 115 may also change the position threshold for each work path R1 to a different value.
[0070] In addition, in Figures 12 and 13, for convenience, the position deviation tolerance level Lp and the position offset amount Op are shown in six stages (Lp1 to Lp6, Op1 to Op6) corresponding to the number of work paths, but in reality, they may be expressed in a preset number of stages (e.g., three stages).
[0071] The route data transferred from the operation terminal 20 includes information on the target route R, an area for storing the maximum change amount Pm, and an area for storing the position deviation tolerance level Lp. In addition, in the route data transferred from the operation terminal 20, the position deviation tolerance level Lp is set to the minimum value (a level where the tolerance deviation is equivalent to 0). The vehicle control device 11 automatically drives the work vehicle 10 based on the route data, calculates the position deviation tolerance level Lp, and updates the route data. That is, the route data is associated with threshold information F3 (see FIG. 14) and stored in the storage unit 12. The position correction information F2 may be stored in advance in the storage unit 12, or may be included in the route data transferred from the operation terminal 20. The travel processing unit 111 executes the next automatic travel and spraying work based on the route data including the target route R and threshold information F3.
[0072] As another embodiment, the setting processing unit 115 may change the preset position threshold value for each field F based on travel history information of the work vehicle 10. For example, the detection processing unit 112 calculates one maximum change amount Pm and one position deviation allowable level Lp for all of the work routes R1a to R1f. As a result, the setting processing unit 115 determines one position offset amount Op for the field F and sets the position threshold value.
[0073] In the above example, the maximum change amount of the position deviation is used. However, as another embodiment, it is also possible to use a method of calculating the position deviation allowable level Lp based on the variance value of the position deviation using a probability statistics method.
[0074] As described above, the setting processing unit 115 sets the position threshold based on the inclination angle θf of the field F or the work path R1. For example, when the inclination angle θf is a first angle, the setting processing unit 115 sets the position threshold to a first position threshold, and when the inclination angle θf is a second angle larger than the first angle, the setting processing unit 115 sets the position threshold to a second position threshold larger than the first position threshold. Furthermore, the larger the inclination angle θf, the larger the value the setting processing unit 115 sets the position threshold to.
[0075] The restriction processing unit 113 executes a restriction operation to restrict the traveling operation of the work vehicle 10 based on the position threshold set by the setting processing unit 115. For example, the restriction processing unit 113 determines whether the position deviation detected by the detection processing unit 112 exceeds the position threshold of the threshold information F3 (see FIG. 14), and executes a restriction operation to restrict the traveling operation (decelerating, stopping, etc.) of the work vehicle 10 when the position deviation exceeds the position threshold. For example, the restriction processing unit 113 decelerates the traveling speed of the work vehicle 10 at a predetermined deceleration and then stops the work vehicle 10. Furthermore, when the work vehicle 10 stops, the correction processing unit 114 executes a correction operation (see FIG. 9) to correct the position deviation.
[0076] With the above configuration, the position threshold value of the position deviation can be changed, making it possible to avoid unnecessary restricting and correcting operations of the work vehicle 10 caused by the inclination of the field F or the work route R1. This makes it possible to improve the work efficiency of the spraying work of the work vehicle 10. In addition, since history information on actual travel through the field F can be used, the position threshold value can be set to an appropriate value suitable for the field F. This makes it possible to improve the work accuracy.
[0077] Here, when the setting processing unit 115 changes the position threshold value to a value larger than a preset value, the restriction processing unit 113 may change the deceleration of the work vehicle 10 during the restriction operation to a value larger than the initially set deceleration. Fig. 15 is a diagram showing a schematic relationship between the position threshold value and the deceleration.
[0078] FIG. 15 shows three types of position thresholds PtA, PtB, and PtC (where PtA < PtB < PtC) for the target path R. The position threshold PtA indicates the initially set position threshold, the position threshold PtB indicates the position threshold after the change, and the position threshold PtC indicates the position threshold for executing the stop operation. In the initial setting, when the position deviation of the work vehicle 10 exceeds the position threshold PtA, the work vehicle 10 decelerates at the first deceleration rate. Further, when the work vehicle 10 decelerates at the azimuth deviation θt and the first deceleration rate and the position deviation exceeds the position threshold PtC, the work vehicle 10 stops. In this case, the work vehicle 10 travels a distance LtA from the start of deceleration until it stops. Note that the angle θt is the threshold value of the azimuth deviation.
[0079] On the other hand, for example, when the setting processing unit 115 changes the position threshold from PtA to PtB, the work vehicle 10 decelerates at the second deceleration rate when the position deviation exceeds the position threshold PtB. Then, when the work vehicle 10 decelerates at the azimuth deviation θt and the second deceleration rate and the position deviation exceeds the position threshold PtC, the work vehicle 10 stops. In this case, the work vehicle 10 travels a distance LtB (allowable straight-ahead distance) from the start of deceleration until it stops. That is, the work vehicle 10 decelerates so as to stop at the distance LtB (allowable straight-ahead distance) after the position deviation exceeds the position threshold PtB. Therefore, the restriction processing unit 113 sets the second deceleration rate to a value larger than the first deceleration rate.
[0080] As described above, when the position deviation exceeds the first position threshold PtA, the restriction processing unit 113 decelerates the work vehicle 10 at the first deceleration rate Va, and when the position deviation exceeds the second position threshold PtB (where PtA < PtB), the restriction processing unit 113 decelerates the work vehicle 10 at the second deceleration rate Vb (where Vb > Va). FIG. 16 shows an example of deceleration information F4 regarding the deceleration rate. For example, when the setting processing unit 115 sets the position threshold PtB, the restriction processing unit 113 refers to the deceleration information F4 to obtain the deceleration rate Vb corresponding to the position threshold PtB and sets it as the deceleration rate of the work vehicle 10 that decelerates. The deceleration information F4 can be calculated in advance by simulation or tests using an actual machine.
[0081] In the above configuration, for example, the setting processing unit 115 sets the position threshold PtA (corresponding to the first threshold of the present invention) when the inclination angle θf of the field F is the first angle. When the position deviation exceeds the position threshold PtA, the restriction processing unit 113 decelerates the work vehicle 10 at a deceleration Va. Further, the setting processing unit 115 sets the position threshold PtB (PtA < PtB) (corresponding to the second threshold of the present invention) when the inclination angle θf of the field F is a second angle greater than the first angle. When the position deviation exceeds the position threshold PtB, the restriction processing unit 113 decelerates the work vehicle 10 at a deceleration Vb (Vb > Va). Thereby, regardless of the inclination angle θf of the field F, when the position deviation of the work vehicle 10 exceeds the position threshold, the work vehicle 10 can be safely stopped.
[0082] In this embodiment, decelerations corresponding to the position thresholds Pt1 to Pt6 registered in the threshold information F3 (see FIG. 14) are registered in the deceleration information F4.
[0083] By the way, the work vehicle 10 executes an operation of decelerating and stopping not only when the position deviation exceeds the position threshold but also when an obstacle is detected. That is, the setting processing unit 115 decelerates the work vehicle 10 at a predetermined deceleration when the position deviation exceeds the position threshold or when the work vehicle 10 detects an obstacle during automatic driving. Here, when the work vehicle 10 detects an obstacle, it is necessary to avoid a collision with the obstacle. Therefore, the setting processing unit 115 sets the deceleration of the work vehicle 10 when the obstacle detection device 17 detects an obstacle to a value larger than the deceleration of the work vehicle 10 when the position deviation exceeds the position threshold. For example, when the position deviation exceeds the position threshold during automatic driving of the work vehicle 10, the setting processing unit 115 causes the work vehicle 10 to travel at a deceleration V1 (corresponding to the third deceleration of the present invention). Further, when an obstacle is detected while the work vehicle 10 is traveling at the deceleration V1, the setting processing unit 115 switches the deceleration of the work vehicle 10 from the deceleration V1 to the deceleration V2 (V2 > V1) (corresponding to the fourth deceleration of the present invention). In this way, the work vehicle 10 gives priority to avoiding a collision with an obstacle by switching the deceleration when an obstacle is detected.
[0084] 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.
[0085] [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.
[0086] 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.
[0087] 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.
[0088] 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. 17) described below. 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.
[0089] 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.
[0090] 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.
[0091] 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).
[0092] 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.
[0093] 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.
[0094] 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).
[0095] 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.
[0096] 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.
[0097] An example of a method for generating the target route R will be described with reference to FIG. 7A and FIG. 7B. FIG. 7A 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. 7A). The work vehicle 10 detects an end point E1 on one side (lower side of FIG. 7A) and an end point E2 on the other side (upper side of FIG. 7A) 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, the path generation processing unit 212 sets a line L1 (see FIG. 7B) 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 for 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.
[0098] 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 route data includes an area for storing the maximum amount of change Pm for each work route R1, and an area for storing the position deviation tolerance level Lp. An initial value (the minimum value equivalent to a tolerance of 0) is registered for the position deviation tolerance level Lp of the route data. The route data may also include an area for storing information related to azimuth deviation (maximum amount of change, azimuth deviation tolerance level).
[0099] The output processing unit 213 may output the route data to a server (not shown). The server stores and manages the route data acquired from each of the operation terminals 20 in association with the operation terminals 20 and the work vehicle 10.
[0100] 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.
[0101] 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.
[0102] 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.
[0103] 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.
[0104] [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.
[0105] 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.
[0106] First, the vehicle control device 11 sets a position threshold according to the inclination angle θf of the field F or the work route R1. For example, the vehicle control device 11 changes the position threshold to a value greater than a preset value by using previous driving history information. The vehicle control device 11 stores route data including the target route R and the changed position threshold (threshold information F3 (see FIG. 14)). In the next work, the work vehicle 10 performs the following automatic traveling based on the route data.
[0107] 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).
[0108] In step S2, the vehicle control device 11 starts automatic driving. For example, when the vehicle control device 11 acquires a work start instruction from the operation terminal 20, the vehicle control device 11 starts automatic driving according to the target route R and the threshold information F3 included in the route data.
[0109] Next, in step S3, the vehicle control device 11 refers to the threshold information F3 to acquire a position threshold corresponding to the current position. For example, when the work vehicle 10 enters the work route R1a, the vehicle control device 11 acquires a position threshold Pt1 corresponding to the work route R1a. Also, for example, when the work vehicle 10 enters the work route R1b, the vehicle control device 11 acquires a position threshold Pt2 corresponding to the work route R1b.
[0110] Next, in step S4, the vehicle control device 11 determines whether or not the position deviation exceeds the position threshold. Specifically, the vehicle control device 11 detects the position deviation dx (see FIG. 11) of the work vehicle 10 with respect to the target route R based on the positioning information from the positioning device 16. Then, the vehicle control device 11 determines whether or not the detected position deviation dx exceeds the position threshold acquired in step S3. If the position deviation dx exceeds the position threshold (S4: Yes), the process proceeds to step S41. If the position deviation dx is equal to or less than the position threshold (S4: No), the process proceeds to step S5.
[0111] In step S41, the vehicle control device 11 decelerates the work vehicle 10. For example, the vehicle control device 11 refers to the deceleration information F4 (see FIG. 16) to acquire the deceleration corresponding to the position threshold value, and sets this as the deceleration of the work vehicle 10 to be decelerated. The vehicle control device 11 also decelerates the work vehicle 10 at the set deceleration until it stops.
[0112] Next, in step S42, the vehicle control device 11 executes a correction operation to correct the position deviation dx of the work vehicle 10. For example, the vehicle control device 11 performs a pivot turn and reverse drive as shown in Fig. 9 to correct the attitude of the work vehicle 10. After executing the correction operation, the vehicle control device 11 returns to step S3, resumes automatic traveling and spraying work, and executes the above-mentioned determination process.
[0113] In step S5, the vehicle control device 11 determines whether the work vehicle 10 has finished work. The vehicle control device 11 determines that work has ended when the position of the work vehicle 10 matches the work end position G. If the work vehicle 10 has finished work (S5: Yes), the automatic driving process ends. The vehicle control device 11 continues automatic driving by repeating the determination process and correction operation of step S3 until the work vehicle 10 finishes work.
[0114] As described above, the automatic driving system 1 according to the present embodiment automatically drives the work vehicle 10 according to the target route R in a travel area (for example, a field F, a work route R1), and executes a limiting operation (deceleration, stopping) to limit the automatic driving of the work vehicle 10 when the position deviation of the work vehicle 10 from the target route R exceeds a position threshold. The automatic driving system 1 also sets the position threshold based on the left-right (lateral) inclination angle θf with respect to the traveling direction of the work vehicle 10 in the travel area. Furthermore, the automatic driving method according to the present embodiment executes the following operations by one or more processors: automatically drives the work vehicle 10 according to the target route R in the travel area; executes a limiting operation to limit the automatic driving of the work vehicle 10 when the position deviation of the work vehicle 10 from the target route R exceeds a position threshold; and sets the position threshold based on the left-right inclination angle θf with respect to the traveling direction of the work vehicle 10 in the travel area. Furthermore, the threshold setting method according to the present embodiment variably sets the position threshold corresponding to the position deviation based on the left-right inclination angle θf with respect to the traveling direction of the work vehicle 10 in the travel area.
[0115] According to the above configuration, the threshold value (position threshold value) of the position deviation can be set according to the inclination angle θf of the travel area (field F, work route R1). Therefore, the work vehicle 10 can automatically travel using the position threshold value corresponding to each field F having a different inclination angle θf, and can automatically travel using the position threshold value corresponding to each work route R1 having a different inclination angle θf within the field F. In addition, by setting the position threshold value when the inclination angle θf is greater than 0 degrees to a value greater than the position threshold value when the inclination angle θf is 0 degrees, it is possible to make it difficult for the position deviation to exceed the position threshold value. Therefore, it is possible to prevent the repeated execution of limiting operations such as deceleration and stopping. Therefore, it is possible to improve the work efficiency of the work by the work vehicle 10 that automatically travels in a sloping travel area. In addition, since the work vehicle 10 can detect an obstacle (e.g., crop V) by the obstacle detection device 17, it is possible to prevent the work vehicle 10 from colliding with an obstacle due to the position deviation caused by the inclination, even if the position threshold value is changed to a value greater than a preset value.
[0116] The present invention is not limited to the above-described embodiment, and other embodiments of the present invention will be described below.
[0117] In another embodiment, the vehicle control device 11 may correct the detected position deviation dx based on the tilt angle θf when the work vehicle 10 travels on an inclined travel area. For example, in Fig. 11, when the height of the reference point d0 is H, the vehicle control device 11 calculates a value obtained by subtracting H x cos(θf) from the detected position deviation dx as the position deviation to be determined from the position threshold value. When the calculated position threshold value exceeds the position threshold value, the vehicle control device 11 executes a limiting operation and a correcting operation.
[0118] According to this configuration, the influence of the inclination of the driving area can be eliminated, and as in the above-described embodiment, in the work vehicle 10 that automatically drives on an inclined driving area, the repeated execution of restrictive operations such as deceleration and stopping can be prevented, thereby improving the work efficiency.
[0119] Furthermore, in the above-described embodiment, the setting processing unit 115 changes the position threshold value based on the travel history information (position deviation information F1) of the work vehicle 10. In contrast to this, in other embodiments, the setting processing unit 115 may set the position threshold value based on the inclination angle θf of the field F. Specifically, as shown in Fig. 10, when the field F is inclined by an angle θf in the lateral direction (arrangement direction of the crop rows), the setting processing unit 115 calculates the position deviation allowable level based on the inclination angle θf.
[0120] For example, the setting processing unit 115 creates a map function in advance from test data of an actual device or test data of a simulation, and calculates the position deviation tolerance level corresponding to the tilt angle θf using the map function. Then, the setting processing unit 115 sets the position threshold value based on the position offset amount Op corresponding to the calculated position deviation tolerance level.
[0121] In this way, the setting processing unit 115 calculates the inclination angle of the field F based on the altitude information (z coordinate information) indicating the altitude of the end point P0 of the work path R1.
[0122] According to this configuration, since the position deviation tolerance level is calculated when creating a map of the field F, there is no need to calculate the maximum change amount Pm and the position deviation tolerance level Lp during the automatic driving of the work vehicle 10. Therefore, the processing load during the automatic driving of the work vehicle 10 can be reduced.
[0123] In the above configuration, the control unit 21 of the operation terminal 20 may calculate the position deviation tolerance level, determine a position offset amount Op corresponding to the calculated position deviation tolerance level, and set it as the position threshold value. In this case, the position correction information F2 is recorded in the storage unit 22 of the operation terminal 20. In addition, the control unit 21 transfers route data including the target route R and the position threshold value to the work vehicle 10.
[0124] In another embodiment of the present invention, the setting processing unit 115 may set the position threshold value based on the topsoil condition of the field F. Specifically, the setting processing unit 115 determines the slope condition of the field F based on images captured by a camera (not shown) mounted on the work vehicle 10, detection results of other external sensors (not shown), and the like, and dynamically sets the position deviation tolerance level based on the determination results. When using images captured by a camera, the setting processing unit 115 may calculate the position deviation tolerance level from image data using a deep learning method (end to end learning).
[0125] Furthermore, when a three-dimensional sensor is used as the external sensor, the setting processing unit 115 may measure the inclination angle of the road surface, the unevenness of the road surface, etc., and calculate the position deviation tolerance level using a conversion function set in advance. Note that, in the method using the external sensor, it is possible to dynamically set the position threshold value before the entry of the crop row Vr in a state where the field F has never been traveled before, and it is also possible to respond to a sudden change in the road surface condition since the previous travel. [Explanation of symbols]
[0126] 1:Autonomous driving system 10: Work vehicle 11: Vehicle control device 111: Driving processing unit 112: Detection processing unit 113: Restriction processing unit 114: Correction processing unit 115: 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) d0 :Reference point dx: position deviation F1:Position deviation information F2: Position correction information F3: Threshold information F4:Deceleration information P0: End point R: Target route R1: Working path (travel area) V: Crop Vr: Crop row θf: Inclination angle
Claims
1. Automatically driving a work vehicle along a target route in a travel area; When a position deviation of the work vehicle with respect to the target route exceeds a threshold, a limiting operation is executed to limit the automatic traveling of the work vehicle; setting the threshold value based on a lateral inclination angle with respect to a traveling direction of the work vehicle in the travel area; An automated driving method that performs the above.
2. calculating, as the position deviation, a distance between the target route and a position corresponding to the inclination angle of a reference point representing a current position of the work vehicle; The automatic driving method according to claim 1.
3. The reference point is set at a position of a predetermined height from the bottom end of the work vehicle. The automatic driving method according to claim 2.
4. When the tilt angle is a first angle, the threshold value is set to a first threshold value, and when the tilt angle is a second angle larger than the first angle, the threshold value is set to a second threshold value larger than the first threshold value. The automatic driving method according to any one of claims 1 to 3.
5. When the position deviation exceeds the first threshold value, the work vehicle is decelerated at a first deceleration; When the position deviation exceeds the second threshold value, the work vehicle is decelerated at a second deceleration that is greater than the first deceleration. The automatic driving method according to claim 4.
6. When the position deviation exceeds the threshold value or when the work vehicle detects an obstacle while the work vehicle is automatically traveling, the work vehicle is decelerated at a predetermined deceleration; setting a deceleration of the work vehicle when the obstacle is detected to a value greater than a deceleration of the work vehicle when the position deviation exceeds the threshold value. The automatic driving method according to any one of claims 1 to 5.
7. When the position deviation exceeds the threshold value while the work vehicle is automatically traveling, the work vehicle is caused to travel at a third deceleration; when the obstacle is detected while the work vehicle is traveling at the third deceleration, the deceleration of the work vehicle is switched from the third deceleration to a fourth deceleration that is greater than the third deceleration. The automatic driving method according to claim 6.
8. Calculating the inclination angle based on the latitude, longitude, and altitude of a plurality of points that identify the traveling area. The automatic driving method according to any one of claims 1 to 7.
9. A driving processing unit that automatically drives a work vehicle along a target route in a driving area; a restriction processing unit that executes a restriction operation to restrict automatic traveling of the work vehicle when a position deviation of the work vehicle with respect to the target route exceeds a threshold value; a setting processing unit that sets the threshold value based on a lateral inclination angle with respect to a traveling direction of the work vehicle in the traveling area; An automated driving system equipped with
10. Automatically driving a work vehicle along a target route in a travel area; When a position deviation of the work vehicle with respect to the target route exceeds a threshold, a limiting operation is executed to limit the automatic traveling of the work vehicle; setting the threshold value based on a lateral inclination angle with respect to a traveling direction of the work vehicle in the travel area; An automated driving program for executing the above on one or more processors.
Citation Information
Patent Citations
Autonomous travel vehicle controller, autonomous travel vehicle control system and autonomous travel vehicle control method
JP2018032282A
Autonomous travelling system
JP2018041359A
Automatic work system
JP2019096342A
Autonomous travel system
JP2020109703A
Automatic travel system for work vehicle
JP2021002171A
