AUTONOMOUS DRIVE CONTROL SYSTEM AND AUTONOMOUS DRIVE CONTROL METHOD

The autonomous driving control system addresses the challenge of creating effective routes in headland areas by using an auxiliary route creation section to manage tractor travel in headland regions, enhancing navigation efficiency and reducing operator workload.

JP7591612B2Active Publication Date: 2024-11-28YANMAR POWER TECH CO LTD
View PDF 3 Cites 0 Cited by

Patent Information

Application Number
JP2023083709
Authority / Receiving Office
JP · JP
Patent Type
Patents
Current Assignee / Owner
Filing Date
2023-05-22
Publication Date
2024-11-28
Estimated Expiration
2039-11-26

AI Technical Summary

Technical Problem

Existing systems do not provide a detailed method for creating or using routes in headland areas of a field, as they have different characteristics than work areas, making simple application of work area methods inadequate.

Method used

An autonomous driving control system and method that includes an auxiliary route creation section to create and manage routes in headland areas based on selected side portions, using a tractor equipped with sensors and a wireless communication terminal to determine and display optimal travel paths.

Benefits of technology

Enables easy and efficient autonomous travel in headland areas by creating and displaying optimal routes, allowing the tractor to navigate complex field peripheries with minimal operator intervention and ensuring smooth transitions between work and headland areas.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 0007591612000001
    Figure 0007591612000001
  • Figure 0007591612000002
    Figure 0007591612000002
  • Figure 0007591612000003
    Figure 0007591612000003
Patent Text Reader

Abstract

To provide an autonomous travel control system and an autonomous travel control method, capable of creating simply and intelligibly a headland travel auxiliary route in a headland area.SOLUTION: In an autonomous travel control system, a travel control unit allows a work vehicle to travel autonomously along an auxiliary route set in a field encircled by a periclinal formed of multiple side parts 91, 92. An auxiliary route creation unit creates the auxiliary route based on selected side parts selected from the multiple side parts 91, 92.SELECTED DRAWING: Figure 10
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present invention relates to an autonomous driving control system and an autonomous driving control method for causing a work vehicle to travel along a route, and more particularly to an auxiliary route created within a headland area. [Background technology]

[0002] When a work vehicle works in a farm field, the farm field may be divided into a work area where the work vehicle mainly travels straight ahead to work, and a headland area around the work area where the work vehicle can turn, for example. Patent Document 1 is configured to create a route for the work vehicle to travel autonomously in both this type of work area and headland area. [Prior art documents] [Patent documents]

[0003] [Patent Document 1] Japanese Patent Application Publication No. 11-266608 Summary of the Invention [Problem to be solved by the invention]

[0004] However, the above-mentioned Patent Document 1 does not describe in detail a specific method for creating or using a route for the headland area. Since the headland area has different characteristics from the work area, the route creation method or usage method for the work area cannot be simply applied to the headland area.

[0005] The present invention has been made in consideration of the above circumstances, and its purpose is to provide an autonomous driving control system and an autonomous driving control method that can create a headland driving auxiliary route in a headland area in a simple and easy-to-understand manner. [Means for solving the problem]

[0006] The problem to be solved by the present invention has been described above. Next, the means for solving this problem and the effects thereof will be described.

[0007] According to one embodiment, an autonomous driving control system includes a driving control unit and an auxiliary path creation unit. The driving control unit causes a work vehicle to autonomously drive along an auxiliary path set in a field surrounded by a periphery formed of a plurality of sides. The auxiliary path creation unit creates the auxiliary path based on a selected side portion selected from the plurality of sides.

[0008] An autonomous driving control method according to one embodiment autonomously drives a work vehicle along an auxiliary path set within a field surrounded by a periphery formed from a plurality of sides, and creates the auxiliary path based on a selected side selected from the plurality of sides. [Brief description of the drawings]

[0009] [Figure 1] 1 is a side view showing the overall configuration of a tractor used in an autonomous driving control system according to an embodiment of the present invention; [Diagram 2] FIG. [Diagram 3] FIG. 1 is a block diagram showing the main configuration of an autonomous driving control system. [Figure 4] FIG. 2 is a diagram showing the working area and headland area of ​​a farm field. [Diagram 5] FIG. 4 is a diagram showing an example of a headland travel auxiliary route. [Figure 6] FIG. 4 is a diagram showing an example of a headland travel auxiliary route. [Figure 7] FIG. 4 is a diagram showing an example of a headland travel auxiliary route. [Figure 8] FIG. 4 is a diagram showing an example of a headland travel auxiliary route. [Figure 9] FIG. 4 is a diagram showing an example of a display screen. [Figure 10] FIG. 4 is a diagram showing an example of a display screen. [Figure 11] FIG. 4 is a diagram showing an example of a display screen. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0010] Next, an embodiment of the present invention will be described with reference to the drawings. Fig. 1 is a side view showing the overall configuration of a tractor 1 used in an autonomous driving control system 100 according to an embodiment of the present invention. Fig. 2 is a plan view of the tractor 1. Fig. 3 is a block diagram showing the main configuration of the autonomous driving control system 100.

[0011] The autonomous driving control system 100 of this embodiment autonomously drives a work vehicle in a field to perform all or part of the work. In this embodiment, a tractor 1 is used as an example of the work vehicle, but in addition to the tractor 1, the work vehicle also includes ride-on work machines such as rice transplanters, combine harvesters, civil engineering / construction work equipment, snowplows, and walk-behind work machines.

[0012] In this specification, autonomous driving means that the configuration related to driving of the tractor 1 is controlled by a control unit (ECU) equipped in the tractor 1, and the tractor 1 autonomously drives along a predetermined route, and autonomous operation means that the configuration related to work of the tractor 1 is controlled by the control unit, and the tractor 1 autonomously performs work along a predetermined route. Autonomous driving and autonomous operation include cases where a person is riding on the tractor 1 and cases where a person is not riding on the tractor 1. In contrast, manual driving and manual operation mean that each configuration equipped in the tractor 1 is operated by an operator to perform driving and work.

[0013] The tractor 1 shown in Fig. 1 is used in an autonomous driving control system 100, and is operated by wireless communication with a wireless communication terminal 46. The tractor 1 includes a traveling machine body 2 capable of autonomously traveling within a farm field. A working machine 3 for performing, for example, agricultural work is removably attached to the traveling machine body 2.

[0014] Examples of this working machine 3 include various working machines such as a cultivator, plow, fertilizer applicator, grass cutter, and seed sower. A desired working machine 3 can be selected from these as needed and attached to the traveling machine body 2. The traveling machine body 2 is configured so that the height and posture of the attached working machine 3 can be changed.

