Driving area determination device
By integrating position detection, storage, control and path generation components in the working vehicle, the automatic and accurate arrival of the working position is achieved, and the path misconfiguration is prevented through the driving trajectory correction function, the problem of operation vehicle configuration and path setting in the prior art is solved. Improves operational efficiency and safety.
Patent Information
- Application Number
- CN202110387024.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Priority Date
- 2016-03-17
- Filing Date
- 2017-03-02
- Publication Date
- 2024-11-19
- Estimated Expiration
- 2037-03-02
AI Technical Summary
The existing autonomous driving vehicles consume a lot of labor when configuring the operation start position and the operation end position, and the path setting is easily misplaced outside the field, affecting operation efficiency and safety.
A working vehicle including position detection, storage, control and path generation components is designed. It can realize autonomous driving through GPS and azimuth detection to ensure that the vehicle reaches the start and end positions accurately, and prevent path setting errors through the driving trajectory correction function. .
It reduces labor consumption for operators in configuring the working vehicle, improves operating efficiency, and prevents path setting errors, ensuring that the working vehicle operates safely and efficiently.
Smart Images

Figure CN113031624B_ABST
Abstract
Description
[0001] This application is a divisional application of the invention patent application with application number 201780010574.9 (international application number PCT / JP2017 / 008223), application date March 2, 2017, and invention name “Work vehicle and driving area determination device”. Technical Field
[0002] The invention relates to a driving area determination device. Background Art
[0003] Conventionally, there are known working vehicles such as tractors that can autonomously travel (unmanned travel) along a set route, and for example, there is a working vehicle disclosed in Patent Document 1.
[0004] The work vehicle shown in Patent Document 1 has a control program that specifies work paths in a work area (central part of the work site) where the work vehicle is used to perform work and in an area other than the work area (peripheral part). The control program enables the work vehicle to autonomously drive along the work path, thereby automating the specified work.
[0005] Patent Literature
[0006] Patent Document 1: Japanese Patent Application Laid-Open No. 10-66405 Summary of the invention
[0007] However, in the conventional work vehicle capable of autonomous driving as disclosed in Patent Document 1, an operator needs to perform driving operation of the work vehicle until the work is started.
[0008] Therefore, in the past, the operator was required to return to other accompanying work vehicles after configuring the work vehicle at the work start position, which resulted in the following problems: the work could not be started immediately after the work vehicle was configured. In addition, when the configuration positions of the work vehicles were separated, the labor required for the operator to move increased.
[0009] In the prior art disclosed in Patent Document 1 and the like, when the vertex of the travel track is erroneously designated, the outside of the field may be mistakenly set as the field, and the path may be set outside the field against the user's intention.
[0010] In addition, in the conventional work vehicle capable of autonomous driving as shown in Patent Document 1, no particular consideration is given to the stopping position at the end of the work.
[0011] Therefore, conventionally, there has been a situation in which a work vehicle that stops after completing work has interfered with work being performed by a following work vehicle.
[0012] The present invention has been completed in view of the above-mentioned existing problems, and its purpose is to provide a work vehicle that can reduce the burden of configuring a work vehicle (autonomous working vehicle) at a work start position, and to provide a driving area determination device that can prevent the path from being mistakenly set outside the driving area during the path setting process of the autonomous working vehicle, thereby improving the working efficiency.
[0013] The problems to be solved by the present invention are as described above. Next, means for solving the problems will be described.
[0014] That is, the work vehicle involved in the first technical solution of the present application includes: a body; a work machine, which is mounted on the body; a position detection unit, which can detect the position information of the body; a storage unit, which can store the travel area for the body to travel; a control unit, which can control the travel of the body in the travel area and the work performed by the work machine; and a path generation unit, which generates a path of the body in the travel area, and the control unit can autonomously travel along the path generated by the path generation unit while detecting the current position of the body in the travel area stored in the storage unit. The work vehicle is characterized in that the travel area includes: a first area, which includes a work path for the work machine to perform the work; and a second area, which is set around the first area, and when an instruction to start the work by the work machine is issued in the second area, the control unit can make the work machine start the work after making the body travel from the current position of the body to the starting point of the work path.
[0015] According to such a configuration, it is not necessary for the operator to arrange the work vehicle at the work start position, and thus it is possible to further improve the efficiency of the work performed using the work vehicle.
[0016] In addition, the work vehicle involved in the second technical solution of the present application is characterized in that it is equipped with an azimuth detection unit, which can detect the azimuth of the vehicle body. If the angle difference between the azimuth of the vehicle body and the angle from the current position relative to the starting point is not within a specified threshold, the control unit does not cause the vehicle body to travel from the current position to the starting point.
[0017] According to such a configuration, the error of the current position of the vehicle body relative to the set start position can be suppressed by the configuration of causing the vehicle body to autonomously travel when the azimuth angle of the vehicle body is within a predetermined threshold value.
[0018] In addition, the work vehicle involved in the third technical solution of the present application is characterized in that the work path includes a first work road, which includes the starting point, and the control unit determines an imaginary path obtained by extending the first work road to the second area. If the current position is within a specified deviation relative to the imaginary path, the travel of the vehicle body can be controlled in a manner to reduce the deviation, so that the vehicle body travels from the current position to the starting point. If the current position is outside the specified deviation with respect to the imaginary path, a travel path from the current position to the starting point can be generated, so that the vehicle body can travel along the travel path.
[0019] According to such a structure, the error of the current position of the vehicle body relative to the set starting point when the vehicle body reaches the starting point can be suppressed. In addition, when the current position of the vehicle body is separated from the starting point, the operating vehicle can be configured at the starting point even if the operator drives the operating vehicle to the starting point without anyone present, thereby saving the operator the labor of configuring the operating vehicle at the starting point.
[0020] That is, the work vehicle involved in the fourth technical solution of the present application includes: a body part; a work machine, which is mounted on the body part; a position detection unit, which can detect the position information of the body part; a storage unit, which can store the travel area for the body part to travel; a control unit, which can control the travel of the body part in the travel area and the work performed by the work machine; and a path generation unit, which generates a path of the body part in the travel area, and the control unit can detect the current position of the body part by using the position detection unit in the travel area stored in the storage unit while autonomously traveling along the path generated by the path generation unit, and the work vehicle is characterized in that the travel area includes: a first area, which includes a work path for the work machine to work; and a second area, which does not include the work path for the work machine to work, and the control unit can make the body part travel from the work end position of the work path to the travel end position set in the second area after the work performed by the work machine in the work path is completed.
[0021] According to such a configuration, the travel end position for the autonomously traveling work vehicle can be set to a position that does not interfere with the work of the accompanying work vehicle, and the work efficiency of the accompanying work vehicle can be further improved.
[0022] In addition, the work vehicle involved in the fifth technical solution of the present application is characterized in that it includes an azimuth angle detection unit that can detect the azimuth angle of the vehicle body, and the control unit can control the azimuth angle of the vehicle body at the travel end position.
[0023] According to such a configuration, the work vehicle can be quickly transported out of the field without damaging the edge of the field or the side margins.
[0024] In addition, the driving area determination device involved in the sixth technical solution of the present application is characterized in that it comprises: a position information acquisition unit, which can acquire the position information of the vehicle body; a driving trajectory area determination unit, which can determine the driving trajectory area of the vehicle body based on the driving trajectory of the vehicle body determined using the position information; a driving area determination unit, which can determine the driving area for the vehicle body to travel based on multiple selection points selected from the driving trajectory; and a notification unit, which can execute a specified notification, and the specified notification is a notification that implies that the driving area includes an area other than the driving trajectory area.
[0025] According to such a configuration, it is possible to prevent the path of the autonomously traveling work vehicle from being mistakenly set outside the traveling area.
[0026] In addition, the driving area determination device involved in the seventh technical solution of the present application is characterized in that it comprises: a position information acquisition unit, which can acquire the position information of the vehicle body; a driving trajectory area determination unit, which can determine the driving trajectory area of the vehicle body based on the driving trajectory of the vehicle body determined using the position information; a driving area determination unit, which can determine the driving area for the vehicle body to travel based on multiple selection points selected from the driving trajectory; and a correction unit, which can correct the driving area, and when the driving area includes an area outside the driving trajectory area, the correction unit corrects the driving area to an area that does not include the area outside the driving trajectory area.
[0027] According to such a configuration, it is possible to prevent the path of the autonomously traveling work vehicle from being mistakenly set outside the traveling area.
[0028] Effects of the Invention
[0029] According to the work vehicle according to the present invention, it is possible to further improve the efficiency of work performed using the work vehicle without requiring the operator to drive the work vehicle to the work start position.
[0030] Furthermore, according to the travel area determination device according to the present invention, it is possible to prevent the path of the autonomously traveling work vehicle from being erroneously set outside the travel area during the path setting. BRIEF DESCRIPTION OF THE DRAWINGS
[0031] Figure 1 It is a schematic side view of an autonomous driving work vehicle and a driving work vehicle.
[0032] Figure 2 It is a control block diagram of an autonomous operating vehicle.
[0033] Figure 3 This is a diagram showing an initial screen of the remote operation device.
[0034] Figure 4 This is a diagram showing the settings for a field when using an autonomous driving work vehicle.
[0035] Figure 5 This is a diagram showing an area of a field.
[0036] Figure 6 FIG. 1 is a diagram showing a situation when the autonomous driving work vehicle starts autonomous driving.
[0037] Figure 7 This is a diagram showing the relationship between the travel start position of the autonomous driving work vehicle and the field.
[0038] Figure 8 The diagram shows a determination state based on the azimuth angle when the autonomous driving work vehicle starts autonomous driving toward the work start position.
[0039] Fig. 9 1 is a diagram showing a situation where the autonomous driving work vehicle autonomously drives toward the work start position (a case where the deviation α is equal to or smaller than a threshold value).
[0040] Fig.10 1 is a diagram showing a situation where the autonomous driving work vehicle autonomously drives toward the work start position (a situation where the deviation α exceeds the threshold value).
[0041] Fig.11 It is a diagram showing a setting state of the autonomous driving start position of the autonomous driving work vehicle.
[0042] Fig.12 This is a diagram showing a setting state of the autonomous driving start position taking into account the heading angle and deviation of the autonomous driving work vehicle.
[0043] Fig.13 is a diagram showing the setting shape of the autonomous driving start position, Fig.13 (A) is a circle, Fig.13 (B) is a rectangle, Fig.13(C) is a shape in which the width becomes narrower toward the working area side.
[0044] Fig.14 It is a diagram showing a setting status of the travel end position for the autonomous driving work vehicle.
[0045] Fig.15 It is a diagram showing the setting status of the previous travel end position for the autonomous driving work vehicle.
[0046] Fig.16 It is a diagram showing a state in which the setting of the travel end position is changed.
[0047] Fig.17 It is a diagram showing a method of setting the travel end position (a method of calculating the set position).
[0048] Fig.18 This is a diagram showing a state where the autonomous driving work vehicle stops at the driving end position (when the azimuth angle is controlled).
[0049] Fig.19 This is a diagram showing the acquisition status of the travel track in the field.
[0050] Fig. 20 This is a diagram showing a setting state of a field shape based on a travel track in the field.
[0051] Fig.21 The figure shows an incorrect setting situation for the field shape.
[0052] Fig. 22 This is a diagram showing the determination status of the field shape based on the map information.
[0053] Fig.23 This is a diagram showing the setting status of the field shape in the field (a case where two areas are set in one field). Fig.23 (A) is a diagram showing the division of a field. Fig.23 (B) is a diagram showing the setting status of the field shape.
[0054] Fig.24 This is a diagram showing the setting status of the field shape in the field (a case where two areas are set in one field). Fig.24 (A) is a diagram showing an incorrect setting of a field shape. Fig.24 (B) is a diagram showing a determination status of a field shape based on the area data.
[0055] Fig.25 It is a diagram showing a method of generating a route according to the first embodiment.
[0056] Fig.26It is a diagram showing a method of generating a route according to the first embodiment.
[0057] Fig. 27 It is a diagram showing a method of generating a route according to the first embodiment.
[0058] Fig.28 It is a diagram showing a method of generating a route according to the first embodiment.
[0059] Fig.29 It is a diagram showing a method of generating a route according to the second embodiment.
[0060] Fig.30 It is a diagram showing a method of generating a route according to the third embodiment.
[0061] Fig.31 It is a diagram showing a method of generating a route according to the third embodiment.
[0062] Fig.32 This is a diagram showing a method of generating a route according to another embodiment. DETAILED DESCRIPTION
[0063] Reference Figure 1 to Figure 5 , a structure of an autonomous driving work vehicle as a work vehicle according to one embodiment of the present invention will be described.
[0064] like Figure 1 As shown, the following embodiment is described, that is, an autonomous driving work vehicle (hereinafter, sometimes referred to as an unmanned vehicle) 1 that can drive autonomously without a human operator, and a manned driving work vehicle (hereinafter, sometimes referred to as a manned vehicle) 100 that is steered by an operator in cooperation with the autonomous driving work vehicle 1 are set as tractors, and a rotary tilling device is respectively installed on the autonomous driving work vehicle 1 and the driving work vehicle 100 as a working machine. However, the working vehicle is not limited to a tractor, and may be a combine harvester, etc., and the working machine is not limited to a rotary tilling device, and may be a ridger, a mower, a rake, a seed drill, a fertilizer applicator, etc.
[0065] In this specification, “autonomous driving” means that the tractor drives along a predetermined path by controlling the driving-related structure of the tractor by a control unit (ECU) of the tractor.
[0066] Sometimes, the use of unmanned vehicles and manned vehicles to perform agricultural operations in a single field is referred to as cooperative agricultural operations, following operations, accompanying operations, etc. In addition, cooperative agricultural operations include "using unmanned vehicles and manned vehicles to perform agricultural operations in a single field" and "using unmanned vehicles and manned vehicles to perform agricultural operations in different fields such as adjacent fields at the same time."
[0067] Figure 1 and Figure 2 In the figure, the overall structure of a tractor as an autonomous driving work vehicle 1 is described. With respect to the body portion 2 of the tractor, an engine 4 is provided in a bonnet 3, an instrument panel 14 is provided in a cab 12 at the rear of the bonnet 3, and a steering wheel 5 as a steering operation unit is provided on the instrument panel 14. The direction of the front wheels 10, 10 is changed by turning the steering wheel 5 and with the aid of a steering device. The steering actuator 40 that operates the steering device is connected to a steering controller 301 that constitutes a control unit 30. The steering direction of the autonomous driving work vehicle 1 is detected by a steering sensor 20. The steering sensor 20 is composed of an angle sensor such as a rotary encoder, and is arranged at the rotating base of the front wheel 10.
[0068] However, the detection structure of the steering sensor 20 is not limited, as long as it can identify the steering direction, it can detect the rotation of the steering wheel 5 or the workload of the power steering. The detection value obtained by the steering sensor 20 is input to the steering controller 301 of the control unit 30.
[0069] The control unit 30 includes a steering controller 301, an engine controller 302, a transmission controller 303, a level controller 304, a work controller 305, a positioning control unit 306, an autonomous driving controller 307, etc., each of which includes a CPU (central processing unit), a storage device such as a RAM and a ROM, an interface, etc., and the storage device stores programs and data for making them perform operations, and can communicate in a manner that can send and receive information and data through CAN communication. In addition, the autonomous driving controller 307 includes a memory 309 as a storage unit for storing programs, data, etc.
[0070] A driver's seat 6 is disposed behind the steering wheel 5, and a transmission 7 is disposed below the driver's seat 6. Rear axle cases 9, 9 are connected to the left and right sides of the transmission 7, and rear wheels 11, 11 are supported by the rear axle cases 9, 9 via axles. The power from the engine 4 is shifted by a transmission device (main transmission device, auxiliary transmission device) in the transmission 7, thereby driving the rear wheels 11, 11. The transmission device is composed of, for example, a hydraulic continuously variable transmission device, and the transmission unit 44 such as a motor can be used to operate the movable inclined plate of a variable capacity hydraulic pump to shift the speed. The transmission unit 44 is connected to the transmission controller 303 of the control unit 30. The rotation speed of the rear wheel 11 is detected by the vehicle speed sensor 27, and the above rotation speed is input to the transmission controller 303 as the driving speed. However, the detection method of the vehicle speed and the configuration position of the vehicle speed sensor 27 are not limited.
[0071] The gearbox 7 contains a PTO clutch and a PTO transmission device. The PTO clutch is engaged and disconnected by a PTO engagement and disconnection unit 45. The PTO engagement and disconnection unit 45 is connected to an autonomous driving controller 307 of the control unit 30 via a display unit 49, and can control the input of power to the PTO shaft and the cutoff of the input. In addition, when a planter, a furrowing machine, etc. are installed as the working machine, a working machine controller 308 is provided so that the working machine can be controlled individually. The working machine controller 308 is connected to the working controller 305 via an information communication wiring (so-called ISOBUS).
[0072] A front axle housing 8 is supported on a front frame 13 supporting the engine 4, and front wheels 10, 10 are supported on both sides of the front axle housing 8, and are configured to transmit power from the transmission 7 to the front wheels 10, 10. The front wheels 10, 10 are steering wheels, and can be turned by turning the steering wheel 5, and can be turned left and right by a steering actuator 40 composed of a power steering cylinder as a driving unit of a steering device. The steering actuator 40 is connected to a steering controller 301 of a control unit 30 and controlled.
[0073] The engine controller 302, which is an engine rotation control unit, is connected to an engine speed sensor 61, a water temperature sensor, a hydraulic pressure sensor, etc., and can detect the state of the engine 4. In the engine controller 302, the load is detected and controlled according to the set speed and the actual speed to avoid overload, and the state of the engine 4 can be sent to the remote control device 112 described later and displayed on the display device 113.
[0074] In addition, a level sensor 29 for detecting the liquid level of the fuel is arranged in the fuel tank 15 arranged below the pedal, and the level sensor 29 is connected to a display unit 49, which is provided on the instrument panel 14 of the autonomous driving working vehicle 1, and displays the remaining amount of fuel. Moreover, the autonomous driving controller 307 calculates the available working time for the remaining amount of fuel, and transmits the information to the remote operating device 112 via the communication device 110, so that the remaining amount of fuel and the available working time can be displayed on the display device 113 of the remote operating device 112. In addition, the display unit for displaying the tachometer, fuel gauge, hydraulic pressure, and abnormality, and the display unit capable of displaying the current position, etc., may be a separate structure.
[0075] The instrument panel 14 is provided with a monitor for displaying the tachometer, fuel gauge, hydraulic pressure, etc., abnormalities of the engine 4, and a display unit 49 for displaying set values, etc. The display unit 49 is configured as a touch panel type structure similar to the remote control device 112, and can also perform data input, selection, switch operation, key operation, etc.
[0076] In addition, a work machine 24 is mounted at the rear of the body 2 of the tractor by means of a work machine mounting device 23 so as to be able to be raised and lowered. In this embodiment, a rotary tilling device is used as the work machine 24, and a lifting cylinder 26 is provided on the transmission case 7. By extending and retracting the lifting cylinder 26, the lifting arm constituting the work machine mounting device 23 can be rotated to lift and lower the work machine 24. The lifting cylinder 26 is extended and retracted by the operation of the lifting actuator 25, and the lifting actuator 25 is connected to the horizontal controller 304 of the control unit 30. In addition, a tilt cylinder is provided on the lifting link on the left and right sides of the work machine mounting device 23, and the tilt actuator 47 that operates the tilt cylinder is connected to the horizontal controller 304.
[0077] The positioning control unit 306 as a position detection unit is connected to a mobile GPS antenna 34 and a data receiving antenna 38 that can detect position information, and the mobile GPS antenna 34 and the data receiving antenna 38 are installed on the cab 12. The positioning control unit 306 is provided with a position calculation unit to calculate the latitude and longitude, and the current position can be displayed using the display unit 49 and the display device 113 of the remote control device 112. In addition, in addition to GPS (USA), high-precision positioning can also be performed using satellite positioning systems (GNSS) such as Quasi-Zenith Satellite (Japan) and GLONASS Satellite (Russia). In this embodiment, GPS is used for explanation.
[0078] The autonomous driving work vehicle 1 includes a gyro sensor 31 for obtaining information on a posture change of the vehicle body 2 and an azimuth angle detection unit 32 for detecting a traveling direction, both of which are connected to the control unit 30 .
[0079] However, since the traveling direction can be calculated by position measurement using GPS, the azimuth angle detection unit 32 may be omitted.
[0080] The gyro sensor 31 detects the angular velocity of the tilt (Pitch) of the vehicle body 2 in the front-to-back direction, the angular velocity of the tilt (Roll) of the vehicle body 2 in the left-to-right direction, and the angular velocity of the turn (Yaw). The three angular velocities are calculated by integration, thereby being able to find the tilt angle of the vehicle body 2 in the front-to-back direction and the left-to-right direction, and the turn angle. Specific examples of the gyro sensor 31 include: a mechanical gyro sensor, an optical gyro sensor, a fluid gyro sensor, a vibration gyro sensor, etc. The gyro sensor 31 is connected to the control unit 30, and the information related to the three angular velocities is input to the control unit 30.
[0081] The azimuth angle detection unit 32 detects the orientation (travel direction) of the autonomous driving work vehicle 1. A specific example of the azimuth angle detection unit 32 is a magnetic azimuth sensor. The azimuth angle detection unit 32 inputs information to the autonomous driving controller 307 via the CAN communication unit.
[0082] In this way, the autonomous driving controller 307 uses the posture and azimuth calculation unit to calculate the signals obtained from the above-mentioned gyro sensor 31 and the azimuth angle detection unit 32, thereby calculating the posture of the autonomous driving work vehicle 1 (direction, inclination of the body 2 in the front and rear directions and the left and right directions, and turning direction).
[0083] The position information of the autonomous driving work vehicle 1 is acquired using GPS (Global Positioning System).
[0084] As positioning methods using GPS, various methods can be cited: single positioning, relative positioning, DGPS (differential GPS) positioning, RTK-GPS (real-time kinematic - GPS) positioning, etc., or one of these methods can be used. However, the present embodiment adopts the RTK-GPS positioning method with higher measurement accuracy.
[0085] RTK-GPS (Real Time Kinematic-GPS) positioning is a method in which GPS observations are simultaneously performed at a base station whose position has been determined and at a mobile station whose position is to be determined, and the data observed at the base station is sent to the mobile station in real time by wireless or other methods, and the position of the mobile station is determined in real time based on the position result of the base station.
[0086] In this embodiment, the autonomous driving working vehicle 1 is provided with a positioning control unit 306 as a mobile station, a mobile GPS antenna 34, and a data receiving antenna 38, and a fixed communication device 35 as a base station, a fixed GPS antenna 36, and a data transmission antenna 39 are arranged at a predetermined position. For RTK-GPS (Real Time Kinematic-GPS) positioning in this embodiment, phase measurement (relative positioning) is performed at both the base station and the mobile station, and the data obtained by positioning using the fixed communication device 35 of the base station is transmitted from the data transmission antenna 39 to the data receiving antenna 38.
[0087] The mobile GPS antenna 34 disposed on the autonomous driving work vehicle 1 receives signals from GPS satellites 37, 37, etc. The signals are sent to the positioning control unit 306 to perform positioning. Moreover, the fixed GPS antenna 36 serving as a base station simultaneously receives signals from GPS satellites 37, 37, etc., performs positioning using the fixed communication device 35, and sends the positioning results to the positioning control unit 306, and analyzes the observed data to determine the position of the mobile station.
[0088] Thus, the autonomous driving controller 307 is provided as an autonomous driving unit for making the autonomous driving work vehicle 1 autonomously drive. That is, the driving state of the autonomous driving work vehicle 1 is acquired as various information by various information acquisition units connected to the autonomous driving controller 307, and the autonomous driving of the autonomous driving work vehicle 1 is controlled by various control units connected to the autonomous driving controller 307. Specifically, the radio waves transmitted from the GPS satellites 37, 37, etc. are received, and the position information of the vehicle body 2 is obtained at a set time interval in the positioning control unit 306, and the displacement information and the azimuth information of the vehicle body 2 are obtained from the gyro sensor 31 and the azimuth angle detection unit 32. Based on these position information, displacement information and azimuth information, the steering actuator 40, the speed change unit 44, the lifting actuator 25, the PTO engagement and disengagement unit 45, the engine controller 302, etc. are controlled so that the vehicle body 2 drives along the preset path (driving path and working path) R, thereby realizing autonomous driving and automatic work.
[0089] In addition, the autonomous driving work vehicle 1 is provided with an obstacle sensor 41, which is connected to the control unit 30, so that the autonomous driving work vehicle 1 does not collide with obstacles. For example, the obstacle sensor 41 is composed of a laser sensor, an ultrasonic sensor, and a camera, which are arranged at the front, side, and rear of the vehicle body 2 and connected to the control unit 30, and the control unit 30 performs the following control: detecting whether there is an obstacle in front, side, and rear of the vehicle body 2, and stopping the driving if the obstacle approaches within a set distance.
[0090] In addition, the autonomous driving work vehicle 1 is equipped with a camera 42F for photographing the front and a camera 42R for photographing the working machine behind and the state of the field after the work, and these cameras are connected to the control unit 30. In the present embodiment, the cameras 42F and 42R are arranged on the front and rear of the top of the cab 12, but the arrangement position is not limited, and a structure may be formed as follows: one camera 42 on the front and rear of the cab 12 is arranged at the center of the vehicle body 2 and rotated around the vertical axis to photograph the surroundings, or a plurality of cameras 42 are arranged at the four corners of the vehicle body 2 to photograph the surroundings of the vehicle body 2. The display device 113 of the remote control device 112 provided in the driving work vehicle 100 displays the images photographed by the cameras 42F and 42R.
[0091] The remote operation device 112 sets the path R of the autonomous working vehicle 1, including the working path Ra and the driving path Rb described later, or remotely operates the autonomous working vehicle 1, or monitors the driving state of the autonomous working vehicle 1 and the working state of the working machine, or stores working data, and is equipped with a control device (CPU, memory), a communication device 111, a display device 113, etc.
[0092] The driving work vehicle 100 as a manned vehicle is used by an operator to ride and perform driving operations, and the driving work vehicle 100 is equipped with a remote control device 112, so that the autonomous driving work vehicle 1 can be operated. The basic structure of the driving work vehicle 100 is substantially the same as that of the autonomous driving work vehicle 1, so a detailed description is omitted. In addition, a structure in which a control unit for GPS is provided in the driving work vehicle 100 (or the remote control device 112) may be provided.
[0093] The remote control device 112 can be attached to and detached from the operating parts such as the dashboard of the driving work vehicle 100 and the autonomous driving work vehicle 1. The remote control device 112 can be operated while being mounted on the dashboard of the driving work vehicle 100, or can be carried outside the driving work vehicle 100 and operated, or can be operated even when mounted on the dashboard 14 of the autonomous driving work vehicle 1. The remote control device 112 can be composed of, for example, a notebook or tablet-type personal computer. In the present embodiment, it is composed of a tablet-type personal computer.
[0094] In addition, the remote control device 112 and the autonomous driving work vehicle 1 are configured to be able to communicate with each other wirelessly, and the autonomous driving work vehicle 1 and the remote control device 112 are respectively provided with communication devices 110 and 111 for communication. The communication device 111 is integrally configured with the remote control device 112. The communication unit is configured to be able to communicate with each other in a manner such as wireless LAN. For the remote control device 112, a display device 113 of a touch panel type operation screen that can be operated by touching the screen is provided on the surface of the housing, and the communication device 111, CPU, storage device 114, battery, etc. are stored in the housing.
[0095] Next, a procedure for setting the route R (the work route Ra and the travel route Rb) using the remote control device 112 will be described.
[0096] The display device 113 of the remote control device 112 is a touch panel type structure, and when the remote control device 112 is powered on and started, an initial screen is displayed. Figure 3 As shown, the initial screen displays a tractor setting key 201 , a field setting key 202 , a route creation setting key 203 , a data transfer key 204 , a work start key 205 , and an end key 206 .
[0097] First, the tractor setting will be described.
[0098] When the tractor setting key 201 is touched, the tractor name (model) is displayed when work has been done with the tractor in the past by means of the remote control device 112, that is, when there is a tractor that has been set in the past. If multiple tractor names are displayed, the tractor name used this time is selected by touching, and then the screen returns to the initial screen.
[0099] When resetting the tractor, the model of the tractor is determined. In this case, the model name is directly input. Alternatively, a list of a plurality of tractor models can be displayed on the display device 113 and a desired model can be selected.
[0100] When the tractor model is set, a setting screen for the installation position of the mobile GPS antenna 34 is displayed. The installation position of the mobile GPS antenna 34 may differ depending on the tractor or the technician who installs it, so the installation position is set by displaying a top view of the tractor.
[0101] When setting the installation position of the mobile GPS antenna 34, a setting screen for the size, shape, and position of the working machine mounted on the tractor is presented. The working machine position can be selected from the front, between the front and rear wheels, rear, or offset.
[0102] When the setting of the working machine is completed, the setting screen of the vehicle speed during operation, the engine speed during operation, the vehicle speed when turning, and the engine speed when turning is presented. The vehicle speed during operation can also be set to different vehicle speeds for the outbound route and the return route.
[0103] When the vehicle speed and engine speed are set, the screen can proceed to the field setting described later or return to the initial screen.
[0104] Next, field setting will be described.
[0105] When the field setting key 202 is touched, when work has been done in the past using the tractor with the remote control device 112, that is, when there is a field set in the past, the name of the set field is displayed. If the field name to be worked on this time is touched and selected from the displayed plurality of field names, the path generation setting screen described later can be entered, or the initial screen can be returned. In addition, the set field can be edited or reset.
[0106] If there is no registered field, a new field setting is performed. When a new field setting is selected, Figure 4 As shown, the tractor (autonomous driving working vehicle 1) is positioned at one of the four corners A in the field H, and the "measurement start" button is touched. Then, the tractor is driven along the periphery of the field H to register the field shape. Next, the operator registers the corner positions A, B, C, D and the inflection points based on the registered field shape to determine the field shape.
[0107] When determining field H, if Figure 5 As shown, the travel start position Sr, the work start position Sw, the work direction F, the work end position Gw, and the travel end position Gr are set. When there is an obstacle in the field H, the tractor is moved to the position of the obstacle, and the obstacle setting key (not shown) is touched to travel around the obstacle to set the obstacle. In addition, if an obstacle exists near the periphery of the field H, or the obstacle is smaller than the minimum turning radius and becomes too large if traveling outside the field H, it can be registered based on the displayed field map.
[0108] When the above work is completed or a field that has been registered in the past is selected, the screen changes to a confirmation screen and an OK key and an "Edit / Add" key are displayed. When changing a field that has been registered in the past, the "Edit / Add" key is touched.
[0109] When the OK key is touched during the field setting, the path generation setting is performed. The path generation setting can also be performed by touching the path generation setting key 203 in the initial screen.
[0110] When the mode is shifted to the route generation setting mode, a selection screen is displayed for the position of the autonomous driving work vehicle 100 relative to the autonomous driving work vehicle 1. That is, the positional relationship between the autonomous driving work vehicle 1 and the autonomous driving work vehicle 100 is set. Specifically, the following four positional relationships can be displayed and selected by touching: (1) the autonomous driving work vehicle 100 is located to the left rear of the autonomous driving work vehicle 1; (2) the autonomous driving work vehicle 100 is located to the right rear of the autonomous driving work vehicle 1; (3) the autonomous driving work vehicle 100 is located directly behind the autonomous driving work vehicle 1; (4) the autonomous driving work vehicle 100 is not parallel (only the autonomous driving work vehicle 1 is working).
[0111] Next, the width of the work machine on which the work vehicle 100 is traveling is set. That is, the width of the work machine is input in digital form.
[0112] Next, the number of jumps is set. That is, the number of paths to be skipped when the autonomous driving working vehicle 1 reaches the edge of the field and moves from the first working path R1 to the second working path R2 is set.
[0113] Specifically, select any one of the options (1) No skip, (2) Skip 1 column, or (3) Skip 2 columns.
[0114] Next, the overlap setting is performed. That is, the overlap amount of the working width in the working path R2 adjacent to the working path R1 is set. Specifically, the options (1) No overlap and (2) Overlap are selected. In addition, when "Overlap" is selected, a numerical input screen is displayed. If a numerical value is not entered, it is impossible to proceed to the next screen.
[0115] Next, the peripheral settings are performed. Figure 5The outer area of the working area HA where the autonomous driving work vehicle 1 and the driving work vehicle 100 or the autonomous driving work vehicle 1 is used to perform work as shown in the figure is set. In other words, the headland HB that turns at the end of the field in a non-working state and the side margin HC between the headland HB and the headland HB that connects to the outer periphery of the field on both sides as the non-working area are set. Therefore, the field H = working area HA + headland HB + headland HB + side margin HC + side margin HC. Usually, the width Wb of the headland HB and the width Wc of the side margin HC are set to a length of less than twice the width of the working machine equipped with the driving work vehicle 100. After the parallel operation of the autonomous driving work vehicle 1 and the driving work vehicle 100 is completed, the operator can enter the driving work vehicle 100 and complete the processing work by driving around the outer periphery twice by manual operation. However, it is also possible to use the autonomous driving work vehicle 1 to perform work on the outer periphery. In the peripheral setting, the width Wb of the headland HB and the width Wc of the side margin HC are automatically calculated as the specified width according to the width of the work machine. However, the calculated width Wb of the headland HB and the width Wc of the side margin HC can be changed to any width. The user can set the changed width Wb and width Wc as the width of the headland HB and the width of the side margin HC respectively on the basis of changing to the desired width. However, in the case where it can be changed to any width, it cannot be set below the calculated minimum setting width in consideration of driving, working and safety in the field. For example, when the autonomous driving work vehicle 1 is driving and turning on the headland HB and the side margin HC, the width that ensures that the work machine will not be separated from the field is calculated as the minimum setting width.
[0116] When the input of the above-mentioned various settings is completed, a confirmation screen is displayed. When the confirmation key is touched, the path R is automatically generated. The path R includes the working path Ra and the driving path Rb. The working path Ra is a path generated in the working area HA, and is a path that is driven while working. The working path Ra is a straight path. However, when the working area HA is not rectangular, it sometimes extends to areas outside the working area HA (the headland HB and the side surplus land (side edge) HC). The driving path Rb is a path generated in an area outside the working area HA, and is a path that is driven when no work is being performed. The driving path Rb is a path composed of a combination of straight lines and curves. Turning is mainly performed at the headland HB.
[0117] Regarding the work route Ra and the travel route Rb, the work route Ra and the travel route Rb are generated for the autonomous driving work vehicle 1 and the driving work vehicle 100 , respectively.
[0118] If the user wishes to check the route R after the route is generated, the user can check the route R by touching the route generation setting key 203 to display a simulation image. Even if the route generation setting key 203 is not touched, the operation route Ra and the travel route Rb are generated.
[0119] When the work route Ra and the travel route Rb are automatically generated, the work start position Sw and the work end position Gw are set. The work start position Sw and the work end position Gw are set to the corresponding positions closest to the travel start position Sr and the travel end position Gr registered in the field setting. In addition, when setting each item of the route generation setting, the route generation setting is displayed, and the "route setting key", "transfer data", and "return to home page" are displayed in a selectable manner at the bottom.
[0120] When the work route Ra and the travel route Rb are generated, the travel end position Gr of the autonomous driving work vehicle 1 is set. The travel end position Gr is the position where the autonomous driving work vehicle 1 is autonomously driven and stopped by the control unit 30 so that the work performed by the work machine 24 ends at the work end position Gw.
[0121] Here, the structure of the work path generation device according to one embodiment of the present invention will be described.
[0122] like Figure 2 As shown, the autonomous driving work vehicle 1 includes: a mobile GPS antenna 34 as a position detection unit, which can detect the position information of the body part 2, that is, the current position Z; a memory 309 as a storage unit, which can store the field H for the body part 2 to travel; a control unit 30, which can issue instructions for the travel of the body part 2 in the field H and the work performed by the work machine 24 mounted on the body part 2; and a remote operation device 112 as a path generation unit, which generates a path R of the body part 2 in the field H.
[0123] In addition, the autonomous driving work vehicle 1 is configured to generate the path R of the vehicle body 2 using the remote control device 112, but the path R of the vehicle body 2 may be generated by the control unit 30 instead of the remote control device 112. In addition, the autonomous driving work vehicle 1 is configured to control the travel of the vehicle body 2 and the operation of the work machine 24 using the control unit 30, but the travel of the vehicle body 2 and the operation of the work machine 24 may be controlled by the remote control device 112 instead of the control unit 30. In addition, the autonomous driving work vehicle 1 is configured to store the field H for the vehicle body 2 to travel in the memory 309, but the field H may be stored in the remote control device 112 (more specifically, in a memory (not shown) provided in the remote control device 112) instead of the memory 309.
[0124] That is, the work path generating device 150 involved in one embodiment of the present invention comprises: a mobile GPS antenna 34 as a position detection unit, which can detect the position information of the vehicle body 2, that is, the current position Z; a memory 309 as a storage unit, which can store the field H for the vehicle body 2 to travel; a control unit 30, which can issue instructions for the travel of the vehicle body 2 in the field H and the work performed by the work machine 24 mounted on the vehicle body 2; and a remote operation device 112 as a path generating unit, which generates a path R of the vehicle body 2 in the field H.
[0125] In the autonomous driving work vehicle 1 , the driving end position Gr is set by the work path generation device 150 in consideration of the generated work path Ra and driving path Rb of the driving work vehicle 100 and the driving position of the driving work vehicle 100 .
[0126] In setting the travel end position Gr, before or after the path generation setting, the work path generation device 150 displays an option such as "There is a possibility of collision with a manned vehicle after the work is completed. Do you want to move to a safe position after the work is completed" on the display device 113.
[0127] Here, when “Yes” is selected, a configuration may be adopted in which the work path generation device 150 presents the recommended points on the display device 113 , and an arbitrary position is selected.
[0128] Alternatively, a configuration may be adopted in which, when “No” is selected, a warning indicating the possibility of a collision is displayed on the display device 113 by the work path generation device 150 .
[0129] In addition, the travel end position Gr may be automatically updated and set appropriately during the work by the work path generation device 150 in consideration of the travel position of the travel work vehicle 100, or may be configured so that the operator can make appropriate corrections during the work.
[0130] When each item of the route generation setting is set, the route generation setting is displayed, and "route setting key", "transfer data", and "return to home page" are displayed in a selectable manner at the lower part.
[0131] When transmitting the information, the information can be transmitted by touching the data transmission key 204 provided in the initial screen. The transmission is performed by the remote control device 112, and therefore, the set information needs to be transmitted to the control unit 30 of the autonomous driving work vehicle 1. There are the following methods for the transmission: (1) a method of transmitting using a terminal; and (2) a method of transmitting wirelessly. In the present embodiment, when using a terminal, the remote control device 112 and the control unit 30 of the autonomous driving work vehicle 1 are directly connected using a USB cable, or the information is temporarily stored in a USB memory and then connected to the USB terminal of the autonomous driving work vehicle 1 for transmission. In addition, when transmitting wirelessly, the information is transmitted using a wireless LAN.
[0132] Here, a method of causing the autonomous driving work vehicle 1 according to one embodiment of the present invention to autonomously drive to the work start position Sw will be described.
[0133] like Figure 1 As shown, an autonomous driving working vehicle 1 according to an embodiment of the present invention includes a vehicle body 2 and a working machine 24 mounted on the vehicle body 2. Figure 1 and Figure 2 As shown, a mobile GPS antenna 34 is provided as a position detection unit, and the mobile GPS antenna 34 can detect the position information of the vehicle body 2 .
[0134] Furthermore, the autonomous driving work vehicle 1 includes a control unit 30 that can control the driving of the vehicle body 2 in the driving area, that is, the field H and the work performed by the work machine 24. The control unit 30 includes a memory 309 as a storage unit that can store the shape, position, size, etc. of the driving area, that is, the field H, where the vehicle body 2 drives. In the following description, when the control unit 30 appears, reference is made to Figure 2 .
[0135] Furthermore, the autonomous driving work vehicle 1 is configured as a work vehicle that can autonomously drive along the work path Ra and the travel path Rb while transmitting the data of the work path Ra and the travel path Rb generated by the remote control device 112 to the control unit 30 and storing them in the memory 309, and can detect the current position Z of the vehicle body 2 using the mobile GPS antenna 34. In addition, the current position Z of the autonomous driving work vehicle 1 is usually consistent with the position of the mobile GPS antenna 34.
[0136] The autonomous driving working vehicle 1 shown in this embodiment is configured as follows: Figure 6 The field H of the substantially rectangular shape shown is set as a driving area, and the vehicle can autonomously drive in the working area HA as a first area, the headland HB as a second area, and the side margin HC constituting the field H. In addition, the driving work vehicle 100 follows (or follows) the autonomous driving work vehicle 1 autonomously driving in the field H as the driving area, and drives under the control of the operator.
[0137] The autonomous driving work vehicle 1 is configured to autonomously drive by the control unit 30 when the current position Z is within the field H. On the other hand, the autonomous driving work vehicle 1 is configured to be unable to autonomously drive by the control unit 30 outside the field H (on a road, etc.).
[0138] Furthermore, the autonomous driving work vehicle 1 is configured to be able to autonomously drive by the control unit 30 when the current position Z is at the driving start position Sr.
[0139] Furthermore, the autonomous driving working vehicle 1 may be configured such that when the current position Z is located at the driving start position Sr on the headland HB, the operating personnel presses the work start key 205 (see Figure 3 ) and issue the instruction to "start operation", such as Figure 6 As shown, the control unit 30 autonomously drives from the current position Z to the work start position Sw, and after reaching the work start position Sw, the work machine 24 (see Figure 1 , 2 ) to carry out the operation.
[0140] In this way, the autonomous working vehicle 1 is configured to be able to start autonomous driving at a position separated from the work start position Sw. Therefore, when there is a distance between the entrance of the field H and the work start position Sw, the operator's labor of moving can be reduced, thereby improving the efficiency of the work using the autonomous working vehicle 1.
[0141] The remote control device 112 generates a work route Ra and a travel route Rb based on the setting results of the tractor setting, the field setting, and the route generation setting described above.
[0142] However, the remote control device 112 can generate a path R including a work path Ra and a travel path Rb from the travel start position Sr to the travel end position Gr set in the field setting, and can send the information of the path R to the autonomous driving work vehicle 1. Then, the autonomous driving work vehicle 1 (control unit 30) that has obtained the information of the path R compares the current position Z and azimuth of the autonomous driving work vehicle 1 with the travel start position Sr and the work direction F, and can start autonomous driving if the difference is within a predetermined deviation.
[0143] Here, the following situation is explained below, that is, if Figure 7 As shown, the entrance of the field H is located approximately in the center of the left and right width of the field H. The user (operator) selects a point Sa located approximately in the center of the left and right width of the field H as the travel start position Sr and selects a point Sb as the travel end position Gr in the field setting.
[0144] In this case, the remote operation device 112 generates a path R from the point Sa to the point Sb. Usually, the path R is generated from the point Sa to the point Sb. However, when the point Sa is approximately in the middle of the left and right width of the field H, it is necessary to generate a path from the point Sa to the opposite side of the point Sb, which makes the path generation complicated. In addition, when the driving work vehicle 100 and the autonomous driving work vehicle 1 work in cooperation, it is difficult for the operator who operates the driving work vehicle 100 to predict which path to enter next.
[0145] Therefore, the autonomous driving work vehicle 1 involved in one embodiment of the present invention is configured as follows: when a location other than the corner of the field H (for example, location Sa) is designated as the driving start position Sr in the field setting, it is selected whether to "autonomously drive from location Sa to location Sc without performing agricultural work accompanied therewith, and then autonomously drive from location Sc toward location Sb accompanied by agricultural work."
[0146] However, if Figure 6 As shown, only when the distance L between the point Sa and the point Sc is greater than a predetermined set value β (for example, the set value β=10m), it is selected whether to "autonomously drive from the point Sa to the point Sc without performing agricultural work, and then autonomously drive from the point Sc to the point Sb accompanied by agricultural work". According to such a structure, the operator only needs to make the autonomous driving work vehicle 1 enter the field H near the entrance, and the autonomous driving work vehicle 1 can be autonomously driven to the work start position Sw without driving, which can shorten the operator's moving distance and improve the work efficiency.
[0147] On the other hand, when the distance L is less than a predetermined setting value β, it can be selected whether to "after driving from point Sa to point Sc by the operator's driving operation, autonomously drive from point Sc toward point Sb accompanied by agricultural work." This is because: when the distance L is short, the user's burden is small.
[0148] The timing for making the above selection is not limited to the above timing (i.e., when setting the field), and may be a specified timing after the field setting is completed, for example, after generating a path R from point Sa to point Sb and presenting the path R to the user (e.g., displaying the above simulation image).
[0149] If the user selects "autonomously drive from point Sa to point Sc without performing agricultural work, and then autonomously drive from point Sc toward point Sb with agricultural work", Figure 6 As shown, in addition to generating the above-mentioned work route Ra and travel route Rb, the remote operation device 112 also generates a route R including a travel route Rc from the point Sa to the point Sc.
[0150] On the other hand, when the user selects "after driving from location Sa to location Sc through the operator's driving operation, autonomous driving from location Sc toward location Sb accompanied by agricultural work", the remote operation device 112 generates a path R including the above-mentioned work path Ra and driving path Rb but not including the driving path Rc.
[0151] That is, the autonomous driving work vehicle 1 as a work vehicle involved in one embodiment of the present invention includes: a body 2; a work machine 24, which is mounted on the body 2; a mobile GPS antenna 34 as a position detection unit, which can detect the position information of the body 2; a memory 309 as a storage unit, which can store the driving area for the body 2 to drive, that is, the field H; and a control unit 30, which can control the driving of the body 2 in the field H and the work performed by the work machine 24, the field H including: a work area HA as a first area, which includes a work path Ra for working with the work machine 24; and a headland HB as a second area, which is set around the work area HA, and when an instruction to start working with the work machine 24 is given at the headland HB, the control unit 30 can drive the body 2 from the current position Z of the body 2 to the starting point of the work path Ra, that is, the work start position Sw, and then start working with the work machine 24.
[0152] According to such a configuration, the autonomous driving work vehicle 1 can be placed at the work start position Sw without the need for the operator to drive the vehicle, and the efficiency of the work performed by the autonomous driving work vehicle 1 can be further improved.
[0153] In addition, when autonomous driving is performed along a path R including the driving path Rc, the following configuration may be adopted: Figure 7 As shown, the current position Z and azimuth angle θa of the autonomous driving work vehicle 1, an arbitrary point Sd on the imaginary starting line s parallel to the working direction F passing through the point Sa, and the angle θb (90 degrees in this embodiment) formed by the line segment connecting the point Sa and the point Sc and the imaginary starting line s are compared, and when the difference is within a prescribed deviation, the autonomous driving is started. Here, the prescribed deviation means, for example, that the distance L1 between the current position Z and the point Sd is within a prescribed set value α (for example, the prescribed set value α=1m), and the difference between the azimuth angle θa and the angle θb is a prescribed set value ε (for example, the prescribed set value ε=15 degrees).
[0154] Next, the start of automatic travel will be described when the point Sc is selected as the travel start position Sr in field setting or when the point Sa is selected as the travel start position Sr but travel is performed from the point Sa to the point Sc by the operator's driving operation.
[0155] In the past, the influence of the orientation of the work vehicle at the work start position Sw on the driving accuracy (and working accuracy) of the work vehicle has not been considered. Therefore, in the past, the actual driving trajectory of the work vehicle sometimes deviates from the set driving path Rb due to the orientation of the work vehicle at the work start position Sw, and it is sometimes difficult to ensure the working accuracy of the work vehicle that can drive autonomously.
[0156] The autonomous driving work vehicle 1 according to one embodiment of the present invention is configured to take into account the influence of the orientation (azimuth) of the autonomous driving work vehicle 1 on the driving accuracy (and working accuracy) when the control unit 30 generates a route.
[0157] The autonomous driving work vehicle 1 is configured to determine whether to start autonomous driving by using the control unit 30 in consideration of the azimuth of the autonomous driving work vehicle 1 at the current position Z when the current position Z is at the driving start position Sr on the headland HB and an instruction to start work is issued.
[0158] The autonomous driving working vehicle 1 is composed of: Figure 8As shown, the control unit 30 can be used to calculate the angle difference dθ between the azimuth angle θ1 of the autonomous working vehicle 1 relative to the reference azimuth X and the azimuth angle θ2 of the autonomous working vehicle 1 from the current position Z to the working start position Sw, and is configured such that when the calculated angle difference dθ is less than a specified threshold value, autonomous driving from the current position Z to the working start position Sw is allowed.
[0159] When the operator presses the work start key 205 (see Figure 3 ), the autonomous driving working vehicle 1 uses the azimuth angle detection unit 32 (refer to Figure 2 ) detects the azimuth angle θ1 of the current position Z relative to the reference azimuth X, and uses the control unit 30 to calculate the azimuth angle θ2 from the current position Z relative to the work start position Sw, thereby calculating the angle difference dθ between the two azimuth angles θ1 and θ2.
[0160] Furthermore, the autonomous driving work vehicle 1 may be configured such that when the angle difference dθ is smaller than a predetermined threshold (eg, smaller than 10°), the control unit 30 allows the autonomous driving work vehicle 1 to autonomously travel from the current position Z to the work start position Sw.
[0161] That is, the autonomous driving work vehicle 1 as a work vehicle involved in one embodiment of the present invention has an azimuth detection unit 32, which can detect the azimuth of the body part 2. If the angle difference dθ between the azimuth angle θ1 of the body part 2 and the azimuth angle θ2 from the current position Z relative to the work start position Sw is not within a specified threshold, the control unit 30 does not make the body part 2 travel from the current position Z to the work start position Sw.
[0162] In this way, the structure that causes the vehicle body 2 to autonomously travel when the angle difference dθ between the azimuth angle θ1 and the azimuth angle θ2 of the vehicle body 2 is within a predetermined threshold value can suppress the error of the current position Z of the vehicle body 2 relative to the set work start position Sw.
[0163] In addition, the autonomous driving working vehicle 1 can be configured as follows: Fig. 9 As shown, the control unit 30 determines the virtual extension line f obtained by extending the first working path R1 including the working start position Sw toward the headland HB side, and when the current position Z is within a predetermined deviation relative to the virtual extension line f, the control unit 30 can allow the autonomous driving of the autonomous driving working vehicle 1. In addition, the direction of the virtual extension line f toward the working direction F at the working start position Sw is consistent with the direction of the first working path R1.
[0164] In addition, the “deviation” referred to here is the deviation of the current position Z from the virtual extension line f, and specifically, is the distance of the current position Z from the virtual extension line f.
[0165] That is, the autonomous driving work vehicle 1 is configured to determine whether to start autonomous driving by the control unit 30 in consideration of the deviation of the current position Z from the virtual extension line f when the current position Z is within the headland HB and an instruction to start work is issued.
[0166] Specifically, the autonomous driving working vehicle 1 can be configured as follows: Fig. 9 As shown, when the deviation of the current position Z from the virtual extension line f is within a predetermined deviation α (for example, within deviation α=1 m), the control unit 30 allows the autonomous driving work vehicle 1 to autonomously travel from the current position Z to the work start position Sw.
[0167] Furthermore, the autonomous driving work vehicle 1 may be configured such that the control unit 30 controls the driving of the vehicle body 2 so that the deviation α between the determined virtual extension line f and the current position Z is reduced.
[0168] That is, in the autonomous working vehicle 1 which is a working vehicle involved in one embodiment of the present invention, the working path Ra includes a first working path R1, and the first working path R1 includes a working start position Sw. The control unit 30 determines an imaginary path obtained by extending the first working path R1 to the head of the ground HB, that is, an imaginary extension line f. If the current position Z is within a specified deviation α relative to the imaginary extension line f, the travel of the body part 2 can be controlled in a manner to reduce the deviation, so that the body part 2 can travel from the current position Z to the working start position Sw.
[0169] According to such a configuration, it is possible to suppress an error in the current position Z relative to the work start position Sw when the vehicle body 2 reaches the work start position Sw.
[0170] In addition, the autonomous driving working vehicle 1 can be configured as follows: Fig.10 As shown, when the deviation of the current position Z from the virtual extension line f is outside the predetermined deviation α (for example, deviation α>1 m), the control unit 30 can prevent the autonomous driving work vehicle 1 from autonomous driving as it is.
[0171] When the deviation of the current position Z from the virtual extension line f is outside the specified deviation α, the autonomous driving work vehicle 1 can be configured to allow an additional driving path Rb to be generated from the current position Z to the work start position Sw, and autonomously drive along the additionally generated driving path Rb.
[0172] That is, in the autonomous working vehicle 1 which is a working vehicle involved in one embodiment of the present invention, the working path Ra includes a first working path R1, and the first working path R1 includes a working start position Sw. The control unit 30 determines an imaginary path obtained by extending the first working path R1 toward the head of the ground HB, that is, an imaginary extension line f. If the current position Z is outside the specified deviation relative to the imaginary extension line f, a driving path Rb from the current position Z to the working start position Sw can be generated and the vehicle body 2 can be driven along the driving path Rb.
[0173] According to such a structure, when the current position Z of the vehicle body 2 is separated from the work start position Sw, even if the operator does not drive the autonomous working vehicle 1 to the work start position Sw with someone on board, the autonomous working vehicle 1 can be configured at the work start position Sw, thereby saving the operator the labor of configuring the autonomous working vehicle 1 at the work start position Sw.
[0174] In order to reduce the deviation α of the current position Z from the virtual extension line f, it is more advantageous that the path from the current position Z to the work start position Sw is as long as possible.
[0175] Here, a method of setting the travel start position Sr will be described.
[0176] For the autonomous driving working vehicle 1, if Fig.11 As shown, the control unit 30 can set a travel start position Sr, a position where the autonomous travel work vehicle 1 can start autonomous travel, in the field H.
[0177] Furthermore, the autonomous driving work vehicle 1 is configured such that when the current position Z coincides with the driving start position Sr, the control unit 30 permits the start of autonomous driving.
[0178] The current position Z of the autonomous driving work vehicle 1 usually coincides with the position of the mobile GPS antenna 34 . Therefore, the control unit 30 may be configured to start autonomous driving when the position of the mobile GPS antenna 34 coincides with the driving start position Sr.
[0179] The autonomous driving work vehicle 1 is constructed so that the driving start position Sr and the current position Z can be displayed on the display device 113. The operator drives the autonomous driving work vehicle 1 while confirming the display device 113 so that the driving start position Sr and the current position Z are consistent. As a result, the autonomous driving work vehicle 1 can be easily positioned relative to the driving start position Sr.
[0180] like Fig.11 As shown, the travel start position Sr is preferably set on the headland HB.
[0181] Furthermore, it is more preferable that the travel start position Sr is set on the headland HB and at a position as far away from the work start position Sw as possible.
[0182] This is because if the travel start position Sr is moved as far away from the work start position Sw as possible, there is a surplus time for correcting the azimuth and posture of the autonomous driving work vehicle 1 while the autonomous driving work vehicle 1 autonomously travels from the travel start position Sr to the work start position Sw.
[0183] Furthermore, it is more preferable that the control unit 30 determines the virtual extension line f and sets the travel start position Sr on the virtual extension line f and at a position of the work area HA as far away from the headland HB as possible.
[0184] This is because if the autonomous driving work vehicle 1 is arranged on the virtual extension line f in advance, the azimuth and posture of the autonomous driving work vehicle 1 can be corrected with higher accuracy while the autonomous driving work vehicle 1 autonomously travels from the travel start position Sr to the work start position Sw.
[0185] Furthermore, the autonomous driving working vehicle 1 can be configured as follows: Fig.12 As shown, the control unit 30 sets the travel start position Sr in consideration of the azimuth angles θ1, θ2, the deviation α of the current position Z relative to the imaginary extension line f, etc. Thus, the azimuth angle and posture of the autonomous travel work vehicle 1 at the work start position Sw can be adjusted simply by placing the autonomous travel work vehicle 1 at the travel start position Sr, thereby improving the work accuracy of the autonomous travel work vehicle 1.
[0186] The autonomous driving work vehicle 1 increases the distance between the driving start position Sr and the work start position Sw as much as possible in order to reliably reduce the deviation α between the determined virtual extension line f and the current position Z and reliably reduce the angle difference dθ.
[0187] When setting the travel start position Sr, it is preferred that the size and shape of the work machine 24 be taken into consideration, and the travel start position Sr be set as far away from the work area HA as possible on the headland HB within a range where the work machine 24 does not protrude from the headland HB.
[0188] In addition, for the autonomous working vehicle 1, between the driving start position Sr and the working start position Sw, the control unit 30 sets the driving path Rb so that the autonomous working vehicle 1 travels on the headland HB, thereby enabling the autonomous working vehicle 1 to be arranged at the working start position Sw without damaging the working area HA.
[0189] For the autonomous driving working vehicle 1, if Fig.11 and Fig.13As shown in (A), the travel start position Sr is set as a "region" having a predetermined area.
[0190] If the travel start position Sr is set as a “point”, high positioning accuracy is required to make the current position Z coincide with the travel start position Sr, and it is difficult to position the autonomous driving work vehicle 1 at the travel start position Sr.
[0191] Therefore, the autonomous driving work vehicle 1 is configured such that the required accuracy during positioning is relaxed by setting the travel start position Sr as the “area”, and the autonomous driving work vehicle 1 can be easily positioned at the travel start position Sr.
[0192] Specifically, for the autonomous driving working vehicle 1, if Fig.13 As shown in (A), the travel start position Sr may be set as a “circular area.” In this case, the “area” as the travel start position Sr can be easily set by simply specifying the center point and radius of the travel start position Sr.
[0193] In addition, the radius of the "circular area" in this case is preferably a radius equal to or smaller than the initial tolerance allowed at the work start position Sw, thereby ensuring the positioning accuracy at the work start position Sw.
[0194] The "area" set as the driving start position Sr is set as a "circular area" with a specified radius centered on the point specified by the operator. When the mobile GPS antenna 34 of the autonomous driving work vehicle 1 is configured in this "area", it is determined that the autonomous driving work vehicle 1 is configured at the driving start position Sr.
[0195] According to such a configuration, the autonomous driving work vehicle 1 can be easily arranged at the travel start position Sr.
[0196] Furthermore, by setting the “area” set as the travel start position Sr within the headland HB, the autonomous travel work vehicle 1 can be prevented from autonomously traveling outside the field H.
[0197] In addition, the shape of the "area" set as the travel start position Sr is not limited to a circle, and for example Fig.13 As shown in (B), it can be a polygon (here a rectangle). In addition, Fig.13 As shown in (C), the shape in which the left and right width becomes narrower as it approaches the work start position Sw side may be adopted.
[0198] Next, the setting of the travel end position Gr of the autonomous driving work vehicle 1 according to one embodiment of the present invention will be described. Figure 2 .
[0199] The autonomous driving working vehicle 1 shown in this embodiment is configured as follows: Fig.14 The field H of the substantially rectangular shape shown is set as a driving area, and the vehicle can autonomously drive in the working area HA as a first area, the headland HB as a second area, and the side margin HC constituting the field H. In addition, the driving work vehicle 100 is driven by the operator to follow the autonomous driving work vehicle 1 autonomously driving in the field H.
[0200] Moreover, in this embodiment, if Fig.14 As shown, the working path generating device 150 constituting the autonomous working vehicle 1 forms n working paths Ra in the working area HA, and forms a driving path Rb for the autonomous working vehicle 1 and the driving working vehicle 100 to travel in the headland HB and the side margin HC. Fig.14 In the example, the n-th operation path Ra is represented in the form of Ra(n), thereby distinguishing the path number of the operation path Ra.
[0201] Furthermore, the autonomous driving work vehicle 1 is configured to set the travel end position Gr on the edge of the field HB using the work path generation device 150. The autonomous driving work vehicle 1 can be prevented from autonomously traveling outside the field H by setting the travel end position Gr on the edge of the field HB.
[0202] In addition, although the present embodiment shows an example of a situation in which the travel end position Gr of the autonomous driving work vehicle 1 is set on the headland HB, the travel end position Gr of the autonomous driving work vehicle 1 only needs to be set in an area other than the working area HA in the field H, and can also be set on the side surplus land HC.
[0203] Conventionally, the travel end position Gr of the autonomous driving work vehicle 100 is set without considering the working path Ra and the travel path Rb of the autonomous driving work vehicle 100. Therefore, the travel end position Gr is sometimes set at the end of the ground HB. Fig.15 The position shown is a position close to the travel path Rb through which the travel work vehicle 100 passes.
[0204] If the travel end position Gr is set at Fig.15 If the autonomous driving work vehicle 100 is in the position shown in FIG. 1 , there is a problem that the autonomous driving work vehicle 1 that stops at the driving end position Gr may become an obstacle when the autonomous driving work vehicle 100 is traveling along the driving path Rb.
[0205] Therefore, the autonomous driving work vehicle 1 according to one embodiment of the present invention is configured to be able to set the travel end position Gr of the autonomous driving work vehicle 1 by using the work path generation device 150 in consideration of the work path Ra and the travel path Rb of the autonomous driving work vehicle 100 .
[0206] Fig.14 In the illustrated embodiment, the autonomous driving work vehicle 1 is configured to perform work in each work path Ra skipping one of the n work paths Ra, Ra, etc. formed by the work path generation device 150 until the n-th work path Ra(n). Furthermore, the autonomous driving work vehicle 1 is configured to terminate the work of the work machine 24 by the control unit 30 when the current position Z of the autonomous driving work vehicle 1 coincides with the work end position Gw set as the end point of the n-th work path Ra(n), and to cause the autonomous driving work vehicle 1 to autonomously travel to the travel end position Gr.
[0207] That is, in the autonomous driving work vehicle 1 according to the embodiment of the present invention, the control unit 30 causes the vehicle body 2 to travel from the work end position Gw to the travel end position Gr at the headland HB serving as the second area.
[0208] With the autonomous driving work vehicle 1 having such a structure, the travel end position Gr for the autonomous driving work vehicle 1 can be set at a position that will definitely not interfere with the work of the driving work vehicle 100, thereby improving the work efficiency of the accompanying driving work vehicle 100.
[0209] The traveling work vehicle 100 is configured to perform work in each work path Ra skipped by one until the work path Ra(n-1) before the n-th work path Ra(n) among the n work paths Ra, Ra, etc. formed by the work path generation device 150.
[0210] The autonomous working vehicle 1 is configured to: in the final stage of the work in the working area HA, Fig.14 As shown, the vehicle moves forward in the order of working path Ra(n-4) → driving path Rb → working path Ra(n-2) → driving path Rb → working path Ra(n), and when the working end position Gw is reached, the working path Ra(n) is completed, and the vehicle autonomously drives toward the driving end position Gr on the head of the ground HB.
[0211] On the other hand, for the driving work vehicle 100, at the final stage of the work in the work area HA, as shown in FIG. Fig.14As shown, the operator drives the vehicle, while accompanying the autonomous working vehicle 1, and moves forward in the order of working path Ra(n-5)→driving path Rb→working path Ra(n-3)→driving path Rb→working path Ra(n-1), and when the work in the working path Ra(n-1) is completed, the operator enters the processing work of the headland HB and the side surplus land HC.
[0212] That is, the autonomous driving working vehicle 1 involved in one embodiment of the present invention comprises: a body part 2; a working machine 24, which is mounted on the body part 2; a mobile GPS antenna 34 as a position detection unit, which can detect the position information of the body part 2; a memory 309 as a storage unit, which can store the driving area for the body part 2 to drive, that is, the field H; a control unit 30, which can control the driving of the body part 2 in the field H and the work performed by the working machine 24; and a remote control device 112 as a path generation unit, which generates a path R of the body part 2 in the field H, and can use the control unit 30 to store the path R stored in the memory In the field H of 309, the current position Z of the body part 2 is detected by using a mobile GPS antenna 34, while the body part 2 autonomously travels along the path R generated by the remote operation device 112, wherein the field H includes: an operation area HA as a first area, which includes an operation path Ra for operations performed using the operation machine 24; and a headland HB as a second area, which does not include the operation path Ra for operations performed using the operation machine 24. The control unit 30 can drive the body part 2 from the operation end position Gw of the operation path Ra to the travel end position Gr set in the headland HB after the operation performed by the operation machine 24 in the operation path Ra is completed.
[0213] In addition, the work path generation device 150 involved in one embodiment of the present invention includes: a mobile GPS antenna 34 as a position detection unit, which can detect the position information of the vehicle body 2; a memory 309, which can store the travel area for the vehicle body 2 to travel, that is, the field H; a control unit 30, which can issue instructions for the travel of the vehicle body 2 in the field H and the work performed by the work machine 24 mounted on the vehicle body 2; and a remote operation device 112 as a path generation unit, which generates a path R of the vehicle body 2 in the field H, the field H includes: a work area HA as a first area, which includes a work path Ra for work performed by the work machine 24; and a headland HB as a second area, which does not include the work path Ra, and the remote operation device 112 can generate a travel path Rb for the vehicle body 2 to travel from the work end position Gw where the work performed by the work machine 24 in the work path Ra ends to the travel end position Gr set in the headland HB.
[0214] According to the autonomous driving work vehicle 1 and the work path generation device 150 having such a structure, the travel end position Gr for the autonomous driving work vehicle 1 can be set at a position that does not hinder the work of the driving work vehicle 100, thereby improving the work efficiency of the accompanying driving work vehicle 100.
[0215] Here, the autonomous driving work vehicle 1 is configured to select the driving end position Gr by considering the driving path Rb of the driving work vehicle 100 after the work in the work path Ra(n-1) is completed. For example, when the driving work vehicle 100 is scheduled to turn left at the edge of the land HB, the first driving end position Gr1 can be selected, or when the driving work vehicle 100 is scheduled to turn right at the edge of the land HB, the second driving end position Gr2 can be selected.
[0216] In addition, according to the work path generating device 150 involved in one embodiment of the present invention, when the work path Ra of other traveling work vehicles 100 is the work path Ra following on the right rear side of the autonomous traveling work vehicle 1, and when the work path Ra of other traveling work vehicles 100 is the work path Ra following on the left rear side of the autonomous traveling work vehicle 1, the driving end position Gr can also be set at different positions within the ground head HB.
[0217] In addition, according to the work path generating device 150 involved in one embodiment of the present invention, when the work path Ra of other traveling work vehicles 100 is the work path Ra following behind the right side of the autonomous traveling work vehicle 1, and when the work path Ra of other traveling work vehicles 100 is the work path Ra following behind the left side of the autonomous traveling work vehicle 1, the driving end position Gr can also be set at different positions (driving end position Gr1 and driving end position Gr2) within the ground head HB.
[0218] That is, in the work path generating device 150 involved in one embodiment of the present invention, the remote operation device 112 can set the driving end position Gr at the edge of the ground HB based on the work end position Gw and the work path Ra of other driving work vehicles 100 performing work in the work area HA. When the work path Ra of other driving work vehicles 100 is the first work path Ra (scheduled to turn left) and when the work path Ra of other driving work vehicles 100 is the second work path Ra different from the first work path Ra (scheduled to turn right), the driving end position Gr can be set to different positions (driving end position Gr1 and driving end position Gr2) within the edge of the ground HB.
[0219] According to the autonomous driving work vehicle 1 having such a structure, it is possible to reliably ensure that the autonomous driving work vehicle 100 accompanying the autonomous driving work vehicle 1 will not be hindered in its driving.
[0220] Furthermore, the autonomous driving work vehicle 1 is configured to use the work path generation device 150 to set the driving end position Gr on the driving path Rb that the driving work vehicle 100 has passed on the headland HB in consideration of the driving position V of the driving work vehicle 100 on the headland HB.
[0221] Specifically, the autonomous driving work vehicle 1 can be configured to: determine the driving position V of the driving work vehicle 100, and determine the part that has been passed and the part that will be passed later in the driving path Rb of the driving work vehicle 100 on the headland HB, and do not set the driving end position Gr of the autonomous driving work vehicle 1 on the driving path Rb that the driving work vehicle 100 will pass later.
[0222] In addition, the autonomous driving work vehicle 1 can be formed into the following structure: the information related to the parts that have been passed and the parts that will be passed in the driving path Rb of the driving work vehicle 100 on the headland HB is updated in real time, and it can be constructed so that the driving end position Gr of the autonomous driving work vehicle 1 can be changed at any time according to the travel conditions of the driving work vehicle 100.
[0223] For example, Fig.16 As shown, the autonomous driving work vehicle 1 may be configured such that when the autonomous driving work vehicle 100 is in the work path Ra(n-5) but has not yet entered the work path Ra(n-3), the work path generation device 150 stops the autonomous driving work vehicle 1 at the temporary stop position Gt. Then, after the autonomous driving work vehicle 100 enters the work path Ra(n-3), the control unit 30 causes the autonomous driving work vehicle 1 to autonomously travel from the temporary stop position Gt to the travel end position Gr.
[0224] In addition, the autonomous driving work vehicle 1 can be configured such that the temporary stop position Gt is not set, but based on the position of the autonomous driving work vehicle 1, the position of the driving work vehicle 100, and the path R of the driving work vehicle 100, the control unit 30 is used to control the autonomous driving work vehicle 1 to temporarily stop at a position closer to the front side than the position where the path R of the autonomous driving work vehicle 1 intersects with the path R of the driving work vehicle 100.
[0225] In addition, the autonomous driving work vehicle 1 can be configured as follows: if the driving position V of the driving work vehicle 100 is detected using the work path generating device 150, the work delay status of the driving work vehicle 100 can be grasped. Therefore, when the work delay of the driving work vehicle 100 is detected, there is no need to wait for the driving work vehicle 100 to reach the work path Ra(n-3), and the driving end position Gr can be changed to the position of the driving path Rb that has been traveled before the work path Ra(n-5).
[0226] The work path generation device 150 is configured to set the travel end position Gr in a manner that prevents the autonomous driving work vehicle 100 from contacting the autonomous driving work vehicle 1 by taking into account the sizes of the autonomous driving work vehicle 1 and the work machine 24 , the sizes of the autonomous driving work vehicle 100 and the work machine 24 , and the like.
[0227] Specifically, it is configured to satisfy the following mathematical formula 1 (refer to Fig.17 ) is determined in a manner such that the driving end position Gr is disposed at a position separated by a distance L or more from an extension line f of the work path Ra passing through the work end position Gw of the autonomous driving work vehicle 1.
[0228] Here, A is the tillage width (working width) of the autonomous driving work vehicle 1, B is the tillage width (working width) of the driving work vehicle 100, C is the overlap amount of the work performed by the autonomous driving work vehicle 1 and the driving work vehicle 100, D is the maximum width of the driving work vehicle 100 (or the working machine equipped on the driving work vehicle 100), E is the distance from the position of the mobile GPS antenna 34 of the autonomous driving work vehicle 1 (current position Z) to the rear end of the working machine 24, and γ is the margin. In addition, it can be configured so that the above-mentioned margin γ is not estimated when determining the configuration of the driving end position Gr.
[0229] (Mathematical formula 1)
[0230] L≥(A / 2)+B-C+(D-B) / 2+E+γ
[0231] That is, the autonomous driving work vehicle 1 is configured to arrange the travel end position Gr at a position separated by a distance greater than a predetermined range (distance L relative to the extension line f) from the work end position Gw of the autonomous driving work vehicle 1. In addition, the travel end position Gr of the autonomous driving work vehicle 1 may be set at a position separated by a distance greater than a predetermined range from the work end position of the traveling work vehicle 100 based on the work end position of the accompanying traveling work vehicle 100.
[0232] In addition, the autonomous driving work vehicle 1 is configured to set the travel end position Gr by using the work path generation device 150 in consideration of the situation when the autonomous driving work vehicle 1 is taken out of the field H after the work is completed, taking into consideration the position of the entrance and exit of the field H. That is, the work path generation device 150 may be configured to set the travel end position Gr at a position as close to the entrance and exit of the field H as possible.
[0233] In addition, the autonomous driving working vehicle 1 is configured as follows: Fig.18 As shown, the azimuth angle θ of the vehicle body 2 relative to the reference azimuth X can be detected by the azimuth angle detection unit 32, and the azimuth angle θ (i.e., direction) when the autonomous driving work vehicle 1 is stopped can be controlled by the control unit 30 of the work path generation device 150.
[0234] Furthermore, the autonomous driving work vehicle 1 is configured to control the azimuth angle θ (direction) of the autonomous driving work vehicle 1 when it stops at the travel end position Gr. When the autonomous driving work vehicle 1 stops at the travel end position Gr, the azimuth angle θ of the autonomous driving work vehicle 1 is directed toward the entrance and exit of the field H in advance, so that when the autonomous driving work vehicle 1 is taken out of the field H, the operator can easily take the autonomous driving work vehicle 1 out of the field H without making a turn, etc., by only making the autonomous driving work vehicle 1 go straight, and without damaging the field H after work.
[0235] That is, the autonomous driving work vehicle 1 according to one embodiment of the present invention includes an azimuth angle detection unit 32 capable of detecting the azimuth angle θ of the vehicle body 2 , and the control unit 30 capable of controlling the azimuth angle θ of the vehicle body 2 at the travel end position Gr.
[0236] With the autonomous driving work vehicle 1 having such a structure, the autonomous driving work vehicle 1 can be quickly moved out of the field H without damaging the headland HB and the side margin land HC.
[0237] Furthermore, the autonomous driving work vehicle 1 may be configured such that: the display device 113 (see Figure 2 ) The travel end position Gr of the autonomous driving work vehicle 1 is displayed, and the travel end position Gr can be easily changed by a touch operation on the screen of the display device 113. The autonomous driving work vehicle 1 with such a structure can flexibly respond to changes in the user's work plan.
[0238] In addition, for the autonomous driving working vehicle 1, if Fig.14As shown, since the side margin HC is set at the side of the field H with the same width as the headland HB by the work path generation device 150, the autonomous driving work vehicle 1 and the driving work vehicle 100 can travel on the side margin HC as well as the headland HB. According to such a structure, the peripheral part of the field H (headland HB and side margin HC) can be easily processed, thereby improving the working efficiency.
[0239] In addition, for the autonomous driving working vehicle 1, if Fig.14 As shown, the side margin HC of the field H is set to the same width as the headland HB, so that the autonomous driving work vehicle 1 can move and pass through the side margin HC, thereby setting the travel end position Gr in the direction opposite to the work end position Gw, and the path generation can be more flexible, and further, the path that does not include virtual travel can be easily generated.
[0240] Here, the configuration of a driving area identification device according to an embodiment of the present invention will be described.
[0241] like Figure 2 As shown, the work path generation device 150 of the autonomous driving work vehicle 1 includes a mobile GPS antenna 34 as a position information acquisition unit. The mobile GPS antenna 34 can acquire the position information of the vehicle body 2 , that is, the current position Z.
[0242] In addition, the work path generation device 150 has a remote operation device 112 as a driving track area determination unit, which can determine the driving track J of the vehicle body 2 using the current position Z detected by the mobile GPS antenna 34, and determine the driving track area JA of the vehicle body 2 based on the driving track J.
[0243] In the autonomous driving work vehicle 1 , the control unit 30 can also determine the travel trajectory area JA of the body 2 based on the travel trajectory J. The control unit 30 can be used instead of the remote control device 112 to determine the travel trajectory area JA of the body 2 .
[0244] In addition, the remote operation device 112 of the work path generation device 150 also has the following function as a driving area determination unit: it can determine the driving area for the vehicle body 2 to drive, that is, the shape of the field H (hereinafter referred to as the field shape HK) based on multiple selection points selected from the driving trajectory J, that is, the corners p~u.
[0245] Furthermore, in the autonomous working vehicle 1 , the control unit 30 can determine the field shape HK based on a plurality of selected points, ie, corners p to u, selected from the travel trajectory J. The field shape HK can be determined by the control unit 30 instead of the remote control device 112 .
[0246] Furthermore, the remote control device 112 of the work path generation device 150 also has a function as a correction unit capable of correcting the field shape HK.
[0247] Furthermore, the autonomous driving working vehicle 1 may be configured to correct the field shape HK using the control unit 30 , and may be configured to correct the field shape HK using the control unit 30 instead of the remote control device 112 .
[0248] Furthermore, the remote operation device 112 of the work route generation device 150 includes a display device 113 as a notification unit, and the display device 113 can perform a predetermined notification.
[0249] That is, the working path generating device 150 of the driving area determining device involved in one embodiment of the present invention is a driving trajectory area determining unit that can determine the driving trajectory area JA of the vehicle body 2 based on the driving trajectory J of the vehicle body 2 determined by utilizing a position information acquiring unit that can acquire the position information of the vehicle body 2, that is, the current position Z, that is, the mobile GPS antenna 34 and the current position Z. In addition, it is also a driving area determining unit that can determine the driving area for the vehicle body 2 to travel, that is, the shape of the field H (field shape HK) based on multiple selection points p~u selected from the driving trajectory J. In addition, it also has a remote operating device 112 and a control unit 30 as a correction unit that can correct the field shape HK.
[0250] Next, the field registration of the autonomous driving working vehicle 1 according to one embodiment of the present invention will be described. Fig.19 The following description will be given of a case where a field H having a concave-convex shape as shown is registered.
[0251] For the autonomous driving working vehicle 1, Fig.19 When the field H shown in FIG. 1 is registered, the autonomous driving work vehicle 1 is driven by the operator to travel along the periphery of the field H, thereby acquiring the travel trajectory J. Fig.19 As shown, the shape of the travel track J is substantially consistent with the outer peripheral shape of the field H.
[0252] Furthermore, since the autonomous driving work vehicle 1 needs to have a predetermined turning radius when turning, the corners of the travel track J are arc-shaped and are different from the shape of the actual field H.
[0253] Next, in the field registration for the field H, the corners existing on the travel track J are identified.
[0254] like Fig. 20 As shown, in the driving trajectory J shown in this embodiment, there are six corners p, q, r, s, t, and u. Fig. 20 The driving trajectory J shown having the corners p, q, r, s, t, u is displayed on the display device 113 .
[0255] Next, in the field registration of the field H, the operator selects a corner existing on the travel track J and sets the shape of the field H (field shape HK).
[0256] For example, Fig. 20 As shown in the figure, when the operator selects the six corners p, q, r, s, t, and u on the driving trajectory J, the operator sets Fig. 20 The field shape HK is shown.
[0257] If the operator selects all corners correctly, Fig. 20 As shown, the field shape HK that substantially matches the shape of the field H can be set with high accuracy.
[0258] On the other hand, for example, if the operator selects only five corners p, q, r, t, and u on the travel trajectory J (that is, if the operator forgets to select the corner S), the setting Fig.21 The pentagonal field shape HK is shown.
[0259] In this case, the portion of the field shape HK corresponding to the triangle rst is set as a part (inside area) of the field H, although it is originally an area outside the field H. In this case, an erroneous field shape HK may be set, and the working path Ra and the driving path Rb of the autonomous driving work vehicle 1 may be set outside the field H.
[0260] Therefore, in order to prevent the work path Ra or the travel path Rb of the autonomous driving work vehicle 1 from being set outside the field H, the work path generation device 150 according to one embodiment of the present invention adopts the configuration described below.
[0261] The operation path generating device 150 of the driving area determining device according to one embodiment of the present invention may be configured as follows: Fig. 20As shown, the remote operating device 112 is used to automatically determine the closed area surrounded by the acquired driving trajectory J (hereinafter referred to as the driving trajectory area JA). When it is detected that a certain point on the set field shape HK is outside the determined driving trajectory area JA, the remote operating device 112 is used to determine whether there is an error in the setting of the field shape HK (that is, whether the field shape HK protrudes from the actual field H).
[0262] Furthermore, the remote control device 112 is configured to issue an alarm on the display device 113 of the remote control device 112 when it is determined that the field shape HK is erroneous.
[0263] That is, the driving area determination device (operation path generation device 150) involved in the present invention has a remote operation device 112 as a determination unit. When a determined point on the set field shape HK is located outside the driving track area JA, the remote operation device 112 determines that the field H includes an area outside the driving track area JA.
[0264] Furthermore, according to the travel area determination device (the work route generation device 150 ) having such a configuration, it is possible to more reliably prevent the route R (the work route Ra and the travel route Rb) from being erroneously set outside the field H.
[0265] In addition, the driving area determination device (operation path generation device 150) involved in one embodiment of the present invention can be configured as follows: using the remote operation device 112 to automatically determine the driving trajectory area JA, and compare the area of the set field shape HK with the area of the driving trajectory area JA. When the area of the field shape HK exceeds the area of the driving trajectory area JA, the remote operation device 112 is used to determine whether there is an error in the setting of the field shape HK (that is, whether the field shape HK protrudes from the actual field H).
[0266] That is, the driving area determination device (operation path generation device 150) involved in the present invention has a remote operation device 112 as a judgment unit. When the area of the set field shape HK is larger than the area of the driving track area JA, the remote operation device 112 judges that the field shape HK includes an area outside the driving track area JA.
[0267] Furthermore, according to such a travel area identification device (the work route generation device 150 ), it is possible to more reliably prevent the route R (the work route Ra and the travel route Rb) from being mistakenly set outside the field H.
[0268] In addition, the structure may be such that a threshold value is appropriately set for determining whether or not there is a portion protruding from the field H, and when the area of the protruding portion exceeds a predetermined threshold value, it is determined that there is a protrusion.
[0269] Furthermore, the travel area identification device (work route generation device 150 ) according to one embodiment of the present invention may be configured to compare the set field shape HK with known map information.
[0270] like Fig. 22 As shown, the driving area determination device (operation path generation device 150) is configured to store the map information HM of the field H in advance in the remote operation device 112, and compare the set field shape HK with the map information HM using the remote operation device 112. The map information HM includes the location information (latitude and longitude of the end points), area, shape and other information of the field H.
[0271] Furthermore, the remote control device 112 is configured to detect a portion of the field shape HK that is inconsistent with the map information HM (for example, Fig. 22 In the case of the triangle rst shown in FIG. 1 , an alarm is issued on the display device 113 of the remote operating device 112.
[0272] Here, the travel area identification device (work path generation device 150 ) sets the content of the notification made by the display device 113 to be the content of the notification suggesting that the field H includes an area other than the travel track area JA.
[0273] As specific notification content displayed on the display device 113, for example, a statement such as "It is necessary to confirm whether the corner selection is incorrect" urges the operator to confirm, or a warning such as "If the path generation continues as it is, there is a possibility that the path will be generated outside the field H" is displayed.
[0274] In addition, the driving area determination device (operation path generation device 150) can be configured to use the remote operation device 112 to correct the field shape HK in such a way that the field H does not include areas outside the driving trajectory J, rather than using the display device 113 to notify areas outside the field H including the driving trajectory J.
[0275] In this case, a configuration may be adopted in which a display for confirming “whether the field shape HK has been corrected” is displayed on the display device 113 , and when the operator selects “correction”, the correction is executed by the remote operation device 112 .
[0276] The driving area determination device (operation path generation device 150) is configured such that, for example, the operator can modify the field shape HK displayed on the display device 113 according to instructions issued on the screen using a stylus. For example, the operator corrects the field shape HK by performing an operation to add and select the corner S.
[0277] In addition, the driving area determination device (operation path generation device 150) can be constructed as follows: in a structure that compares map information and the field shape HK, the protruding part is determined using the remote operation device 112, and the determined protruding part is deleted using the remote operation device 112, thereby correcting the field shape HK.
[0278] In addition, the method of specifying the field shape HK after acquiring the travel trajectory J is not limited to the method of specifying only the corners.
[0279] For example, the structure may be as follows: the acquired driving trajectory J is displayed in advance on the display device 113, and the operator specifies the corners and sides according to instructions given on the screen using a stylus, thereby determining the field shape HK. According to such a determination method, even if the selection of the corners is forgotten, the field shape HK can be determined with high accuracy.
[0280] Alternatively, as a method for determining the field shape HK after acquiring the driving trajectory J, it can be configured as follows: using the remote operation device 112 to automatically generate the field shape HK based on the acquired driving trajectory J. In addition, it can also be configured as follows: the operator confirms the automatically generated field shape HK and makes appropriate corrections based on the actual situation, thereby obtaining a more appropriate field shape HK.
[0281] That is, the working path generating device 150 as the driving area determining device involved in the present invention is a driving track area determining unit that can determine the driving track area JA of the vehicle body 2 based on the driving track J of the vehicle body 2 determined by utilizing a position information acquiring unit that can acquire the position information of the vehicle body 2, that is, the current position Z, that is, the mobile GPS antenna 34 and the current position Z. In addition, it has: a remote operating device 112 as a driving area determining unit, which can determine the driving area for the vehicle body 2 to travel, that is, the field shape HK, based on multiple selection points selected from the driving track J, that is, the corners p~u; and a display device 113 as a notification unit, which can execute a specified notification, and the specified notification is a notification that implies that the set field shape HK includes an area outside the driving track area JA.
[0282] In addition, the working path generating device 150 as the driving area determining device involved in the present invention is a driving track area determining unit that can determine the driving track area JA of the vehicle body 2 based on the driving track J of the vehicle body 2 determined by utilizing a position information acquiring unit that can acquire the position information of the vehicle body 2, that is, the current position Z, that is, the mobile GPS antenna 34 and the current position Z. In addition, it is a driving area determining unit that can determine the driving area for the vehicle body 2 to travel, that is, the field shape HK, based on multiple selection points selected from the driving track J, that is, the corners p~u. In addition, it has a remote operating device 112 as a correction unit that can correct the field shape HK. When the set field shape HK includes an area outside the driving track area JA, the remote operating device 112 corrects the field shape HK to an area that does not include the area outside the driving track area JA.
[0283] Furthermore, the work path generation device 150 having such a configuration can prevent the path R (work path Ra and travel path Rb) of the autonomous working vehicle 1 from being mistakenly set outside the field H, which is the travel area.
[0284] Next, an example of registering a field by the autonomous driving working vehicle 1 according to an embodiment of the present invention is shown. Fig.23 The following describes a case where two crops (crop SX and crop SY) are respectively set in the field H shown in FIG. Fig.23 The following describes a case where a substantially rectangular field H shown in (A) is divided into two areas, a crop SX is cultivated in one area, and a crop SY is cultivated in the other area.
[0285] In such a case, when registering a field for the area of the crop SX, first, the outer peripheral shape of the field H is detected by the autonomous working vehicle 1, and the field shape HK of the entire field H is determined. Fig.23 As shown in (B), the field shape HK of the entire field H is determined by selecting the corner pqrs.
[0286] Next, in order to determine the area of crop SX, point t on line segment pq and point u on line segment rs are additionally selected, and the rectangular portion defined by point ptus is determined as the field shape HK1 for crop SX, and the rectangular portion defined by point qrut is determined as the field shape HK2 for crop SY.
[0287] Here, for example, in the case where the user mistakenly selects t and point u, Fig.24 As shown in (A), there is a possibility that a part of the area of the crop SY is mistakenly registered as the area of the crop SX.
[0288] Therefore, the work path generation device 150 involved in one embodiment of the present invention can be configured to: obtain the area data DX, DY of each area of the crops SX, SY in advance, and compare the area data DX, DY with each field shape HK1, HK2, thereby preventing erroneous field registration.
[0289] In addition, as the area data DX and DY of the crops SX and SY, the area of each area, the position information of the end points in each area, the map data of each area (including the shape, area, and position information), etc. can be used.
[0290] Then, such area data DX and DY are stored in the remote control device 112 in advance, and the determined field shapes HK1 and HK2 are compared with the area data DX and DY by the remote control device 112, thereby preventing erroneous field registration.
[0291] In addition, if Fig.24 As shown in (B), the area data DX and DY are compared, and when the remote control device 112 determines that the field shapes HK1 and HK2 are wrong (there is an overlapping portion), the display device 113 notifies the error.
[0292] Alternatively, it can be configured such that: when it is determined that there is an error in the field shape HK1, HK2, the remote operation device 112 is used to correct the configuration of points t, u in such a way that the determined field shape HK1, HK2 matches the regional data DX, DY, thereby correcting each field shape HK1, HK2.
[0293] Next, a method for generating a route for a work vehicle will be described.
[0294] When the autonomous working vehicle is used to work back and forth in the working area, the turning radius of the headland area is smaller than the turning radius of the autonomous working vehicle itself due to the set overlap amount or the width of the installed working machine, so that the turning cannot be completed in one go and a turnaround is required, which may increase the time required for turning, which is inefficient. In addition, when the turning radius is small, a sharp turn may occur, and tire marks may be clearly left on the headland, which may also cause a time-consuming processing operation on the headland.
[0295] The path generation method for the work vehicle shown below carefully designs the path generation, so that when performing reciprocating work in the work area HA, it is possible to turn efficiently at the head of the field HB. When performing reciprocating work, the surface of the field H will not be damaged by turning at the head of the field HB, and turning can be performed efficiently.
[0296] Regarding the setting of the number of jumps in the path generation setting, when jumping N (N is a natural number greater than 1) columns is selected, the path is generated by "jumping N columns". Here, "jumping N columns" means: configuring the nth column (in the present embodiment, n is a natural number greater than 0, used as a mark to indicate the order of work) of the working road and the n+1th column of the working road across N columns of working roads. Specifically, it means: when driving sequentially on the working roads R1, R2, etc. included in the working path Ra, the working road configured across N columns of working roads relative to the current working road is set as the next working road, that is, skipping 2 adjacent working roads from the current working road and entering the next working road (for example, refer to Fig.25 , after driving on R1, driving on R4). Each working road has a predetermined working width corresponding to the work performed by the autonomous driving working vehicle 1, and is arranged in parallel in the working area. Moreover, by skipping multiple rows to generate a path, it is possible to fully ensure the turning distance, and the autonomous driving working vehicle 1 can have room to turn on the driving path Rb without making a sharp turn. As a result, the field surface can be turned efficiently without damaging it. The following is a more detailed description of the method of generating a path when skipping 2 rows is selected in the path generation setting.
[0297] In addition, "skipping N columns" means that the nth column (n is a natural number greater than 0) and the n+1th column of working paths are arranged across N columns of working paths. However, sometimes the working path Rn and the working path (Rn+1) cannot be arranged across N columns of working paths due to the number of working paths included in the working path Ra. In this case, they are arranged across at least K columns greater than (N+1).
[0298] Figure 25 to Figure 28 A method for generating a path according to the first embodiment is shown. Fig.29 A method for generating a path according to the second embodiment is shown. Fig.30 and Fig.31 A method for generating a path according to the third embodiment is shown.
[0299] [First embodiment]
[0300] Fig.25The following embodiment is shown: starting from the working road R1 at the end (the work start position S), the order of the working roads is determined by skipping two roads to one side, returning from the working road R10 which is the limit on one side, that is, the working road R10 which cannot skip two roads to one side, to the first working road R2 adjacent to the working road R1 at the end, and from there, skipping two roads to one side again to set the driving order of the working roads, and after reaching the working road which is the limit, returning to the second working road R3 adjacent to the working road R1 at the end, and skipping two roads to one side again to set the driving order of the working roads. In addition, the "driving order" is the driving order in the working path Ra generated in the path R, which is the order of the working roads used for driving in the working path Ra from one end HB to another end HB.
[0301] Fig.26 The following implementation method is shown: starting from the working road R1 at the end (the work start position S), 2 roads are skipped toward one side to determine the order of the working roads, and from the limit of one side, that is, the working road R10, return to the second working road R3 adjacent to the working road R1 at the end, and from here, 2 roads are skipped toward one side again to set the driving order of the working roads. After reaching the working road R9 as the limit, return to the working road R2, and 2 roads are skipped toward one side again to set the driving order of the working roads.
[0302] In this embodiment, the cases where the number of working paths is 10, 11, and 12 are taken as examples. Fig.25 and Fig.26 The upper, middle and lower parts.
[0303] As described above, by generating path R, it is possible to maintain a method of skipping two or more paths so that the adjacent work roads enter the next work road by jumping two columns using the following simple algorithm. The algorithm is as follows: take the work road at the end as the starting position, set the driving order from the end by jumping two columns in sequence, and when the limit is reached, return to the second or third work road from the end.
[0304] The repetition unit of the operation path in the algorithm of this embodiment is, for example, Fig. 27 In this case, the number of working paths of the first group is 9, from the first working path R1 as the starting position of the group (working starting position S1) to the ninth working path R9 as the ending position, and the starting position (working starting position S2) of the second group is shared with the ending position (R9) of the working paths of the first group, so that the number of working paths of the second group is counted as 9. That is, the first group is set to 9 starting from the working path R1 at the end, and the 9th working path R9 is counted repeatedly as the first (end) working path R1 of the next second group.
[0305] And, similarly, the entire paths of the third group, the fourth group, and the fifth group are repeatedly established. Thus, even when the number of working roads is large, the method of skipping two rows can be maintained, and the driving distance between working roads (the distance of the driving path Rb) can be shortened, and the overall driving distance when the method of skipping two rows is selected can be shortened.
[0306] The quotient obtained by subtracting 1 from the number of work roads M (M is a natural number) and dividing the result by 8 is the number of repetitions of the work road group. The value of the remainder (a value from 1 to 7) is added to the final group. The same algorithm is used for the final work road group of 10 to 16 generated to set the driving order of the work roads. In this way, the driving order of the work roads in the repeated work road group and the driving order of the work roads in the final work road group can be set. Regardless of the number of work roads, the algorithm of this embodiment can be applied.
[0307] like Fig.28 As shown, the repetition unit of the working road in the algorithm of this embodiment can be set to 11. In this case, the eleventh working road R11 of the first group is also used as the first working road R1 of the second group. In addition, the quotient obtained by subtracting 1 from the number of working roads M and dividing it by 10 is the number of repetitions of the working road group. In addition, the value of the remainder is added to the last group, or, if the value of the remainder is large, the driving order can be set according to the same algorithm for the number of working roads corresponding to the value of the remainder.
[0308] In addition, the repetitive unit of the working path is not limited to the above-mentioned 9 or 11, for example, it can also be 15. However, if the number of working paths included in the repetitive unit increases, the number of jumps within the repetitive unit (the distance between the moving working paths) will inevitably increase, so it does not constitute a preferred method.
[0309] That is, the path generation method shown in the first embodiment is characterized in that the path R includes a working path Ra within a working area HA of a field H and a driving path Rb within a headland HB, the working path Ra includes a plurality of working roads R1 to R12 arranged in parallel, and the working roads R1 to R12 are connected in sequence according to the driving path Rb, and when two or more adjacent working roads are skipped in the driving path Rb for connection, starting from the working road at the end of the working road, two working roads are skipped toward one side to set the driving order of the working roads, and after reaching the limit of the one side, two working roads are skipped again toward one side from either the first working road or the second working road adjacent to the working road at the end, thereby setting the driving order of the working roads, and after reaching the limit of the one side, two working roads are skipped again toward one side from the other of the first working road or the second working road adjacent to the working road at the end, thereby setting the driving order of the working roads.
[0310] According to such a configuration, when performing reciprocating work in the work area HA, the operator can efficiently turn at the headland HB, and when performing reciprocating work, the operator can efficiently turn at the headland HB without damaging the surface of the field H due to turning.
[0311] [Second Embodiment]
[0312] Fig.29 An embodiment in which the work start position is changed according to the number of work paths is shown. Fig.29 In the figure, the upper part shows an example in which the number of working roads is set to 12 (a multiple of 3), the middle part shows an example in which the number of working roads is set to 10 (a multiple of 3 - 2), and the lower part shows an example in which the number of working roads is set to 11 (a multiple of 3 - 2).
[0313] When the number of working roads is 3N (N is a natural number greater than 4, "3N" means a multiple of 3), the second working road R2 from the end is used as the starting position, when the number of working roads is 3N-2, the third working road R3 from the end is used as the starting position, and when the number of working roads is 3N-1, the working road R1 at the end is used as the starting position. And, after setting the work starting position S (starting working road) according to the number of working roads, the driving order of the working roads is set in a way of skipping 2 rows.
[0314] As described above, by changing the work start position according to the number of work lanes, it is possible to maintain the method of jumping two rows and realize efficient turning at the edge of the field.
[0315] That is, the path generation method shown in the second embodiment is characterized in that the path R includes a working path Ra within the working area HA of the field H and a driving path Rb within the headland HB, the working path Ra includes a plurality of working roads R1 to R12 arranged in parallel, and the working roads R1 to R12 are connected in sequence according to the driving path Rb, and when the connection is performed by skipping two or more adjacent working roads in the driving path Rb, when the number of the working roads is 3N (N is a natural number greater than or equal to 4, the same below), the second working road starting from the end is used as the starting position, when the number of the working roads is 3N-2, the third working road starting from the end is used as the starting position, and when the number of the working roads is 3N-1, the working road at the end is used as the starting position.
[0316] According to such a configuration, when performing reciprocating work in the work area HA, the operator can efficiently turn at the headland HB, and when performing reciprocating work, the operator can effectively turn at the headland HB without damaging the surface of the field H due to turning.
[0317] [Third Embodiment]
[0318] Fig.30 and Fig.31 An embodiment of setting the driving order so that the working directions of adjacent working paths are different from each other is shown. Fig.30 An example of using all or part of the algorithm of the first embodiment is shown. Fig.31 An example using the algorithm of the second embodiment is shown.
[0319] By alternately setting the working directions in the working area as in the present embodiment, it is possible to suppress the displacement of soil after the working.
[0320] Fig.30 , the cases where the number of working paths is set to 9, 11, and 13 are taken as examples and are shown in the upper, middle, and lower parts, respectively.
[0321] When there are 9 working roads, the driving order is set twice from the working road R1 at the end (working start position S) toward one side, and the driving order is set in the working road R4 and the working road R7. Then, the second working road R2 starting from the end is returned to the one side again, and the driving order is set in the order of the working road R5 and the working road R8. Finally, the third working road R3 starting from the end is returned to the one side again, and the driving order is set in the order of the working road R6 and the working road R9.
[0322] When there are 11 working roads, the driving order is set three times from the working road R1 at the end (working start position S) toward one side, to the working road R4, working road R7, and working road R10. Then, the driving order is set by returning to the third working road R3 from the end and again toward one side, and finally, the driving order is set from the second working road R2 from the end toward one side.
[0323] That is, when the running order is set in a manner of skipping 2 rows from the working road at the end, if the running order is set in an even number of times toward one side, then the second working road from the end is returned to set the running order by skipping 2, and finally, the third working road from the end is returned to set the running order by skipping 2, thereby maintaining the method of skipping 2 rows. On the other hand, if the running order is set in an odd number of times toward one side, then the third working road from the end is returned to set the running order by skipping 2, and finally, the second working road from the end is returned to set the running order by skipping 2, thereby maintaining the method of skipping 2 rows.
[0324] In other words, the driving order is set by skipping two working roads from the end, and the next working road to be entered is determined to be the second or third working road starting from the end according to the working direction when turning back after reaching the limit on one side. In this way, the working directions in adjacent working roads can be set alternately.
[0325] When there are 13 working roads, the driving order is set 4 times (even times) from the working road R1 at the end toward one side to the working road R4, working road R7, working road R10, and working road R13. Then, return to the second working road R2 starting from the end, and toward one side again, set the driving order 3 times (odd times) in the order of working road R5, working road R8, and working road R11. Then, return to the sixth working road R6 starting from the end, and toward one side again, set the driving order in the order of working road R9 and working road R12, and finally return to the third working road R3 starting from the end.
[0326] When there are 13 working roads, unlike the cases of 9 and 11 working roads, the working direction of the driving sequence at the second turn, that is, the tenth road, is the same as the working direction in the driving sequence at the first turn, that is, the sixth road, and therefore the third working road from the end is skipped and the next working road R6 is set as the next driving sequence. That is, while using a part of the algorithm of the first embodiment, the working directions in adjacent working roads are set alternately with priority.
[0327] Fig.31 In the figure, the cases where the number of working paths is 7 and 8 are taken as examples and are shown in the upper and lower parts respectively.
[0328] When the number of working roads is 7 (multiple of 3 - 2), the driving order is set in the order of working roads R6, R1, R4, R7, R2, and R5, starting from the third working road R3 at the end. When the number of working roads is 8 (multiple of 3 - 1), the driving order is set in the order of working roads R6, R3, R8, R5, R2, R7, and R4, starting from the working road R1 at the end.
[0329] Thus, in the second embodiment, although N is set to a natural number greater than or equal to 4, the present invention can also be similarly applied to a case where N=3.
[0330] As described above, in this embodiment, when setting the driving order of each work road in a manner that makes the driving directions in adjacent work roads in the work area different from each other, the algorithm used in the first embodiment or the second embodiment is utilized; however, as long as the driving order can be set in a manner that forms alternating driving directions, it is not limited to these examples.
[0331] Other features of the present embodiment are that, when it is impossible to configure the work path Rn and the work path (Rn+1) across N columns of work paths based on the number of work paths included in the work path Ra, they are configured across at least K columns more than (N+1) columns, and, when other work paths with a continuous sequence are configured across more than N columns of work paths, they are always configured across K columns, and further, the setting direction of the work sequence of the work paths configured across N columns is one side, and the setting direction of the work sequence of the work paths configured across K columns is the opposite direction of the above-mentioned one side.
[0332] Right now, Fig.32 In the path shown in the upper layer (the case where the number of work paths is 7), work paths with a continuous work sequence (for example, work path R1 and work path R4, and work path R3 and work path R6) are arranged with 2 rows of work paths between them on one side (a direction perpendicular to the work direction F set in the field setting and a direction of the work end position G based on the work start position S), and work paths with a continuous work sequence (for example, work path R7 and work path R2, and work path R6 and work path R1) are arranged with 4 rows more than 2 rows between them on the opposite side of one side.
[0333] since Fig.32 In the paths shown in the second layer from the top (when the number of work paths is 8), work paths with a continuous work sequence (for example, work paths R1 and work paths R4, and work paths R3 and work paths R6) are arranged with 2 rows of work paths between them on one side (a direction perpendicular to the work direction F set in the field setting and a direction of the work end position G based on the work start position S), and work paths with a continuous work sequence (for example, work paths R7 and work paths R2, and work paths R8 and work paths R3) are arranged with 4 rows more than 2 rows between them on the opposite side of one side.
[0334] Fig.32 In the path shown in the middle layer (when the number of work paths is 9), work paths with a continuous work sequence (for example, work path R1 and work path R4, and work path R3 and work path R6) are arranged with 2 rows of work paths between them on one side (a direction perpendicular to the work direction F set in the field setting and a direction of the work end position G based on the work start position S), and work paths with a continuous work sequence (for example, work path R7 and work path R2, and work path R8 and work path R3) are arranged with 4 rows more than 2 rows between them on the opposite side of one side.
[0335] since Fig.32In the paths shown in the second layer from the bottom (when the number of work paths is 10), work paths with a continuous work sequence (for example, work path R1 and work path R4, and work path R3 and work path R6) are arranged with 2 rows of work paths between them on one side (a direction perpendicular to the work direction F set in the field setting and a direction of the work end position G based on the work start position S), and work paths with a continuous work sequence (for example, work path R9 and work path R2, and work path R10 and work path R3) are arranged with 6 rows more than 2 rows between them on the opposite side of one side.
[0336] Fig.32 In the path shown in the lower layer (when the number of work paths is 11), work paths with a continuous work sequence (for example, work path R1 and work path R4, and work path R3 and work path R6) are arranged with 2 rows of work paths between them on one side (a direction perpendicular to the work direction F set in the field setting and a direction of the work end position G based on the work start position S), and work paths with a continuous work sequence (for example, work path R9 and work path R2, and work path R10 and work path R3) are arranged with 6 rows more than 2 rows between them on the opposite side of one side.
[0337] The above-mentioned features are summarized. When two (two columns) of working paths are arranged with a predetermined number of working paths separated, the predetermined number is a value set in advance by the user. Therefore, when the "first value" is set as the predetermined number, the "first value" column of working paths is arranged between the nth column of working paths and the n+1th column of working paths among the multiple columns of working paths. On the other hand, when it is impossible to arrange two working paths with the "first value" column separated due to the number of working paths, two working paths are arranged with the "second value" column separated, which is greater than the first value. That is, when it is impossible to arrange two working paths with the "first value" column separated, two working paths are not arranged with the "third value" column separated, which is smaller than the "first value" column.
[0338] In addition, in the case where it is impossible to arrange two working paths across the "first value" column for many times, two working paths are always arranged across the "second value" column, thereby suppressing the excessive generation of paths that the user does not expect. That is, two working paths are not arranged across a "fourth value" column that is larger than the "first value" and different from the "second value". In addition, when two columns of working paths are arranged across the "first value" column, the setting direction of the working sequence (the working direction of the n+1th column based on the working path of the nth column) is the above-mentioned one side, and when two columns of working paths are arranged across the "second value" column, the setting direction of the working sequence is the opposite direction of the above-mentioned one side.
[0339] Furthermore, when the end position of the work performed by the autonomous working vehicle 1 in the work path for which the final order is set as the work order is different from the work end position G set in the field setting, the autonomous working vehicle only needs to travel on the headland HB and / or the side margin HC and move from the above end position to the work end position G. Thus, the path can be appropriately generated without changing the work end position G specified by the user in the field setting.
[0340] That is, the path generation method shown in the third embodiment is characterized in that the path R includes a working path Ra within the working area HA of the field H and a driving path Rb within the headland HB, the working path Ra includes a plurality of working roads R1 to R12 arranged in parallel, and the working roads R1 to R12 are connected in sequence according to the driving path Rb, and when the driving path Rb skips two or more adjacent working roads for connection, the driving directions in the adjacent working roads in the working roads are set to be different from each other.
[0341] According to such a configuration, when reciprocating work is performed in the work area HA, the vehicle can efficiently turn at the headland HB, and when reciprocating work is performed, the surface of the field H can be efficiently turned at the headland HB without damaging the surface of the field H due to turning.
[0342] Description of Reference Numerals
[0343] 1 Autonomous working vehicles
[0344] 2 Body
[0345] 24 Operating Machine
[0346] 32 Azimuth angle detection unit
[0347] 34 Mobile GPS antenna (position detection unit)
[0348] 30 Control Department
[0349] 100 Driving work vehicles
[0350] 112 Remote control device
[0351] 113 Display device
[0352] 150 Operation path generation device (driving area determination device)
[0353] 309 memory (storage unit)
[0354] H Field (driving area)
[0355] HA operation area (first area)
[0356] HB Land (Second Area)
[0357] Ra operation path
[0358] Rb driving path
[0359] Gw Job end position
[0360] Gr Travel end position
[0361] Z Current position (of autonomous working vehicles)
[0362] V Driving position (of a moving work vehicle)
[0363] θ Azimuth (of the vehicle body)
[0364] HK Field Shape
[0365] J Driving trajectory
[0366] JA driving track area
Claims
1. A driving area determination device, It is characterized in that have: a position information acquisition unit, the position information acquisition unit being capable of acquiring position information of the vehicle body; a driving track area determination unit capable of determining a driving track area of the vehicle body based on a driving track of the vehicle body determined using the position information; a driving area determination unit capable of determining a driving area for the vehicle body to travel based on a plurality of selected points selected from the driving trajectory; as well as a notification department, which is able to carry out prescribed notifications, The predetermined notification is a notification suggesting that the driving area includes an area other than the driving track area.
2. A driving area determination device, It is characterized in that have: a position information acquisition unit, the position information acquisition unit being capable of acquiring position information of the vehicle body; a driving track area determination unit capable of determining a driving track area of the vehicle body based on a driving track of the vehicle body determined using the position information; a driving area determination unit capable of determining a driving area for the vehicle body to travel based on a plurality of selected points selected from the driving trajectory; as well as a correction unit capable of correcting the driving area, When the traveling area includes an area other than the traveling track area, the correction unit corrects the traveling area to an area not including the area other than the traveling track area.
3. The driving area determination device according to claim 1 or 2, It is characterized in that The traveling area identification device includes a determination unit configured to determine that the traveling area includes an area outside the traveling track area when a specified point on the traveling area is outside the traveling track area.
4. The driving area determination device according to claim 1 or 2, It is characterized in that The traveling area identification device includes a determination unit configured to determine that the traveling area includes an area other than the traveling track area when an area of the traveling area is larger than an area of the traveling track area.