[0015] 1 and 2 show an example in which a tiller is attached to the traveling machine body 2 as the working machine 3. The tiller has tiller tines 3b arranged inside a cover 3a, and the tiller tines 3b rotate around the vehicle width direction as a rotation center to till the field. Here, the width (length in the vehicle width direction) in which the working machine 3 works is called the working width W1, and the length of the working machine 3 in the vehicle width direction is called the working machine width W2. In the tiller having the shape shown in FIG. 2, the width of the tiller tines 3b corresponds to the working width W1, and the width of the cover 3a corresponds to the working machine width W2. In the tiller, the tiller tines 3b are arranged inside the cover 3a, so that the working width W1<the working machine width W2. However, this is not limited thereto, and for example, in the case of a fertilizer applicator that spreads a chemical agent in the width direction, the working width W1>the working machine width W2 may be the case.

[0016] Next, the configuration of the tractor 1 will be described in more detail with reference to Figures 1 and 2. As shown in Figure 1, the traveling body 2 of the tractor 1 has its front part supported by a pair of left and right front wheels 7, 7, and its rear part supported by a pair of left and right rear wheels 8, 8.

[0017] A bonnet 9 is disposed at the front of the traveling body 2. An engine 10, which is the drive source of the tractor 1, and a fuel tank (not shown) are housed within this bonnet 9. This engine 10 can be configured, for example, as a diesel engine, but is not limited to this and may be configured, for example, as a gasoline engine. Also, an electric motor may be used as the drive source in addition to or instead of the engine.

[0018] A cabin 11 for an operator to ride in is disposed behind the bonnet 9. Inside this cabin 11, mainly provided are a steering wheel 12 for the operator to steer, a seat 13 in which the operator can sit, and various operating devices for performing various operations. However, a work vehicle such as the tractor 1 may or may not be provided with the cabin 11.

[0019] 2, the monitor device 14, the throttle lever 15, the main shift lever 27, the multiple hydraulic control levers 16, the PTO switch 17, the PTO shift lever 18, the sub shift lever 19, the forward / reverse switch lever 25, the parking brake 26, the work equipment lift switch 28, etc. These operating devices are disposed near the seat 13 or near the steering wheel 12.

[0020] The monitor device 14 is configured to be able to display various information about the tractor 1. The throttle lever 15 is an operating tool for setting the rotation speed of the engine 10. The main speed change lever 27 is an operating tool for steplessly changing the travel speed of the tractor 1. The hydraulic operation lever 16 is an operating tool for switching a hydraulic external take-off valve (not shown). The PTO switch 17 is an operating tool for switching between transmission and cut-off of power to a PTO shaft (not shown) (power take-off shaft) protruding from the rear end of the transmission 22. That is, when the PTO switch 17 is in the ON state, power is transmitted to the PTO shaft, the PTO shaft rotates, and the work machine 3 is driven, whereas when the PTO switch 17 is in the OFF state, the power to the PTO shaft is cut off, the PTO shaft does not rotate, and the work machine 3 is stopped. The PTO speed change lever 18 is used to change the power input to the work machine 3, and specifically, is an operating tool for changing the rotation speed of the PTO shaft. The auxiliary speed change lever 19 is an operating tool for changing the gear ratio of the traveling auxiliary speed change gear mechanism in the transmission 22. The forward / reverse switching lever 25 is configured to be switchable between a forward position, a neutral position, and a reverse position. When the forward / reverse switching lever 25 is in the forward position, the power of the engine 10 is transmitted to the rear wheels 8, and the tractor 1 moves forward. When the forward / reverse switching lever 25 is in the neutral position, the tractor 1 does not move forward or backward. When the forward / reverse switching lever 25 is in the reverse position, the power of the engine 10 is transmitted to the rear wheels 8, and the tractor 1 moves backward. The parking brake 26 is an operating tool that is operated by the operator's hand to generate a braking force, and is used, for example, when the tractor 1 is stopped for a while. The working equipment lift switch 28 is an operating tool for lifting and lowering the height of the working equipment 3 attached to the traveling machine body 2 within a predetermined range.

[0021] 1, a chassis 20 of the tractor 1 is provided under the traveling body 2. The chassis 20 is made up of a body frame 21, a transmission 22, a front axle 23, a rear axle 24, and the like.

[0022] The machine frame 21 is a support member at the front of the tractor 1, and supports the engine 10 directly or via a vibration-proof member or the like. The transmission 22 changes the power from the engine 10 and transmits it to a front axle 23 and a rear axle 24. The front axle 23 is configured to transmit the power input from the transmission 22 to the front wheels 7. The rear axle 24 is configured to transmit the power input from the transmission 22 to the rear wheels 8.

[0023] As shown in FIG. 3, the tractor 1 includes a control unit 4. The control unit 4 is configured as a known computer and includes an arithmetic unit such as a CPU, a storage device such as a non-volatile memory, and an input / output unit (not shown). The storage device stores various programs and data related to the control of the tractor 1. The arithmetic unit can read out and execute various programs from the storage device. The above hardware and software work together to allow the control unit 4 to operate as a travel control unit 4a and a work machine control unit 4b. The travel control unit 4a controls the travel (forward, backward, stop, turning, etc.) of the traveling machine body 2. The work machine control unit 4b controls the operation (lifting, driving, stopping, etc.) of the work machine 3. The control unit 4 can also perform other controls (for example, analysis of captured images, etc.). The control unit 4 may be configured as one computer or multiple computers.

[0024] The travel control unit 4a performs vehicle speed control to control the speed of the tractor 1 and steering control to steer the tractor 1. When performing vehicle speed control, the control unit 4 controls at least one of the rotation speed of the engine 10 and the gear ratio of the transmission 22.

[0025] Specifically, the engine 10 is provided with a governor device 41 that includes an actuator (not shown) that changes the rotation speed of the engine 10. The cruise control unit 4a can control the rotation speed of the engine 10 by controlling the governor device 41. The engine 10 is also provided with a fuel injection device 45 that adjusts the injection timing and injection amount of fuel to be injected (supplied) into the combustion chamber of the engine 10. The cruise control unit 4a can, for example, stop the supply of fuel to the engine 10 and stop the operation of the engine 10 by controlling the fuel injection device 45.

[0026] The transmission 22 is provided with a speed change device 42, which is, for example, a hydraulic continuously variable speed change device of a movable swash plate type. The travel control unit 4a changes the gear ratio of the transmission 22 by changing the angle of the swash plate of the speed change device 42 using an actuator (not shown). By performing the above processing, the tractor 1 is changed to the target vehicle speed.

[0027] When performing steering control, the traveling control unit 4a controls the rotation angle of the steering wheel 12. Specifically, a steering actuator 43 is provided in the middle of the rotation axis (steering shaft) of the steering wheel 12. In this configuration, when the tractor 1 travels along a predetermined route, the control unit 4 calculates an appropriate rotation angle of the steering wheel 12 so that the tractor 1 travels along the route, and drives the steering actuator 43 to achieve the obtained rotation angle, thereby controlling the rotation angle of the steering wheel 12.

[0028] The work implement control unit 4b controls the PTO switch 17 based on whether a work execution condition is satisfied, thereby switching between driving and stopping the work implement 3. The work implement control unit 4b also controls the elevation and lowering of the work implement 3.

[0029] Specifically, the tractor 1 is provided with a lifting actuator 44 consisting of a hydraulic cylinder or the like, near the three-point linkage that connects the work implement 3 to the traveling body 2. The work implement control unit 4b drives the lifting actuator 44 to appropriately lift and lower the work implement 3, allowing the work implement 3 to perform work at a desired height.

[0030] A tractor 1 equipped with a control unit 4 as described above can control each part of the tractor 1 (the running body 2, the work equipment 3, etc.) via the control unit 4, allowing the tractor 1 to autonomously travel within a field and perform autonomous work, without the need for an operator to board the cabin 11 and perform various operations.

[0031] Next, a configuration for acquiring information required for autonomous traveling will be described. Specifically, as shown in Fig. 3 etc., the tractor 1 of this embodiment is equipped with a positioning antenna 6, a wireless communication antenna 48, a front camera 56, a rear camera 57, a vehicle speed sensor 53, a steering angle sensor 52, etc. In addition to these, the tractor 1 is equipped with an inertial measurement unit (IMU: orientation detection unit) 58 that can specify the attitude and traveling direction (vehicle orientation) of the traveling body 2 by calculating a roll angle, a pitch angle, and a yaw angle.

[0032] The positioning antenna 6 receives signals from positioning satellites constituting a positioning system such as a global navigation satellite system (GNSS). As shown in FIG. 1, the positioning antenna 6 is attached to the upper surface of the roof 5 of the cabin 11 of the tractor 1. The positioning signal received by the positioning antenna 6 is input to a position information acquisition unit (positioning unit) 49 shown in FIG. 3. The position information acquisition unit 49 calculates and acquires position information of the traveling body 2 of the tractor 1 (strictly speaking, the positioning antenna 6) as, for example, latitude and longitude information. The position information acquired by the position information acquisition unit 49 is input to the control unit 4 and used for autonomous traveling, determination of a selected side, which will be described later, and the like.

[0033] In this embodiment, a highly accurate satellite positioning system using the GNSS-RTK method is used, but the present invention is not limited to this, and other positioning systems may be used as long as they can obtain highly accurate position coordinates. For example, a differential GPS (DGPS) or a satellite-based augmentation system (SBAS) may be used.

[0034] The wireless communication antenna 48 receives signals from the wireless communication terminal 46 operated by the operator and transmits signals to the wireless communication terminal 46. As shown in FIG. 1, the wireless communication antenna 48 is attached to the upper surface of the roof 5 of the cabin 11 of the tractor 1. A signal received by the wireless communication antenna 48 from the wireless communication terminal 46 is processed by the wireless communication unit 40 shown in FIG. 3 and then input to the control unit 4. A signal to be transmitted from the control unit 4 or the like to the wireless communication terminal 46 is processed by the wireless communication unit 40, then transmitted from the wireless communication antenna 48 and received by the wireless communication terminal 46.

[0035] The front camera 56 photographs the area in front of the tractor 1. The rear camera 57 photographs the area behind the tractor 1. The front camera 56 and the rear camera 57 are attached to the roof 5 of the tractor 1. Video data photographed by the front camera 56 and the rear camera 57 is transmitted by the wireless communication unit 40 from the wireless communication antenna 48 to the wireless communication terminal 46. The wireless communication terminal 46, which has received the video data, displays the content on the display 61.

[0036] The vehicle speed sensor 53 detects the vehicle speed of the tractor 1, and is provided, for example, on the axle between the front wheels 7, 7. Data of the detection result obtained by the vehicle speed sensor 53 is output to the control unit 4. Note that the vehicle speed of the tractor 1 may not be detected by the vehicle speed sensor 53, but may be calculated based on the travel time of the tractor 1 over a predetermined distance using the positioning antenna 6.

[0037] The steering angle sensor 52 is a sensor that detects the steering angle of the front wheels 7, 7. In this embodiment, the steering angle sensor 52 is provided on a kingpin (not shown) provided on the front wheels 7, 7. Data on the detection result obtained by the steering angle sensor 52 is output to the control unit 4. Note that the steering angle sensor 52 may be configured to be provided on a steering shaft.

[0038] The wireless communication terminal 46 is configured as, for example, a tablet-type personal computer. The operator can refer to and confirm information displayed on a display (display unit) 61 of the wireless communication terminal 46. The operator can also operate a touch panel (not shown) arranged to cover the display 61, hardware keys (not shown) located near the display 61, or the like, to transmit control signals (for example, an automatic travel start signal, an automatic travel stop signal, etc.) for controlling the tractor 1 to the control unit 4 of the tractor 1.

[0039] The wireless communication terminal 46 is not limited to being configured as a tablet-type personal computer, and may be configured as, for example, a node-type personal computer, a smartphone, etc. When the tractor 1 is caused to perform autonomous traveling with an operator on board the tractor 1, the tractor 1 side (for example, the control unit 4) may be provided with the same functions as the wireless communication terminal 46.

[0040] The configuration of the wireless communication terminal 46 included in the autonomous driving control system 100 will be described in detail below with reference to FIG. 3 and other figures.

[0041] As shown in Figure 3, the wireless communication terminal 46 includes a display 61, a terminal communication unit 62, a determination distance calculation unit 63, a determination angle calculation unit 64, a field information setting unit 65, a work area setting unit 66, a work path generation unit 67, a headland traveling auxiliary path creation unit 68, an auxiliary path creation edge determination unit 69, and an auxiliary path creation edge locking unit 70.

[0042] The wireless communication terminal 46 includes a calculation device such as a CPU (not shown), a storage device such as a non-volatile memory, and an input / output unit. The storage device stores various programs and data related to travel routes. The calculation device can read and execute various programs from the storage device. The storage device configures a terminal storage unit (field information storage unit) 60 of the wireless communication terminal 46.

[0043] Through collaboration between the above hardware and software, the wireless communication terminal 46 can operate as a terminal communication unit 62, a determination distance calculation unit 63, a determination angle calculation unit 64, a field information setting unit 65, a work area setting unit 66, a work path generation unit 67, a headland driving auxiliary path creation unit 68, an auxiliary path creation edge determination unit 69, and an auxiliary path creation edge locking unit 70.

[0044] The terminal communication unit 62 is for communicating with the tractor 1. The wireless communication terminal 46 can receive and acquire information such as the traveling position (vehicle position) and traveling direction (vehicle orientation) of the tractor 1 from the tractor 1 via the terminal communication unit 62, and can transmit set farm field information (distribution of work areas and headland areas, etc.), work routes, headland traveling auxiliary routes, control signals, and the like to the tractor 1.

[0045] When the peripheral shape of the field is expressed by a polygon, the determination distance calculation unit 63 calculates the distance between the tractor 1 and each side of the polygon. Since this distance is used to determine the selected side, which will be described later, this distance may be referred to as the determination distance D hereinafter. The determination distance calculation unit 63 calculates the determination distance D based on the position information (vehicle position) of the tractor 1 received from the tractor 1 via the terminal communication unit 62. The determination distance D is calculated in the same number as the sides. The determination distance D can be calculated by a known method of calculating the length of a perpendicular line drawn from the vehicle position point to the side. The vehicle position point is preferably located at the center in the width direction of the tractor 1 to simplify the calculation, but may be shifted from the center in the width direction. The position of the positioning antenna 6 can be adopted as the vehicle position point, but is not limited to this.

[0046] The determination angle calculation unit 64 calculates the angle between the traveling direction (vehicle orientation) of the tractor 1 and each side portion constituting the periphery of the field. Since this angle is used to determine the selected side portion described later, this angle may be referred to as the determination angle θ hereinafter. The determination angle calculation unit 64 calculates the determination angle θ based on the vehicle orientation of the tractor 1 received from the tractor 1 via the terminal communication unit 62. The determination angles θ are calculated in the same number as the sides. Since the orientation of each side portion is known in advance, the determination angle θ can be easily obtained. The determination angle θ can be considered as the amount by which the vehicle orientation of the tractor 1 deviates from the orientation of the side portion. In this embodiment, the determination angle θ is always a value greater than or equal to 0° and less than 180°, but is not limited to this.

[0047] The field information setting unit 65 is for setting information (hereinafter, sometimes referred to as field information) about the field 90 shown in Fig. 4. Information on the position and shape of the field 90 can also be acquired, for example, by having the operator operate the wireless communication terminal 46 while a map is displayed on the display 61 to specify a number of points on the map, based on a specified polygon such that lines (sides) connecting the specified points do not intersect.

[0048] However, the present invention is not limited to this, and the information can be automatically acquired by, for example, having an operator get on the tractor 1 and drive it around the perimeter of the field, and storing the side (periphery) obtained from the transition of the position information of the positioning antenna 6 at that time. The field information setting unit 65 sets, as the field 90, the portion surrounded by the periphery formed from the multiple sides acquired as described above.

[0049] The work area setting unit 66 sets the position of a work area where the tractor 1 performs autonomous work while traveling autonomously. To be more specific, the operator sets the headland width (distance away from the edge of the field) W0 and the like on an input screen displayed on the display 61. The work area setting unit 66 determines the headland area based on the headland width W0 input by the operator's operation and the outer circumferential shape (edge) of the field 90 set by the field information setting unit 65, and determines the area of ​​the field 90 excluding the headland area as the work area.

[0050] The terminal memory unit 60 stores field information such as the position and shape of the field set by the field information setting unit 65, work information such as the start and end positions for autonomous driving specified by the operator operating the wireless communication terminal 46, the work direction, and the work area and headland area defined as described above.

[0051] The work path generating unit 67 generates a travel path along which the tractor 1 travels autonomously when performing autonomous work in a work area in a farm field. The work path generating unit 67 generates a travel path along which the tractor 1 travels autonomously when performing autonomous work, based on work information such as the work width W1, the work implement width W2, the type of work implement 3, the work start position, the work end position, and the work direction input by the operator by operating a touch panel or the like, and the work area set by the work area setting unit 66. As shown in FIG. 4, the travel path alternately includes a straight travel path generated in the work area and a turning path for turning generated in the headland area. Note that the travel path is not limited to a straight line, and may be formed in a broken line or the like as necessary.

[0052] The headland traveling auxiliary path creating unit 68 creates a headland traveling auxiliary path along which the tractor 1 travels autonomously so that the tractor 1 can work autonomously in the headland area in the field. The headland traveling auxiliary path creating unit 68 creates a headland traveling auxiliary path as shown in FIG. 4 based on the working width W1, working implement width W2, auxiliary path reference, headland area set by the working area setting unit 66, and the like, which are input by the operator operating a touch panel or the like. The headland traveling auxiliary path is formed in a straight line. In other words, the headland traveling auxiliary path is intended for the straight traveling of the tractor 1 in the headland, and does not target turning traveling. In the following description, this headland traveling auxiliary path may be simply referred to as an auxiliary path.

[0053] The auxiliary route reference is a reference for creating an auxiliary route, and may be the periphery of the work area or the periphery of the field. In other words, the operator can specify either the periphery of the work area or the periphery of the field as the auxiliary route reference by operating a touch panel or the like.

[0054] When the edge of the field is specified as the auxiliary path reference, the headland traveling auxiliary path creation unit 68 creates an auxiliary path parallel to the edge of the field and offset inward by a predetermined interval according to the mounting position of the work implement 3, as shown in Figure 4.

[0055] It is preferable that the above-mentioned predetermined interval be set to at least half the working machine width W2 when the widthwise center of the working machine 3 coincides with the widthwise center of the tractor 1. On the other hand, when the widthwise center of the working machine 3 does not coincide with the widthwise center of the tractor 1 (i.e., when the working machine 3 is attached to the tractor 1 in a state where it is offset from the widthwise center of the traveling body 2), it is preferable that the above-mentioned predetermined interval be set to be larger than half the working machine width W2, taking into account the offset amount of the working machine 3.

[0056] The headland travel auxiliary path creating unit 68 further offsets the created auxiliary path further inward by the working width (predetermined width) W1 to create another auxiliary path. Figure 4 shows an example in which an auxiliary path is created for one of the four sides of the field.

[0057] It is preferable that the headland traveling auxiliary path creation unit 68 creates an auxiliary path for the first auxiliary path that is closest (located outermost) to the field edge used as the auxiliary path reference, so that the distance from the field edge is at least half the work implement width W2.

[0058] When the working area periphery is specified as the auxiliary path reference, the headland traveling auxiliary path creation unit 68 creates an auxiliary path parallel to the working area periphery and offsetting it outward by at least half the working width W1, as shown by the dotted line in Fig. 5. The headland traveling auxiliary path creation unit 68 further offsets the created auxiliary path outward by the working width W1 to create another auxiliary path. Fig. 5 shows an example in which an auxiliary path is created for one of the four sides of a farm field.

[0059] To explain in more detail, for example, if the distance between the auxiliary path closest to the field edge and the field edge is less than half the work implement width W2, as shown by the dotted line in Fig. 5, there is a risk that the work implement 3 will come into contact with a ridge or the like on the edge. Therefore, in this case, the headland traveling auxiliary path creation unit 68 creates a new auxiliary path by shifting the multiple created auxiliary paths toward the working area, as shown by the thin solid line in Fig. 5, so that the new auxiliary path is more than half the work implement width W2.

[0060] As described above, a plurality of auxiliary routes parallel to each other are created between the periphery of the work area and the periphery of the field by the headland traveling auxiliary route creation unit 68. The auxiliary routes created by the headland traveling auxiliary route creation unit 68 are displayed on the display 61 superimposed on field information such as the shape of the field, the headland area, the work area, etc.

[0061] The auxiliary path creation side determination unit 69 is for determining which side of the headland area should be focused on when creating the auxiliary path. As described above, multiple auxiliary paths are generated for each side of the field so as to follow the periphery of the field. In theory, auxiliary paths can be created for all sides of the field, but in this embodiment, auxiliary paths for two or more sides are not created at the same time, and the headland traveling auxiliary path creation unit 68 creates an auxiliary path only for one selected side (hereinafter, sometimes referred to as a selected side). The auxiliary path creation side determination unit 69 determines which side of the multiple sides of the field should be selected to create the auxiliary path. The selected side is determined based on the above-mentioned determination distance D and determination angle θ (and thus the vehicle position and vehicle orientation of the tractor 1). The details of this determination method will be described later.

[0062] The auxiliary path creation edge lock unit 70 can lock a selected edge portion for which the headland traveling auxiliary path creation unit 68 creates an auxiliary path. The operator instructs the locking of the selected edge portion by operating a touch panel or the like. This locking will be described in detail later.

[0063] In the autonomous driving control system 100 of this embodiment, after work in the work area is completed, the wireless communication terminal 46 displays a screen that allows the operator to select, for example, either "work in headland area" or "end work" and accepts the operator's selection. If the operator wishes to work in the headland area now, the operator selects "work in headland area." On the other hand, if the operator wishes to work in the headland area later or if work in the headland area is not necessary at all, the operator selects "end work."

[0064] Next, in the autonomous driving control system 100 of this embodiment, the creation and display of a headland traveling auxiliary path in a headland area when the tractor 1 travels through the headland area to perform work will be described in detail with reference to Fig. 6 to Fig. 11. Note that the following description will be given taking as an example a farm field 90 having a rectangular periphery composed of four sides 91, 92, 93, and 94 as shown in Fig. 6 etc.

[0065] When the operator operates the wireless communication terminal 46 to select the above-mentioned "work in headland area", the determination distance calculation unit 63 acquires position information of the tractor 1 via the terminal communication unit 62. In addition, the determination angle calculation unit 64 acquires orientation information of the tractor 1 via the terminal communication unit 62. In the tractor 1, the position information can be obtained by the position information acquisition unit 49, and the orientation information can be obtained by the inertial measurement unit 58.

[0066] Based on the current position of the tractor 1 and the position information of each of the sides 91, 92, 93, and 94 that form the periphery of the field 90, the determination distance calculation unit 63 calculates the distance between the tractor 1 and each of the sides as a determination distance D.

[0067] The determination angle calculation unit 64 calculates the angle between the vehicle direction of the tractor 1 and each side, based on the orientation information of the tractor 1 and the orientations on the map of each of the sides 91, 92, 93, and 94 of the field 90. In this example, since the two opposing sides are parallel, the determination angle calculation unit 64 may calculate the angle with respect to either one of the two sides (sides 91 and 93 or sides 92 and 94) as the determination angle θ.

[0068] When the tractor 1 is at position A in FIG. 6, the determination distance D and the determination angle θ in relation to the side 91 can be shown as shown in FIG.

[0069] The auxiliary path creation edge determination unit 69 comprehensively evaluates each determination distance D calculated by the determination distance calculation unit 63 and each determination angle θ calculated by the determination angle calculation unit 64, and determines the selected edge for which the headland driving auxiliary path creation unit 68 will create an auxiliary path.

[0070] More specifically, when determining the selected side, the auxiliary route creation side determiner 69 uses an evaluation function R(D, θ) for comprehensively evaluating the determination distance D and the determination angle θ. The auxiliary route creation side determiner 69 determines, as the selected side, a portion of the headland region that corresponds to the side for which R(D, θ) is the smallest.

[0071] The evaluation function R can be determined in any manner, but for example, it can be a function that appropriately weights and adds the value of θ (unit: °) and the value of D (unit: meter). The value of the evaluation function R is determined for each of the sides 91, 92, 93, and 94. In the example shown at position A in FIG. 6, among the four sides 91, 92, 93, and 94, the vehicle orientation of the tractor 1 is closest to the sides 91 and 93, and the vehicle position of the tractor 1 is closest to the side 91. Therefore, the value of the evaluation function R for the side 91 is the smallest. For this reason, the auxiliary path creation side determination unit 69 determines the side 91 as the selected side.

[0072] Here, when the operator operates a touch panel or the like to specify the work start position and work direction of work in the headland area, the auxiliary path creation side determiner 69 may determine a selected side for which the headland traveling auxiliary path creation unit 68 will first create an auxiliary path, based on the work start position and work direction specified by the operator. That is, the determination distance calculator 63 calculates each of the determination distances D based on the work start position specified by the operator. The determination angle calculator 64 calculates each of the determination angles θ based on the work direction specified by the operator.

[0073] The headland traveling auxiliary path creating unit 68 creates a plurality of auxiliary paths parallel to each other as described above in correspondence with the selected side portions determined by the auxiliary path creation side determining unit 69 as shown in FIG.

[0074] As shown in Fig. 9, the display 61 displays the auxiliary route created by the headland traveling auxiliary route creation unit 68. The portion marked with a grass pattern in Fig. 9 indicates a part of the farm field 90. The display of the part of the farm field 90 on the display 61 can be enlarged / reduced in response to an operation by the operator.

[0075] As described above, the auxiliary route is displayed only in the portion of the headland area where the tractor 1 is traveling or will travel in the future. This limited display makes the display screen of the display 61 simple, as shown in Fig. 9, making it easier for the operator to confirm.

[0076] The selected side (in other words, which side corresponds to which auxiliary path is to be created) is determined by the auxiliary path creation side determiner 69 by comprehensively evaluating the determination distance D and the determination angle θ. Therefore, by appropriately determining the evaluation function R(D, θ), it is possible to display the auxiliary path corresponding to side 91 even when, for example, the tractor 1 is located near position A in FIG. 6 and the vehicle orientation of the tractor 1 is significantly changed for some reason such as obstacle avoidance, causing the vehicle orientation to be along side 92, 94. This composite evaluation makes it possible to prevent the auxiliary path of side 92 or side 94 from being displayed even when the operator wants to work along side 91.

[0077] When it is confirmed that the vehicle position of the tractor 1 (or the instructed start position) substantially matches any of the auxiliary routes created by the headland traveling auxiliary route creation unit 68 and that the tractor 1 can travel along the auxiliary route, the auxiliary route is highlighted on the display 61. Fig. 9 shows an example in which the auxiliary route is highlighted using a thick dotted line. The highlighting is not limited to a thick dotted line, and for example, the auxiliary route may be displayed in a different color, or a message may be displayed near the auxiliary route (or a mark indicating the tractor 1).

[0078] When it is confirmed that the tractor 1 can travel along the auxiliary route displayed on the display 61, the operator touches, for example, an "automatic steering start" button on the right side of the display screen shown in FIG. 9 to start the autonomous travel of the tractor 1. When the tractor 1 receives a control command to start the autonomous travel from the wireless communication terminal 46 via the wireless communication unit 40, the travel control unit 4a controls the structure related to travel to make the tractor 1 travel autonomously, and the work machine control unit 4b controls the structure related to work to make the tractor 1 work autonomously. As a result, as shown in FIG. 7, the tractor 1 performs work on the headland area while traveling autonomously along the auxiliary route created by the headland travel auxiliary route creation unit 68.

[0079] In the autonomous driving control system 100 of this embodiment, turning of the tractor 1 in the headland area is performed by the operator operating the steering wheel 12. The autonomous driving control system 100 of this embodiment is configured to notify the operator shortly before the timing when turning is required.

[0080] 7, the distance D0 between the tractor 1 and a side 92 of a field 90 ahead in the traveling direction of the tractor 1 is monitored. When the distance D0 becomes equal to or smaller than a predetermined threshold, the tractor 1 or the wireless communication terminal 46 notifies the operator by, for example, sounding a buzzer.

[0081] Consider a case where, after working along side 91, the operator turns the tractor 1 at the position shown as position B in Fig. 6 to work along side 92. Even in this situation, the auxiliary path creation side determination unit 69 determines the selected side by comprehensively evaluating the determination distance D for each side and the determination angle θ for each side.

[0082] Referring to Figure 6, in area A1 where the determination distance D1 for side 91 is greater than the determination distance D2 for side 92, side 92 is determined to be the selected side even if the determination angle θ1 for side 91 is smaller than the determination angle θ2 for side 92.

[0083] In addition, in area A2 where the determination distance D1 for side 91 is smaller than the determination distance D2 for side 92, side 92 is determined to be the selected side, provided that the determination angle θ1 for side 91 is greater than the determination angle θ2 for side 92.

[0084] The auxiliary path is used as a reference for aligning the vehicle position of the tractor 1 during autonomous driving. Therefore, in headland work, when work is to be carried out along side 92 immediately after work has been carried out along side 91, it is generally desirable that the auxiliary path for side 92 be displayed on the display 61 early. By defining the evaluation function R(D, θ) so that the selected side is determined as described above, it is possible to prevent delay in displaying the auxiliary path for side 92. As a result, it becomes easy to manually turn the tractor 1 so as to quickly align the vehicle position with the auxiliary path for side 92 and switch to autonomous driving.

[0085] The autonomous driving control system 100 of this embodiment can operate in an early display mode. The early display mode is a mode in which, when switching the side portion to be worked on in the headland area, the auxiliary route in the headland area portion to be switched to is displayed earlier than the above. The operator can turn the early display mode on and off by operating a touch panel or the like. When the early display mode is on, in the above example, in the tractor 1 working along the side portion 91, when the determination angle θ1 related to the side portion 91 becomes equal to or greater than a predetermined angle, the side portion 92 is determined as the selected side portion even in the area A2 in which the determination distance D1 related to the side portion 91 is smaller than the determination distance D2 related to the side portion 92. This predetermined angle is set to an angle smaller than half the angle between the side portion 91 and the side portion 92, for example, 30°. As a result, the display of the auxiliary route is switched in a predictive manner just by the tractor 1 turning by more than a predetermined angle, so that the side portion to be worked on by the tractor 1 can be smoothly changed.

[0086] In the early display mode, the selected side may be changed with emphasis on the decision angle θ as described above only when the difference between the decision distance D1 for the side 91 currently being worked on and the decision distance D2 for the side 92 adjacent to the side 91 is within a predetermined range. In this case, it is possible to prevent the display of the auxiliary path from being switched simply by the tractor 1 turning slightly near the center of the side 91, for example. Also, the selected side may be changed with emphasis on the decision angle θ only when the vehicle position of the tractor 1 is near the vertex where the side 91 and the side 92 are connected.

[0087] As described above, only the auxiliary path created for the selected side determined by the auxiliary path creation side determination unit 69 is displayed on the display 61. Therefore, as shown in Figure 10 etc., when an auxiliary path is displayed in the headland area corresponding to side 92 by turning the tractor 1, the display of the auxiliary path created for the headland area corresponding to side 91 disappears almost simultaneously. In this way, the creation and display of the auxiliary path can be switched in response to the change of the side to be worked on.

[0088] As shown in Fig. 8, the start position of the autonomous traveling of the tractor 1 may deviate from the created auxiliary route for some reason. In this case, in the autonomous traveling control system 100 of this embodiment, the headland traveling auxiliary route creation unit 68 shifts the created auxiliary route based on the vehicle position of the tractor 1 acquired from the tractor 1 via the terminal communication unit 62 to create a new auxiliary route. The dotted line in Fig. 8 indicates the auxiliary route before the shift, and the thin solid line in Fig. 8 indicates the auxiliary route after it has been shifted to match the vehicle position of the tractor 1.

[0089] When the auxiliary path is shifted to match the vehicle position of the tractor 1 as described above, the headland traveling auxiliary path creation unit 68 stores this shift amount. When the tractor 1 goes around the headland area and creates an auxiliary path again for the same selected side, the auxiliary path is shifted in the same way based on the stored shift amount. In this way, when the tractor 1 goes around the headland area to work and a shift is made in one turn, the shift amount of the auxiliary path can be maintained in the subsequent turn at the same selected side where the shift was made. As a result, a neat finish can be achieved.

[0090] The shifting of the auxiliary route by the headland traveling auxiliary route generating unit 68 may be performed automatically, or may be performed in response to an operation by an operator (for example, a button for shifting).

[0091] The autonomous driving control system 100 of this embodiment has a lock function for locking a selected side. When the operator wishes to concentrate on one particular side among the four sides, the operator touches that side in the field 90 displayed on the display 61. This enables the lock function. However, this is not limiting, and for example, a separate button for locking the selected side may be provided. When the lock function is enabled, as shown in FIG. 11, the indicated side is displayed on the display 61 in a manner that makes it possible to distinguish the indicated side from the other sides by displaying the indicated side in a thick line or by displaying a lock mark or the like on the indicated side.

[0092] The auxiliary path creation edge lock unit 70 fixes the edge designated by the operator as the selected edge. In this case, regardless of the vehicle position and vehicle orientation of the tractor 1, the selected edge determined by the auxiliary path creation edge determination unit 69 is not changed from the headland area portion corresponding to the edge designated at the time of the lock operation. In other words, the automatic switching function of the selected edge by the auxiliary path creation edge determination unit 69 is substantially blocked.

[0093] 11, the auxiliary path displayed on the display 61 is only the path created for the portion corresponding to the side specified by the operator. Depending on the situation, the operator may want to perform work by traveling back and forth while repeating going straight, turning, going straight, turning, ... along multiple auxiliary paths displayed on a specific side 92. In this case, the operator is not bothered by switching the display of the auxiliary path when turning the tractor 1.

[0094] The lock function can be released, for example, by touching the locked side again, by touching a separately provided release button, etc. When the lock function is released, the automatic determination function of the selected side by the auxiliary path creation side determination unit 69 becomes effective.

[0095] The function of automatically determining the selected edge by the auxiliary path creation edge determiner 69 may be automatically blocked during the autonomous traveling of the tractor 1. This makes it possible to prevent the display of the auxiliary path from being switched even if, for example, the direction of the tractor 1 changes for some reason while the tractor 1 is autonomously traveling along the auxiliary path.

[0096] Specifically, for example, the operator touches an "automatic steering start" button displayed on the display 61 to start the autonomous driving of the tractor 1. At the same time that the autonomous driving of the tractor 1 starts, automatic determination of the selected side is prevented. When the autonomous driving of the tractor 1 is released, the above-mentioned prevention is released in conjunction with this. The auxiliary path creation side determination unit 69 newly determines the selected side based on the vehicle position and vehicle orientation of the tractor 1 at the time when the autonomous driving of the tractor 1 is released.

[0097] The autonomous driving of the tractor 1 may be cancelled, for example, by the operator touching an "automatic steering stop" button displayed on the display screen of the display 61 shown in Fig. 10, or may be cancelled automatically when the operator operates the steering wheel 12 to steer the vehicle by a predetermined steering angle or more. That is, the wireless communication terminal 46 and the steering wheel 12 function as an autonomous driving cancellation unit of the autonomous driving control system 100 of this embodiment.

[0098] As a result, when the operator turns the tractor 1 by operating the steering wheel 12 in a case such as that shown in position B in Figure 6, the autonomous driving of the tractor 1 is cancelled and the auxiliary path creation edge determination unit 69 determines a new selected edge. The vehicle position and vehicle orientation of the tractor 1 change from moment to moment, and the selected edge is determined each time. When the tractor 1 turns to a certain extent or more, the selected edge is switched from edge 91 to edge 92.

[0099] The auxiliary route created by the headland traveling auxiliary route creation unit 68 for the newly selected side determined by the auxiliary route creation side determination unit 69 is displayed on the display 61, and as shown in Fig. 9, a display appears confirming that the auxiliary route is travellable at the current position of the tractor 1. In this state, the operator can have the tractor 1 autonomously perform work in the corresponding headland area by touching the "automatic steering start" button again.

[0100] As described above, the autonomous driving control system 100 of this embodiment includes the terminal storage unit 60, the position information acquisition unit 49, the inertial measurement unit 58, the determination distance calculation unit 63, the determination angle calculation unit 64, the headland traveling auxiliary path creation unit 68, the auxiliary path creation side determination unit 69, and the traveling control unit 4a. The terminal storage unit 60 stores field information related to a work area in which the tractor 1 performs work while traveling autonomously, which is set in a field 90 surrounded by a periphery formed by a plurality of sides, and a headland area formed between the periphery and the work area. The position information acquisition unit 49 acquires the traveling position of the tractor 1 as the vehicle position. The inertial measurement unit 58 acquires the traveling direction of the tractor 1 as the vehicle orientation. The determination distance calculation unit 63 calculates the distance between each side and the vehicle position of the tractor 1 as the determination distance D. The determination angle calculation unit 64 calculates the angle between each side and the vehicle direction as a determination angle θ. The headland traveling auxiliary path creation unit 68 creates a plurality of headland traveling auxiliary paths arranged at predetermined widths parallel to a selected side selected from the plurality of sides. The auxiliary path creation side determination unit 69 evaluates each of the determination distances D calculated by the determination distance calculation unit 63 and each of the determination angles θ calculated by the determination angle calculation unit 64, thereby automatically determining the selected side for which the headland traveling auxiliary path is to be created. The travel control unit 4a causes the tractor 1 to travel autonomously along the headland traveling auxiliary path.

[0101] This makes it possible to automatically select an edge according to the position and orientation of the tractor 1 in the headland area, and automatically create a headland traveling auxiliary path for this selected edge. In addition, since the selected edge is determined by comprehensively considering the position and orientation of the tractor 1, the selected edge can be determined in accordance with the operator's intention under various circumstances. Therefore, autonomous traveling can be easily performed in the edge in which the operator wants to work with the tractor 1 in the headland area.

[0102] The autonomous driving control system 100 of this embodiment also includes a steering wheel 12 and a wireless communication terminal 46 that function as an autonomous driving cancellation unit. The autonomous driving cancellation unit cancels the autonomous driving of the tractor 1 by the driving control unit 4a. When the autonomous driving of the tractor 1 is canceled, the auxiliary path creation edge determination unit 69 newly determines a selected edge based on the determination distance D based on the vehicle position of the tractor 1 after the autonomous driving is canceled and the determination angle θ based on the vehicle orientation.

[0103] This makes it possible to quickly determine the selected side that matches the vehicle position and vehicle orientation of the tractor 1 after the autonomous traveling is released (and thus to create the headland traveling auxiliary path).

[0104] Moreover, the autonomous driving control system 100 of this embodiment includes a display 61. The display 61 displays the headland driving assistance route and the vehicle position of the tractor 1.

[0105] This allows the operator to easily confirm the positional relationship between the created headland traveling supplementary route and the tractor 1. In addition, since the headland traveling supplementary route for unnecessary sides is not displayed, the display screen can be made easy to understand and simple.

[0106] Moreover, the autonomous driving control system 100 of this embodiment includes an auxiliary path creation edge locking unit 70. The auxiliary path creation edge locking unit 70 fixes the selected edge. When the selected edge is fixed by the auxiliary path creation edge locking unit 70, even if at least one of the determination distance D based on the vehicle position and the determination angle θ based on the vehicle orientation is changed, the auxiliary path creation edge determining unit 69 does not newly determine the selected edge.

[0107] This makes it possible to prevent the operator from having to bother with switching auxiliary routes when, for example, it is desired to first complete only the portion of the headland region that corresponds to one side.

[0108] Although the preferred embodiment of the present invention has been described above, the above configuration can be modified, for example, as follows.

[0109] The headland traveling auxiliary route creation unit 68 may first create an auxiliary route for the entire headland area and store it in the terminal storage unit 60. In this case, the display 61 displays only the auxiliary route that corresponds to the selected side determined by the auxiliary route creation side determination unit 69. However, creating an auxiliary route every time the selected side is changed as in the above embodiment is advantageous in that an auxiliary route can be created flexibly.

[0110] The auxiliary route may be created so as to extend outward from the headland region, or may be created so as to fit within the headland region.

[0111] When the periphery of the work area is used as the auxiliary route reference, one or more auxiliary routes may be additionally created outside the field as a continuation of the dotted auxiliary route shown in FIG. 5, etc. For example, in a field shaped like a rectangle with a missing corner, the actual shape of the field may be larger than the shape of the field set by the field information setting unit 65. In this case, the auxiliary route additionally created by the headland traveling auxiliary route creating unit 68 is useful. When the periphery of the field is used as the auxiliary route reference, one or more auxiliary routes including a portion passing through the work area may be additionally created as a continuation of the solid line field route shown in FIG. 5, etc.

[0112] The moving direction of the tractor 1 obtained from the change in the GNSS positioning result can be treated as the vehicle direction. In this case, the position information acquisition unit 49 corresponds to the direction detection unit.

[0113] The creation of auxiliary paths in the above-described embodiment can also be applied to farm fields having any shape other than a rectangle (for example, a trapezoid, etc.).

[0114] The auxiliary path reference for creating the auxiliary path may be automatically determined according to the vehicle position of the tractor 1. For example, when the vehicle position is close to the periphery of the work area, the headland traveling auxiliary path creation unit 68 recognizes the periphery of the work area as the auxiliary path reference, and when the vehicle position is close to the periphery of the field, the headland traveling auxiliary path creation unit 68 recognizes the periphery of the field as the auxiliary path reference.

[0115] <Notes on the invention> According to an aspect of the present invention, an autonomous driving control system having the following configuration is provided. That is, the autonomous driving control system includes a field information storage unit, a positioning unit, a direction detection unit, a determination distance calculation unit, a determination angle calculation unit, a headland traveling auxiliary path creation unit, an auxiliary path creation edge determination unit, and a traveling control unit. The field information storage unit stores field information relating to a work area in which a work vehicle performs work while autonomously traveling, which is set within a field surrounded by a periphery formed by a plurality of sides, and a headland area formed between the periphery and the work area. The positioning unit acquires the traveling position of the work vehicle as a vehicle position. The direction detection unit acquires the traveling direction of the work vehicle as a vehicle orientation. The determination distance calculation unit calculates the distance between each of the sides and the vehicle position of the work vehicle as a determination distance. The determination angle calculation unit calculates the angle formed between each of the sides and the vehicle orientation as a determination angle. The headland traveling auxiliary path creation unit creates a plurality of headland traveling auxiliary paths arranged at predetermined widths parallel to a selected side portion selected from the plurality of sides. The auxiliary path creation side determination unit automatically determines the selected side portion for which the headland traveling auxiliary path is to be created by evaluating each of the determination distances calculated by the determination distance calculation unit and each of the determination angles calculated by the determination angle calculation unit. The travel control unit causes the work vehicle to autonomously travel along the headland traveling auxiliary path.

[0116] This makes it possible to automatically select an edge according to the position and orientation of the work vehicle in the headland area, and automatically create a headland travel auxiliary path for this selected edge. In addition, since the selected edge is determined by comprehensively taking into account the position and orientation of the work vehicle, the selected edge can be determined in accordance with the operator's intention under various circumstances. Therefore, in the headland area, autonomous travel can be easily performed in the edge where the operator wants to work with the work vehicle.

[0117] The autonomous driving control system is preferably configured as follows. That is, the autonomous driving control system includes an autonomous driving cancellation unit that cancels the autonomous driving of the work vehicle by the driving control unit. When the autonomous driving of the work vehicle is canceled, the auxiliary path creation edge determination unit newly determines the selected edge based on the determination distance based on the vehicle position of the work vehicle after the autonomous driving is canceled and the determination angle based on the vehicle orientation.

[0118] This makes it possible to quickly determine the selected side that matches the vehicle position and vehicle orientation of the work vehicle after autonomous driving is released (and thus create the headland traveling supplementary path).

[0119] It is preferable that the autonomous driving control system includes a display unit that displays the headland driving auxiliary path and the vehicle position of the work vehicle.

[0120] This allows the operator to easily check the positional relationship between the created headland traveling supplementary route and the work vehicle. Also, since the headland traveling supplementary route for unnecessary sides is not displayed, the display screen can be made easy to understand and simple.

[0121] The autonomous driving control system is preferably configured as follows: That is, the autonomous driving control system includes an auxiliary path creation edge locking unit that fixes the selected edge. When the selected edge is fixed by the auxiliary path creation edge locking unit, the auxiliary path creation edge determining unit does not newly determine the selected edge even if at least one of the determination distance based on the vehicle position and the determination angle based on the vehicle orientation is changed.

[0122] This makes it possible to prevent the operator from having to bother with switching the headland traveling auxiliary path when, for example, it is desired to first complete only the portion of the headland area that corresponds to one side. [Explanation of symbols]

[0123] 1 Tractor (work vehicle) 4a Driving control unit 12 Steering handle (autonomous driving release part) 49 Location information acquisition unit (positioning unit) 46 Wireless communication terminal (autonomous driving release unit) 60 Terminal memory unit (field information memory unit) 61 Display (display unit) 63 Determination distance calculation unit 64 Decision angle calculation unit 68 Headland travel auxiliary route creation section 69 Auxiliary path creation edge determination section 70 Auxiliary path creation edge lock section 100 Autonomous Driving Control System

Claims

1. A route for working on a headland, the route being a route for working on a headland, the route being a route for working on a headland, the route being a route for working on a headland, the route being a route for working on a headland, the route being a route for working on a headland, and an auxiliary path creating unit that creates the auxiliary path parallel to a selected side portion selected from the plurality of sides. Autonomous driving control system.

2. An orientation detection unit that acquires a traveling direction of the work vehicle as a vehicle orientation; a determination angle calculation unit that calculates an angle between each of the sides and the vehicle direction as a determination angle; and an auxiliary path creation side determination unit that automatically determines the selected side based on the determination angle. The autonomous driving control system according to claim 1 .

3. A positioning unit that acquires a traveling position of the work vehicle as a vehicle position; a determination distance calculation unit that calculates a distance between each of the sides and the vehicle position of the work vehicle as a determination distance; and an auxiliary path creation side determination unit that automatically determines the selected side based on the determination distance. The autonomous driving control system according to claim 1 .

4. A route for working on a headland, the route comprising: a field surrounded by a periphery formed by a plurality of sides; and an auxiliary route set parallel to the periphery within the field, the auxiliary route being autonomously driven by a work vehicle; creating the auxiliary path parallel to a selected edge selected from the plurality of edges; Autonomous driving control method.

Citation Information

Patent Citations

  • Unmanned working method for field working vehicle

    JP1999266608A

  • Working vehicle cooperation system

    JP2016031649A

  • Path planning method for vehicle guidance

    US20150331423A1