WO2017195510A1 - 自律走行経路生成システム - Google Patents
自律走行経路生成システム Download PDFInfo
- Publication number
- WO2017195510A1 WO2017195510A1 PCT/JP2017/014436 JP2017014436W WO2017195510A1 WO 2017195510 A1 WO2017195510 A1 WO 2017195510A1 JP 2017014436 W JP2017014436 W JP 2017014436W WO 2017195510 A1 WO2017195510 A1 WO 2017195510A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- work
- travel
- route
- travel route
- path
- Prior art date
Links
- 230000002093 peripheral effect Effects 0.000 claims description 49
- 238000004891 communication Methods 0.000 description 165
- 238000012937 correction Methods 0.000 description 153
- 238000000034 method Methods 0.000 description 63
- 230000008569 process Effects 0.000 description 49
- 238000003860 storage Methods 0.000 description 34
- 238000004364 calculation method Methods 0.000 description 33
- 238000010586 diagram Methods 0.000 description 29
- 238000012545 processing Methods 0.000 description 24
- 230000005540 biological transmission Effects 0.000 description 19
- 230000008859 change Effects 0.000 description 18
- 230000037303 wrinkles Effects 0.000 description 15
- 238000004519 manufacturing process Methods 0.000 description 6
- 230000000694 effects Effects 0.000 description 4
- 230000003028 elevating effect Effects 0.000 description 4
- 230000007246 mechanism Effects 0.000 description 4
- 230000007704 transition Effects 0.000 description 4
- 238000001514 detection method Methods 0.000 description 3
- 238000006073 displacement reaction Methods 0.000 description 3
- 210000000744 eyelid Anatomy 0.000 description 3
- 238000009313 farming Methods 0.000 description 3
- 238000005259 measurement Methods 0.000 description 3
- 239000002689 soil Substances 0.000 description 3
- 230000003068 static effect Effects 0.000 description 3
- 239000004575 stone Substances 0.000 description 3
- 238000012546 transfer Methods 0.000 description 3
- 238000013459 approach Methods 0.000 description 2
- 230000015572 biosynthetic process Effects 0.000 description 2
- 238000012790 confirmation Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 238000005192 partition Methods 0.000 description 2
- 230000002250 progressing effect Effects 0.000 description 2
- 238000009333 weeding Methods 0.000 description 2
- 241001465754 Metazoa Species 0.000 description 1
- 240000007594 Oryza sativa Species 0.000 description 1
- 235000007164 Oryza sativa Nutrition 0.000 description 1
- 230000003416 augmentation Effects 0.000 description 1
- 239000003337 fertilizer Substances 0.000 description 1
- 239000002828 fuel tank Substances 0.000 description 1
- 239000003502 gasoline Substances 0.000 description 1
- 238000010191 image analysis Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000002955 isolation Methods 0.000 description 1
- 238000010295 mobile communication Methods 0.000 description 1
- 238000010899 nucleation Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 235000009566 rice Nutrition 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 230000007306 turnover Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0219—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
- G05D1/0253—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means extracting relative motion information from a plurality of images taken successively, e.g. visual odometry, optical flow
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
Definitions
- the present invention relates to an autonomous traveling route generation system that generates a traveling route for autonomously traveling a work vehicle.
- Patent document 1 discloses this kind of autonomous traveling system.
- the agricultural work vehicle disclosed in Patent Document 1 receives radio waves transmitted from a GPS satellite, obtains position information of the body at a set time interval in a mobile communication device, and detects displacement information of the body from a gyro sensor and a direction sensor.
- Steering actuator, speed change means, elevating actuator, PTO on / off means, engine controller, etc. so that the aircraft travels along a preset route based on the position information, displacement information and direction information.
- a control device as an automatic traveling means for automatically operating while controlling the vehicle.
- Patent Document 1 When an agricultural work vehicle performs an operation while autonomously running in a farm field, as disclosed in Patent Document 1, a plurality of linear work paths arranged at equal intervals are arranged from one end in the arrangement direction. It is widely performed to run and work one by one up to the other end. At this time, the agricultural work vehicle completes the work on a certain work route, then turns back at the edge of the farm field to reverse the traveling direction, and works on the work route adjacent to the work route.
- the turn may involve turning back and forth due to circumstances such as the minimum turning radius of the work vehicle at the time of turning back, and the efficiency may be lowered. Therefore, it is conceivable that the agricultural work vehicle travels so as to work on a work route that has been skipped by about one or two after completing a work route, instead of a work route adjacent to the work route ( Skip driving).
- a traveling route of the agricultural work vehicle in this case, for example, with respect to a plurality of arranged working routes, it travels from one end of the arranged direction to one end of the working route and reaches the other end, After that, the vehicle is generated so as to return to the one side while traveling on the remaining work route (by skipping the already-worked work route).
- the configuration in which the agricultural work vehicle autonomously travels as described above exhibits an effect such as labor saving particularly when the farm field is very large.
- the interruption of the work as described above must be taken into consideration, and there remains room for improvement.
- the present invention has been made in view of the above circumstances, and the potential purpose thereof is that when the work is skipped, even if the work is interrupted in the middle, the already worked place and the unworked place It is an object of the present invention to provide an autonomous traveling route generation system capable of preventing a portion where the alternating current appears alternately in a wide range.
- an autonomous travel route generation system having the following configuration. That is, this autonomous travel route generation system generates a travel route for autonomously traveling a work vehicle in order to perform work on a predetermined work area.
- the autonomous traveling route generation system includes an area dividing unit and a route generating unit.
- the area dividing unit divides the work area into a plurality of sections.
- the route generation unit generates the travel route so as to include a plurality of travel routes arranged in each of the sections divided by the region dividing unit.
- the area dividing unit can divide the work area so that the number of the traveling roads included in each section has a predetermined value equal to each other.
- the autonomous traveling route generation system has the following configuration. That is, the route generation unit sets an operation order based on a reference value for the plurality of travel routes. When there are a plurality of sections in which the number of travel paths included is equal to the predetermined value, the route generation unit sets the same work order for the travel paths corresponding to each other between the sections. To do.
- the autonomous traveling route generation system has the following configuration. That is, the area dividing unit includes a plurality of the work areas so as to form a first section and a second section when the number of the traveling paths included in the work area is not an integer multiple of the predetermined value. Divide into sections. The number of the travel paths included in the first section is equal to the predetermined value. The number of travel paths included in the second section is greater than the predetermined value.
- an autonomous travel route generation system having the following configuration. That is, the autonomous travel route generation system includes a travel direction setting unit and an obstacle outer periphery setting unit.
- the travel direction setting unit sets a travel direction of the work vehicle in the travel area.
- the obstacle outer periphery setting unit sets an obstacle outer periphery region for the obstacle in the traveling region.
- the route generation unit can generate the travel route including a plurality of the travel routes provided along the travel direction set by the travel direction setting unit in the travel region.
- the route generation unit can generate the travel route so as to include a first travel route, a detour, and a second travel route.
- the first travel path is disposed along the travel direction.
- the detour extends from the end point of the first traveling path to the opposite side of the obstacle while passing through the obstacle outer peripheral region and extends the first traveling path so as to penetrate the obstacle. It reaches the position on the virtual extension line.
- the second traveling path is arranged on the virtual extension line starting from the end point of the detour.
- a travel route including the first travel route, the detour, and the second travel route is generated. Therefore, by making the work vehicle autonomously travel along this travel route, the work vehicle can travel so as to bypass the obstacle. Moreover, since the detour is arranged so as to pass through the obstacle outer peripheral area set in advance, the detour is systematically generated in consideration of the relationship with the entire travel route, etc. Can be made smooth. Further, in a portion other than the detour, the traveling route can be a route along the traveling direction, and the algorithm for generating the autonomous traveling route can be simplified.
- the autonomous traveling route generation system has the following configuration. That is, the route generation unit may generate the travel route so as to include the first travel route, the detour route, and the second travel route when the route length of the bypass route is less than a predetermined distance. Is possible.
- the route generation unit can generate the travel route so as to include the first travel route, the return route, and the third travel route when the length of the bypass route is equal to or longer than a predetermined distance. is there.
- the return path starts from the end point of the first travel path, and returns before the obstacle while passing through the obstacle outer peripheral area.
- the third travel path is arranged in parallel with the first travel path, starting from the end point of the turnback path.
- the autonomous traveling route generation system has the following configuration. That is, the route generation unit is configured such that when the work vehicle has an avoidance distance that is a distance that must move in a direction perpendicular to the traveling direction in order to avoid the obstacle, the first generation is less than a predetermined distance. It is possible to generate the travel route so as to include a travel route, the bypass route, and the second travel route. On the other hand, when the avoidance distance is a predetermined distance or more, the route generation unit can generate a travel route so as to include the first travel route, the turnback route, and the third travel route. The return path starts from the end point of the first travel path, and returns before the obstacle while passing through the obstacle outer peripheral area. The third travel path is arranged in parallel with the first travel path, starting from the end point of the turnback path.
- the route is turned before the obstacle instead of the route that detours the obstacle.
- a route can be generated as a travel route. Therefore, it is possible to prevent the portion of the travel route that does not contribute to work from becoming excessively long.
- the autonomous traveling route generation system has the following configuration. That is, the route generation unit generates the travel route so as to include the first travel route, the detour route, and the second travel route when the number of turns or the turn angle in the bypass route is less than a predetermined value. It is possible. On the other hand, the route generation unit generates the travel route so as to include the first travel route, the turnback route, and the third travel route when the number of turns or the turn angle in the detour is greater than or equal to a predetermined value. It is possible.
- the return path starts from the end point of the first travel path, and returns before the obstacle while passing through the obstacle outer peripheral area.
- the third travel path is arranged in parallel with the first travel path, starting from the end point of the turnback path.
- the route generation unit when the obstacle is arranged in an island shape in the travel region, the travel route from the detour to the first travel route. It is preferable to generate so as to turn from the side far from the side to the opposite side of the obstacle.
- the vehicle does not step into the region where the work vehicle has traveled before reaching the first travel path when detouring the obstacle. Therefore, the work vehicle can be run while avoiding obstacles so that the work performed on the work vehicle is not affected.
- an autonomous travel route generation system having the following configuration. That is, this autonomous travel route generation system includes a route generation unit, a storage unit, an external environment information acquisition unit, a correction information calculation unit, and a correction route generation unit.
- the route generation unit generates the travel route.
- the storage unit stores the travel route generated by the route generation unit.
- the external environment information acquisition unit is provided in the work vehicle and acquires external environment information in the travel area.
- the correction information calculation unit calculates correction information for correcting the travel route based on the external environment information acquired by the external environment information acquisition unit.
- the correction route generation unit generates a correction route in which the travel route is corrected based on the correction information calculated by the correction information calculation unit, and stores the correction route in the storage unit.
- the travel route is corrected based on the external environment information acquired by the external environment information acquisition unit provided in the work vehicle. Therefore, the travel route generated in advance can be corrected based on the current environment or the like. In addition, by storing the correction route in the storage unit, it is possible to eliminate the trouble of correcting the travel route after the next time.
- the autonomous traveling route generation system has the following configuration. That is, the autonomous travel route generation system includes a position information calculation unit that calculates the absolute position of the work vehicle.
- the correction information calculation unit includes a position of the work vehicle calculated by the position information calculation unit, and a position of the specification target when the specific target specified by the external environment information obstructs work by the work vehicle. The correction information is calculated based on.
- the autonomous traveling route generation system has the following configuration. That is, the autonomous travel route generation system includes a position information calculation unit that calculates the absolute position of the work vehicle. When the position of the specific target specified by the external environment information differs from the position registered in advance in the storage unit by a threshold or when the specific target is not registered in the storage unit The correction information is calculated based on the position of the work vehicle calculated by the position information calculation unit and the position of the specific target.
- an autonomous travel route generation system having the following configuration. That is, a travel route for autonomously traveling a work vehicle including a vehicle body portion and a work implement attached to the vehicle body portion in a predetermined travel region is generated.
- This autonomous travel route generation system includes an offset setting unit and a route generation unit.
- the offset setting unit can set an offset direction and an offset distance of a reference point of the work implement with respect to a reference point of the vehicle body part.
- the route generation unit can generate the travel route in the travel region based on a reference point of the work implement.
- the autonomous traveling route generation system has the following configuration.
- the traveling area includes a first area where work is performed by the work implement, and a second area set around the first area.
- the route generation unit generates the travel route in the first region based on a reference point of the work implement, and generates the travel route in the second region based on a reference point of the vehicle body unit.
- the work machine is offset in the left-right direction with respect to the traveling machine body in the work area. Even in this case, it is possible to simplify the generation process of the autonomous traveling route in both the work area and the non-work area.
- the autonomous traveling route generation system has the following configuration. That is, the autonomous travel route generation system includes a start / end position setting unit that sets a start position and an end position of work performed by the work vehicle in the travel area. When both the start position and the end position are set at the end of the travel region by the start / end position setting unit, the route generation unit, as the travel route, includes an edge and an edge of the travel region. A return travel route from the start position to the end position is generated while repeating the return. When one of the start position and the end position is set at the end of the travel area and the other is set at the center of the travel area by the start / end position setting section, the route generation section As described above, a spiral traveling route from the start position to the end position is generated.
- the work efficiency can be improved because it can be appropriately selected and generated from the two types of autonomous driving routes according to the work content.
- the conceptual diagram which shows a mode that a robot tractor performs autonomous driving
- the side view which shows the whole structure of the robot tractor which drive
- generation system are provided.
- the block diagram which shows the main structures of the electric system of the robot tractor and radio
- the figure which shows a mode that the work order of the work route was determined.
- the block diagram which shows the main structures of the electric system of the robot tractor and radio
- the flowchart which shows the process performed in a route production
- the flowchart which shows the continuation of the process of FIG.
- the block diagram which shows the main structures of the electric system of the robot tractor and radio
- the flowchart which shows the process which detects a wrinkle and produces
- running route memorize
- the flowchart which shows the process which detects an obstruction and produces
- the present disclosure provides a travel route for autonomously traveling a work vehicle when one or a plurality of work vehicles are traveled in a predetermined field and all or part of the farm work is performed in the field.
- the present invention relates to an autonomous travel route generation system to be generated.
- a tractor will be described as an example of a work vehicle.
- a walk-type work machine in addition to a riding work machine such as a rice transplanter, a combiner, a civil engineering / architecture work device, a snowplow, etc.
- autonomous traveling means that the configuration related to traveling provided by the tractor is controlled by the control unit (ECU) of the tractor, and the tractor travels along a predetermined route.
- ECU control unit
- manual travel / manual work means that each component included in the tractor is operated by an operator to perform travel / work.
- a tractor that autonomously travels and works autonomously may be referred to as an “unmanned tractor” or a “robot tractor”, and a tractor that travels manually and is manually operated is referred to as a “manned tractor”.
- an unmanned tractor or a “robot tractor”
- a tractor that travels manually and is manually operated is referred to as a “manned tractor”.
- manned tractor Sometimes.
- Performing farm work in a single farm with unmanned tractors and manned tractors may be referred to as cooperative work of farm work, follow-up work, accompanying work, and the like.
- the unmanned tractor and the manned tractor may have different configurations or may have a common configuration.
- an unmanned tractor can be operated (boarded) by an operator (that can be used as a manned tractor), or Even in such a case, it is possible for the operator to get off and run autonomously and work (that is, it can be used as an unmanned tractor).
- “agricultural work in different fields such as adjacent fields is performed simultaneously with unmanned vehicles and manned vehicles. To do "may be included.
- FIG. 1 is a conceptual diagram showing a state in which the robot tractor 1 performs autonomous traveling / autonomous work along an autonomous traveling route 93 generated in the farm field 90.
- FIG. 2 is a side view illustrating an overall configuration of the robot tractor 1 that travels along the autonomous traveling route 93 generated by the autonomous traveling route generation system 99 according to the first embodiment of the present disclosure.
- FIG. 3 is a plan view of the robot tractor 1.
- FIG. 4 is a diagram showing a wireless communication terminal 46 provided with the main configuration of the autonomous travel route generation system 99.
- FIG. 5 is a block diagram showing the main configuration of the electrical system of the robot tractor 1 and the wireless communication terminal 46.
- the autonomous traveling route generation system 99 generates an autonomous traveling route 93 for the robot tractor 1 to perform autonomous traveling and autonomous work in an agricultural field 90 as shown in FIG.
- the wireless communication terminal 46 shown in FIG. the robot tractor 1 includes a control unit 4 that controls the traveling and work of the robot tractor 1, and the wireless communication terminal 46 communicates with the control unit 4 by wireless communication.
- a predetermined signal related to autonomous traveling / autonomous work can be output to the tractor 1. Examples of signals output from the wireless communication terminal 46 to the control unit 4 include signals related to autonomous traveling / autonomous work routes, autonomous traveling / autonomous work start signals, stop signals, and end signals, but are not limited thereto.
- tractor 1 a robot tractor (hereinafter sometimes simply referred to as “tractor”) 1 will be described mainly with reference to FIGS.
- the tractor 1 includes a traveling machine body (body portion) 2 that can autonomously travel on the farm field 90.
- the working machine 3 shown in FIGS. 2 and 3 is detachably attached to the traveling machine body 2.
- Examples of the work machine 3 include various work machines such as a tiller (management machine), a plow, a fertilizer machine, a mowing machine, and a seeding machine, and a desired work machine 3 is selected from these as required. And can be attached to the traveling machine body 2.
- the traveling machine body 2 is configured to be able to change the height and posture of the attached work machine 3.
- the traveling machine body 2 of the tractor 1 has a front portion supported by a pair of left and right front wheels 7 and 7 and a rear portion supported by a pair of left and right rear wheels 8 and 8.
- a bonnet 9 is arranged at the front of the traveling machine body 2.
- the bonnet 9 accommodates an engine 10 that is a driving source of the tractor 1, a fuel tank (not shown), and the like.
- this engine 10 can be comprised, for example with a diesel engine, it is not restricted to this, For example, you may comprise with a gasoline engine. Further, an electric motor may be employed in addition to or instead of the engine 10 as a drive source.
- a cabin 11 for an operator to board is disposed behind the bonnet 9. Inside the cabin 11, there are mainly provided a steering handle 12 for an operator to steer, a seat 13 on which an operator can be seated, and various operating devices for performing various operations.
- the work vehicle is not limited to the one with the cabin 11 and may be one without the cabin 11.
- the monitor device 14 shown in FIG. 3 the throttle lever 15, the main transmission lever 27, the plurality of hydraulic operation levers 16, the PTO switch 17, the PTO transmission lever 18, the auxiliary transmission lever 19, and the work equipment lift switch 28 etc. can be mentioned as an example.
- These operating devices are arranged in the vicinity of the seat 13 or in the vicinity of the steering handle 12.
- the monitor device 14 is configured to display various information of the tractor 1.
- the throttle lever 15 is an operating tool for setting the output rotational speed of the engine 10.
- the main transmission lever 27 is an operating tool for changing the traveling speed of the tractor 1 in a stepless manner.
- the hydraulic operation lever 16 is an operation tool for switching and operating a hydraulic external take-off valve (not shown).
- the PTO switch 17 is an operating tool for switching the transmission / cutoff of power to a PTO shaft (power take-off shaft) (not shown) protruding from the rear end of the transmission 22.
- the PTO speed change lever 18 is used to change the power input to the work machine 3, and specifically, is an operating tool for changing speed of the rotational speed of the PTO shaft.
- the auxiliary transmission lever 19 is an operating tool for switching the gear ratio of the traveling auxiliary transmission gear mechanism in the transmission 22.
- the work implement raising / lowering switch 28 is an operating tool for raising and lowering the height of the work implement 3 attached to the traveling machine body 2 within a predetermined range.
- a chassis 20 of the tractor 1 is provided at the lower part of the traveling machine body 2.
- the chassis 20 includes a body frame 21, a transmission 22, a front axle 23, a rear axle 24, and the like.
- the fuselage frame 21 is a support member at the front portion of the tractor 1 and supports the engine 10 directly or via a vibration isolation member.
- the transmission 22 changes the power from the engine 10 and transmits it to the front axle 23 and the rear axle 24.
- the front axle 23 is configured to transmit the power input from the transmission 22 to the front wheels 7.
- the rear axle 24 is configured to transmit the power input from the transmission 22 to the rear wheel 8.
- the tractor 1 includes a control unit 4 for controlling the operation of the traveling machine body 2 (forward, reverse, stop, turn, etc.) and the operation of the work machine 3 (elevation, drive, stop, etc.).
- the control unit 4 includes a CPU, a ROM, a RAM, an I / O, and the like (not shown), and the CPU can read various programs from the ROM and execute them.
- the controller 4 is electrically connected to a controller for controlling each component (for example, the engine 10 and the like) included in the tractor 1 and a wireless communication unit 40 that can wirelessly communicate with other wireless communication devices. ing.
- the tractor 1 includes at least an engine controller 61, a vehicle speed controller 62, a steering controller 63, and a lift controller 64. Each controller can control each component of the tractor 1 in accordance with an electrical signal from the control unit 4.
- the engine controller 61 controls the rotational speed of the engine 10. Specifically, the engine 10 is provided with a governor device 41 including an unillustrated actuator that changes the rotational speed of the engine 10. The engine controller 61 can control the rotational speed of the engine 10 by controlling the governor device 41.
- the vehicle speed controller 62 controls the vehicle speed of the tractor 1.
- the transmission 22 is provided with a transmission 42 which is, for example, a movable swash plate type hydraulic continuously variable transmission.
- the vehicle speed controller 62 can change the gear ratio of the transmission 22 and realize a desired vehicle speed by changing the angle of the swash plate of the transmission 42 by an actuator (not shown).
- the steering controller 63 controls the rotation angle of the steering handle 12. Specifically, a steering actuator 43 is provided in the middle of the rotating shaft (steering shaft) of the steering handle 12. With this configuration, when the tractor 1 travels (as an unmanned tractor) on a predetermined route, the control unit 4 calculates an appropriate rotation angle of the steering handle 12 so that the tractor 1 travels along the route. Then, a control signal is output to the steering controller 63 so that the obtained rotation angle is obtained. The steering controller 63 drives the steering actuator 43 based on the control signal input from the control unit 4 and controls the rotation angle of the steering handle 12.
- the elevation controller 64 controls the elevation of the work implement 3.
- the tractor 1 includes an elevating actuator 44 composed of a hydraulic cylinder or the like in the vicinity of a three-point link mechanism that connects the work machine 3 to the traveling machine body 2.
- the elevating controller 64 drives the elevating actuator 44 based on the control signal input from the control unit 4 to appropriately elevate the work implement 3 so that the work implement 3 can perform farm work at a desired height. It can be performed.
- the work machine 3 can be supported at a desired height such as a retreat height (a height at which farm work is not performed) and a work height (a height at which farm work is performed).
- a plurality of controllers such as the engine controller 61 described above controls each unit such as the engine 10 based on a signal input from the control unit 4. Therefore, it can be grasped that the control unit 4 substantially controls each unit.
- the tractor 1 including the control unit 4 as described above controls various parts of the tractor 1 (the traveling machine body 2, the work implement 3, and the like) by the control unit 4 when the operator gets into the cabin 11 and performs various operations.
- the farm work can be performed while traveling in the farm field 90.
- the tractor 1 according to the present embodiment can autonomously travel and work based on a predetermined control signal output from the wireless communication terminal 46 without the operator getting on the tractor 1. .
- the tractor 1 has various configurations for enabling autonomous traveling and autonomous work.
- the tractor 1 has a configuration such as a positioning antenna 6 necessary for acquiring position information of itself (the traveling machine body 2) based on the positioning system.
- the tractor 1 can acquire its own position information based on the positioning system and can autonomously travel on the agricultural field 90.
- the tractor 1 of the present embodiment includes a positioning antenna 6, a radio communication antenna 48, a storage unit 55, and the like.
- the tractor 1 may be provided with an inertial measurement unit (IMU) that can specify the posture (roll angle, pitch angle, yaw angle) of the traveling machine body 2.
- IMU inertial measurement unit
- the positioning antenna 6 receives a signal from a positioning satellite constituting a positioning system such as a satellite positioning system (GNSS). As shown in FIG. 2, the positioning antenna 6 is disposed on the upper surface of the roof 29 of the cabin 11 of the tractor 1.
- the positioning signal received by the positioning antenna 6 is input to the position information calculation unit 49 shown in FIG.
- the position information calculation unit 49 calculates the position information of the traveling machine body 2 (strictly speaking, the positioning antenna 6) of the tractor 1 as, for example, latitude / longitude information.
- the position information detected by the position information calculation unit 49 is input to the control unit 4 and used for autonomous traveling.
- a high-accuracy satellite positioning system using the GNSS-RTK method is used.
- the present invention is not limited to this, and other positioning systems can be used as long as high-precision position coordinates can be obtained. May be.
- DGPS relative positioning method
- SBAS geostationary satellite type satellite navigation augmentation system
- the wireless communication antenna 48 receives a signal from the wireless communication terminal 46 operated by the operator or transmits a signal to the wireless communication terminal 46. As shown in FIG. 1, the radio communication antenna 48 is disposed on the upper surface of the roof 29 provided in the cabin 11 of the tractor 1. A signal from the wireless communication terminal 46 received by the wireless communication antenna 48 is subjected to signal processing by the wireless communication unit 40 shown in FIG. A signal transmitted from the control unit 4 or the like to the wireless communication terminal 46 is subjected to signal processing by the wireless communication unit 40, then transmitted from the wireless communication antenna 48 and received by the wireless communication terminal 46.
- the storage unit 55 stores a travel route (path) that is a route for causing the tractor 1 to autonomously travel, and stores a transition (travel locus) of the position of the traveling tractor 1 (strictly speaking, the positioning antenna 6). Can be. In addition, the storage unit 55 stores various information necessary for the tractor 1 to autonomously travel and work.
- the storage unit 55 is, for example, a non-volatile memory such as a flash memory (flash disk and memory card), a hard disk, or an optical disk.
- the wireless communication terminal 46 is configured as a tablet personal computer as shown in FIGS.
- the operator can check the information by referring to the information displayed on the display 37 of the wireless communication terminal 46. Further, the operator operates the hardware key 38 disposed in the vicinity of the display 37 and a touch panel (not shown) disposed so as to cover the display 37 to control the tractor 1 with the control unit 4 of the tractor 1.
- a control signal (for example, an emergency stop signal) can be transmitted.
- the wireless communication terminal 46 is not limited to a tablet-type personal computer, but can be configured by, for example, a notebook-type personal computer.
- the monitor device mounted on the manned tractor can be a wireless communication terminal.
- the tractor 1 configured as described above can perform farm work by the work implement 3 while traveling autonomously along a route on the field based on an instruction from an operator using the wireless communication terminal 46.
- the operator can form the autonomous traveling route 93 shown in FIG. 1 and the like by making various settings using the wireless communication terminal 46.
- the autonomous traveling path 93 is configured as a series of paths in which a linear or broken line working path 93A for performing farm work and an arc-shaped non-working path 93B that connects the ends of the working path 93A are alternately connected.
- the information on the autonomous traveling route 93 generated as described above on the wireless communication terminal 46 side is input (transferred) to the storage unit 55 electrically connected to the control unit 4 of the tractor 1 to perform a predetermined operation.
- the tractor 1 can be controlled by the control unit 4 to allow the tractor 1 to perform autonomous traveling and autonomous work along the autonomous traveling route 93.
- the wireless communication terminal 46 includes a control unit 71, a display (display unit) 37, a communication unit 72, a work vehicle information setting unit 51, an agricultural field information setting unit 52, and a work information setting unit. 53, a work area dividing unit (area dividing unit) 54, and an autonomous traveling route generating unit (route generating unit) 47.
- the control unit 71 of the wireless communication terminal 46 is configured as a computer including a CPU, ROM, RAM, I / O, etc. (not shown). Various programs can be read from the ROM and executed. The ROM stores an appropriate program for causing the tractor 1 to perform autonomous traveling and autonomous work. And by cooperation of above-mentioned software and hardware, the wireless communication terminal 46 is changed into the communication part 72, the work vehicle information setting part 51, the farm field information setting part 52, the work information setting part 53, the work area
- the communication unit 72 is for performing communication with the tractor 1 side.
- the control unit 71 of the wireless communication terminal 46 communicates with the control unit 4 of the tractor 1 through the communication unit 72, thereby transmitting the information on the autonomous travel route 93 generated by the autonomous travel route generation unit 47 to the tractor 1 side. it can.
- the control unit 71 of the wireless communication terminal 46 can instruct the tractor 1 to start and stop autonomous traveling by transmitting a control signal to the tractor 1 side using the communication unit 72.
- the control unit 71 of the wireless communication terminal 46 can receive the state (position, travel speed, etc.) of the tractor 1 from the tractor 1 side and display it on the display 37. .
- the work vehicle information setting unit 51 is for setting information related to the tractor 1 (hereinafter sometimes referred to as work vehicle information).
- the work vehicle information setting unit 51 includes the model of the tractor 1, the size of the tractor 1, the position where the positioning antenna 6 is attached to the tractor 1, the type of the work machine 3, the size and shape of the work machine 3, and the work machine 3
- the contents designated by the operator by appropriately operating the wireless communication terminal 46 can be stored.
- the farm field information setting unit 52 is for setting information related to the farm field 90 (hereinafter sometimes referred to as farm field information).
- the farm field information setting unit 52 stores the contents designated by the operator operating the wireless communication terminal 46 regarding the position and shape of the farm field 90, the start position and the end position to be autonomously run, the work area, the work direction, and the like. Can do.
- the work direction refers to a work area 91 that is an area excluding a non-work area 92 (such as a headland and a non-cultivated land) from the farm field 90 while performing work on the work machine 3. It means the direction in which the tractor 1 travels.
- the operator rides on the tractor 1 and operates so as to make one turn along the outer circumference of the farm field, and records the transition of the position information of the positioning antenna 6 at that time. Can be obtained automatically.
- the position and shape of the farm field 90 are based on a polygon obtained by the operator operating the wireless communication terminal 46 while designating a map on the display 37 and specifying a plurality of points on the map. It can also be acquired.
- the work information setting unit 53 is for setting information relating to how the work is specifically performed (hereinafter sometimes referred to as work information).
- the work information setting unit 53 includes, as work information, the presence / absence of cooperative work between the robot tractor 1 and the manned tractor, the number of skips (reference value) that is the number of work paths 93A to be skipped when the tractor 1 turns on the headland, The width of the headland and the width of the non-cultivated land can be set.
- the work area dividing unit 54 is configured to divide the work area 91 into a plurality of sections S as shown in FIG. 12 and the like when the autonomous traveling route 93 with skip traveling is generated in the autonomous traveling route generating unit 47. Is.
- the section S generated by this division is a unit of work for performing skip traveling. Details of the division of the work area 91 will be described later.
- the autonomous traveling route generation unit 47 generates and stores the autonomous traveling route 93 of the tractor 1 based on the information set by the work vehicle information setting unit 51, the farm field information setting unit 52, and the work information setting unit 53. Can do.
- the autonomous traveling route 93 includes a work route 93 ⁇ / b> A arranged in the work region 91 and a non-work route 93 ⁇ / b> B arranged in the non-work region 92.
- the autonomous traveling route generation unit 47 generates the autonomous traveling route 93, the work width of the work implement 3 and the work width of the work implement 3 partially overlap between the work routes 93A adjacent to each other in the work area 91.
- the upper limit value of the overlapping width the size and shape of the non-working area 92 (in other words, the width of the headland and the width of the non-cultivated land), and the non-working path when the tractor 1 is in the headland
- the number of work paths 93A skip number to be skipped when turning in 93B is taken into consideration.
- the positional relationship between the unmanned tractor 1 and the manned tractor, the work width of the work machine of the manned tractor, and the like are taken into consideration in the generation process of the autonomous traveling route 93. .
- FIG. 6 is a diagram illustrating a display example of the work vehicle information input screen 81 displayed on the wireless communication terminal 46.
- FIG. 7 is a diagram illustrating a display example of the field information input screen 82 displayed on the wireless communication terminal 46.
- FIG. 8 is a diagram illustrating a display example of the work information input screen 83 displayed on the wireless communication terminal 46.
- control unit 71 controls the display 37 to display the work vehicle information input screen 81 shown in FIG.
- the work vehicle information input screen 81 information (the work vehicle information) regarding the traveling machine body 2 and the work machine 3 attached to the traveling machine body 2 can be input.
- the work vehicle information input screen 81 includes the model of the tractor 1, the size of the tractor 1, the mounting position of the positioning antenna 6 with respect to the traveling machine body 2, the type of the work machine 3, and the work width W of the work machine 3. Fields for inputting the distance from the rear end of the three-point link mechanism (the rear end of the lower link) to the rear end of the work machine 3 are arranged.
- the operator performs settings by operating the wireless communication terminal 46 and inputting a numerical value in a text box arranged in each column of the work vehicle information input screen 81 or selecting from a drop-down box list. . Thereby, various information regarding the traveling machine body 2 and the work machine 3 can be set.
- Work vehicle information specified by the operator on the work vehicle information input screen 81 is stored in the work vehicle information setting unit 51.
- the control unit 71 controls the display 37 to display the farm field information input screen 82 as shown in FIG.
- the farm field information input screen 82 information regarding the farm field 90 on which the traveling machine body 2 travels (the farm field information) can be input. Specifically, on the farm field information input screen 82, a plane display unit 88 that graphically indicates the position and shape of the farm field 90 and the start and end positions of autonomous traveling is arranged. Further, on the farm field information input screen 82, “designation” and “reset” buttons are arranged for the outer periphery of the farm field 90, the autonomous running start position, the autonomous running end position, and the work direction, respectively.
- buttons on the field information input screen 82 and the like are all configured as virtual buttons displayed on the display 37, and the operator touches the position of the touch panel corresponding to the display area of the buttons with a finger. Can do.
- the wireless communication terminal 46 switches to the field shape recording mode.
- this field shape recording mode when the operator gets on and operates the tractor 1 and makes one turn along the outer periphery of the field 90, the position of the field 90 is determined based on the transition of the position information of the positioning antenna 6 at that time. And the shape is acquired (calculated). Thereby, the position and shape of the agricultural field 90 can be designated.
- the control unit 71 of the wireless communication terminal 46 graphically displays the obtained position and shape of the farm field 90 on the plane display unit 88 of the farm field information input screen 82 as shown in FIG.
- the contents designated so far can be discarded by operating the “reset” button, and the “designation” button can be operated again.
- a map is displayed on the display 37 of the wireless communication terminal 46, and the map is displayed on the map.
- the position and shape of the polygon identified by the so-called closed graph can be designated as the position and shape of the field 90 so that the lines connecting the designated points do not intersect.
- the farm field information specified by the operator on the farm field information input screen 82 is stored in the farm field information setting unit 52.
- the control unit 71 controls the display 37 to display a work information input screen 83 as shown in FIG.
- the work information input screen 83 specific work information (the work information) can be input.
- the work information input screen 83 includes the presence / absence of cooperative work between the robot tractor 1 and the manned tractor, the pattern when the manned tractor cooperates, and the manned tractor when the manned tractor cooperates. Columns for inputting the work width, the number of skips of the robot tractor 1, the work width overlap allowable amount in the adjacent work path 93A, the headland width, the width of the non-cultivated land, and the like.
- the robot tractor 1 is autonomously run to perform farming work (without accompanying manned tractors), or the autonomously running robot tractor 1 and the manned tractor (operator It is possible to select whether to perform farming work (with accompanying tractor) by accompanying the tractor (boarding tractor).
- a drop-down list box is arranged, and a list of numerical values that can be set as the skip count is displayed by drop-down operation.
- the operator can designate one of the work routes 93A by skipping the work route 93A by selecting one from the list.
- the skip number SN can be set by selecting one of 0, 1, or 2. If skipping is not desired, zero may be selected as the skip number SN.
- headland width for example, a value equal to or larger than the lower limit of the headland width calculated in advance based on the size of the work implement 3 attached to the unmanned tractor 1 is set. be able to.
- an appropriate value can be set in consideration of working while rotating around the outer periphery of the field 90 by manual travel after the end of autonomous travel.
- the autonomous travel route generation unit 47 When the operator inputs all the input fields of the work information input screen 83 and operates the “Generate Autonomous Travel Route” button, the autonomous travel route generation unit 47 generates the autonomous travel route 93 and the autonomous travel route 93 Is stored in the work area dividing unit 54. The generated autonomous traveling route 93 is appropriately displayed on the display 37 for confirmation, and the autonomous traveling route 93 can be confirmed by the operator operating the “OK” button (not shown).
- the control unit 71 controls the display 37 to display a route data transfer screen (not shown). On this route data transfer screen, the operator can transfer the data of the autonomous traveling route 93 generated by the autonomous traveling route generation unit 47 to the tractor 1 side by radio, for example, and store the data in the storage unit 55 provided in the tractor 1. .
- the operator can instruct the tractor 1 to start autonomous traveling by appropriately operating the wireless communication terminal 46.
- the tractor 1 autonomously travels according to the autonomous traveling route 93 transmitted from the wireless communication terminal 46 to the tractor 1 and performs autonomous work.
- FIG. 9 is a flowchart illustrating processing performed by the autonomous traveling route generation unit 47 when the autonomous traveling route generation unit 47 is generated.
- FIG. 10 is a diagram illustrating a state in which a plurality of work routes 93 ⁇ / b> A are arranged in the work area 91 in order to generate an autonomous travel route 93 that performs skip travel.
- FIG. 11 is a diagram illustrating a group including a specific number of work paths 93A, which is a unit of work when skipping travel is performed.
- FIG. 12 is a diagram illustrating a state in which the work area 91 is divided and a plurality of sections S are generated.
- FIG. 13 is a diagram illustrating a state in which the work area 91 is divided and a plurality of sections S and SE including an exceptional section SE in which the number of work paths 93A is greater than a specific number are generated.
- FIG. 14 is a diagram illustrating a state in which the work order of the work path 93A is determined.
- FIG. 15 is a diagram illustrating a state where the autonomous traveling route 93 is generated based on the work order determined in FIG. 14.
- the “Generate Autonomous Travel Route” button is operated on the work information input screen 83 shown in FIG. 8, first, the shape of the field 90 set on the field information input screen 82 and the work information input screen 83 are set. The work area 91 and the non-work area 92 are determined based on the headland width and the non-cultivated land width. Thereafter, the process of FIG. 9 is started, and the autonomous travel route generation unit 47 arranges the work route 93A in the work area 91 with a space therebetween (step S101). Each work path 93A is arranged along the work direction set on the farm field information input screen 82 in FIG.
- the interval at which the work path 93A is arranged takes into consideration the work width W of the work machine 3 so that work work of the work machine 3 with respect to the work area 91 does not occur and the work efficiency is improved. Determined.
- the number of columns (number) of work paths 93A arranged in the work area 91 can be calculated based on the size of the work area 91, the work width W of the work implement 3, and the overlap allowance. In this step, the number of columns of the work route 93A to be arranged may be calculated without arranging the work route 93A in the work area 91, and the process may proceed to step S102.
- the autonomous travel route generation unit 47 acquires information on the skip number SN of the robot tractor 1 (input on the work information input screen 83) set by the work information setting unit 53, and the skip number SN is 1. It is determined whether or not the above is true (step S102).
- step S102 when the skip number SN is 0, the autonomous travel route generation unit 47 travels the work route 93A in order (without skipping) from one end in the direction in which the work routes 93A are arranged. Then, an autonomous travel route 93 that reaches the other end is generated (step S103), and the process ends. Thereby, the autonomous traveling route 93 without skip is generated.
- step S104 when the skip number SN is 1 or more, the autonomous traveling route generation unit 47 has the number of work routes 93A (work route number TP) in the work area 91 equal to or more than the basic unit route number BP. Whether or not (step S104).
- each work path 93A may be referred to as an alphabet such as A, B, C, D, E from the side closer to the autonomous travel start position.
- the tractor 1 travels A, skips one and travels C, and skips one and travels E.
- the direction to fly is reversed once, and it skips two more than usual, and runs B.
- the direction of flight is further reversed and the vehicle travels D.
- the work can be completed for the five work paths 93A while generally following the set skip number SN (ie, 1). it can.
- each work path 93A may be referred to as an alphabet such as A, B, C, D, E, F, G from the side close to the start position of autonomous driving.
- the tractor 1 travels A and then skips two to travel D and then skips two and travels G.
- the direction of flight is once reversed, and three more than the set number are skipped, and the vehicle travels C.
- run in F with the direction of flight reversed. After that, the direction of flight is reversed, and three more than the set number are skipped, and the vehicle travels B.
- the basic unit route number BP means the number of work routes 93A in a basic unit (group) for completing work by skip traveling.
- the basic unit path number BP is 5
- the basic unit path number BP is 7.
- the basic unit path number BP is represented by 2 (SN + 1) +1 with respect to the skip number SN.
- step S104 substantially means determining whether or not the number of work paths 93A arranged in step S101 is sufficient to form at least one of the above groups.
- step S104 If it is determined in step S104 that the work path number TP is less than the basic unit path number BP, it means that none of the above groups can be formed. Therefore, the control unit 71 controls the display 37 to display a message indicating that the autonomous traveling route 93 cannot be generated with the set skip number SN (step S105), and the process is terminated.
- step S104 If it is determined in step S104 that the work route number TP is equal to or greater than the basic unit route number BP, the autonomous traveling route generation unit 47 determines whether the work route number TP is an integer multiple of the basic unit route number BP. (Step S106).
- step S106 If it is determined in step S106 that the work route number TP is an integral multiple of the basic unit route number BP, the autonomous traveling route generation unit 47 divides the work area 91 in the direction in which the work routes 93A are arranged, and thereby creates a plurality of sections. S is generated (step S107). This division is performed so that the number of work paths 93A included in each section S is equal to the number of basic unit paths BP. In FIG. 12, when the skip number SN is 1 (the number of basic unit paths BP is 5), the work area 91 in which 15 work paths 93A are arranged is divided, and each has 5 work paths 93A. An example of forming three sections S is shown. However, when the work path number TP is equal to the basic unit path number BP, it is not necessary to divide, so one section S is generated in the entire work area 91.
- the autonomous traveling route generation unit 47 divides the work area 91 in the direction in which the work routes 93A are arranged, A partition S is generated (step S108). This division is based on the principle that the number of work paths 93A included in each section S is equal to the number of basic unit paths BP, except that only one section SE includes work paths included in the section SE. It is performed so that the number of 93A exceeds the basic unit path number BP.
- the number of work paths 93A included in each section S is equal to the number of basic unit paths BP, except that only one section SE includes work paths included in the section SE. It is performed so that the number of 93A exceeds the basic unit path number BP.
- the work area 91 in which 16 work paths 93A are arranged is divided, and each has five work paths 93A.
- An example is shown in which two sections (first section) S and one exceptional section (second section) SE having six work paths 93A are formed.
- This exceptional section SE is preferably arranged at the end in the direction in which the work paths 93A are arranged, that is, at the end close to the end of the autonomous travel.
- the work path number TP is less than twice the basic unit path number BP, it is not necessary to divide, so one (exception) section SE is generated in the entire work area 91.
- the autonomous traveling route generation unit 47 exceeds the (basic) section S in which the number of work routes 93A is equal to the basic unit route number BP and the basic unit route number BP (exception)
- the autonomous travel route 93 is generated so that the tractor 1 travels in accordance with a predetermined work order on the work route 93A for both of the sections SE (step S109).
- the above work order is the order of A, C, E, B, and D described above when the number of work paths 93A is equal to the number of basic unit paths BP (in principle) and the skip number SN is 1.
- the skip number SN is 2, it means the order of A, D, G, C, F, B, E described above.
- FIG. 14 shows how the work order of the work path 93A is determined when the skip number SN is 1 and the work area 91 is divided as shown in FIG. In FIG. 14, the encircled numbers attached to the respective work paths 93A indicate the determined work order.
- the section (exception section) SE in which the number of work paths 93A exceeds the basic unit path number BP preferably has a work order similar to the work order in the basic section S, but the work path 93A is skipped.
- the autonomous traveling route 93 may be generated so as to travel along the work route 93 ⁇ / b> A in an appropriate work order, considering the number to be performed to some extent.
- FIGS. 12 to 15 show the case where the skip number SN is 1, but when the skip number SN is 2, the basic unit path number BP is also as shown in FIG. 11B. It can be generated in the same manner as described above except that the work order is A, D, G, C, F, B, and E.
- the autonomous travel route generation system 99 of the present embodiment generates the autonomous travel route 93 that causes the tractor 1 to travel autonomously in order to perform work on a predetermined work area 91.
- the autonomous travel route generation system 99 includes a work area dividing unit 54 and an autonomous travel route generation unit 47.
- the work area dividing unit 54 divides the work area 91 into a plurality of sections S.
- the autonomous traveling route generation unit 47 generates the autonomous traveling route 93 so as to include a plurality of work routes 93 ⁇ / b> A arranged in each of the sections S divided by the work area dividing unit 54.
- the work area dividing unit 54 can divide the work area 91 so that the number of work paths 93A included in each section S is equal to the basic unit path number BP.
- the autonomous travel route generation unit 47 sets the work order based on the skip number SN for the plurality of work routes 93A.
- the autonomous traveling route generation unit 47 sets the work order based on the skip number SN for the plurality of work routes 93A.
- the work area dividing unit 54 when the number of work routes 93A included in the work area 91 is not an integral multiple of the basic unit route number BP.
- the operation is performed so as to form, in principle, a partition S in which the number of work paths 93A included is equal to the basic unit path number BP, and an exceptional section SE in which the number of included work paths 93A is greater than the basic unit path number BP.
- the area 91 is divided into a plurality of sections S and SE.
- FIG. 16 is a diagram illustrating an example in which the tractor 1 performs a plurality of turns in the non-work area 92.
- FIG. 17 is a diagram illustrating an example in which the tractor 1 performs a plurality of turns and turns in the non-work area 92.
- a non-working area 92 has a crank-shaped portion with continuous L-shaped paths.
- the non-work path 93B connecting the end points of the work path 93A for which the work order is determined passes through the portion, the non-work path 93B is placed in the non-work area 92 (that is, the tractor 1 is in the work area 91). It is generated in anticipation of a predetermined margin, so that it does not enter or get out of the field 90P.
- the turning radius R of the traveling machine body 2 is considered in the L-shaped road portion.
- the non-working area 92 since the non-working area 92 has a crank-shaped portion, two extra turns are required in the non-working area 92 as compared with the field 90 shown in FIG.
- the non-working path 93 ⁇ / b> B is generated as a path accompanied by a turnover that causes the traveling machine body 2 to move back and forth one end in addition to the turning of the L-shaped portion.
- the autonomous travel route generation unit 47 when the non-work area 92 is indefinite, the autonomous travel route generation unit 47 generates the non-work route 93B so as to involve turning and turning as necessary, thereby appropriately performing skip travel. Can do.
- the basic unit path number BP is a numerical value represented by 2 (SN + 1) +1 with respect to the skip number SN, but may be changed to another numerical value. That is, the basic unit path number BP is represented by M (SN + 1) +1 (M is a natural number of 2 or more).
- the skip number SN can be selected from 1 or 2. However, it may be configured such that a numerical value of 3 or more can be selected as necessary.
- the order (work order) of the work path 93A for performing work is not limited to the example shown in FIG. 11, but can be changed as appropriate.
- the autonomous travel route generation unit 47 generates the autonomous travel route 93 without dividing the work area 91, but the work area 91 is divided. On the above, the autonomous traveling route 93 may be generated.
- step S105 shown in FIG. 9 instead of displaying a message, the autonomous traveling route described in the problem to be solved by the invention described above (simple skip traveling) may be generated.
- the work route number TP is less than the basic unit route number BP
- the user is prompted to change the skip number SN to 0.
- the process proceeds to step S103, and the user skips.
- the process may proceed to step S105.
- the tractor 1 performs autonomous running / autonomous work.
- the work order with respect to each section is set in order from the section close to the start position, and when the work is completed for a specific section, the work is performed in the section adjacent to the section.
- the work order for each section is not limited to this, and an arbitrary order may be set.
- the non-working area 92 is determined based on the headland width and the non-cultivated land width set on the work information input screen 83, and the work is performed as the remaining area excluding the non-working area 92 from the farm field 90.
- An area 91 is defined.
- the method of setting the work area 91 is not limited to the above.
- the operator designates an arbitrary point of the farm field 90 displayed on the flat display unit 88 on the farm field information input screen 82 described above, and the work area 91 and The non-work area 92 may be set.
- the work area dividing unit 54 and the autonomous traveling route generating unit 47 constituting the autonomous traveling route generating system 99 are provided on the wireless communication terminal 46 side.
- part or all of the work area dividing unit 54 and the autonomous traveling route generating unit 47 may be provided on the tractor 1 side.
- FIG. 18 is a block diagram illustrating main components of the electrical system of the robot tractor 1 and the wireless communication terminal 46 according to the second embodiment.
- symbol is attached
- the main configuration of the autonomous travel route generation system 199 according to the present embodiment is provided in the wireless communication terminal 46.
- the wireless communication terminal 46 of the present embodiment further includes a display control unit 31, a storage unit 32, a field outer periphery setting unit 33, and an obstacle.
- the outer periphery setting part 34, the work area setting part (travel area setting part) 35, the start / end position setting part 151, the work direction setting part (travel direction setting part) 36, and the autonomous travel route generation part 147 are provided.
- the autonomous traveling route generation unit 147 corresponds to the autonomous traveling route generation unit 47 in the first embodiment.
- the wireless communication terminal 46 of the present embodiment also has the display control unit 31, the storage unit 32, the field outer periphery setting unit 33, and the obstacle outer periphery setting by the cooperation of the above-described software and hardware.
- Unit 34 work area setting unit 35, start / end position setting unit 151, work direction setting unit 36, autonomous travel route generation unit 147, and the like.
- the display control unit 31 creates display data to be displayed on the display 37 and appropriately controls display contents.
- the display control unit 31 of the present embodiment causes the display 37 to display the field information input screen 182 shown in FIG.
- FIG. 19 is a diagram illustrating an example of a screen for inputting information regarding a farm field on which the tractor 1 travels, which is displayed on the wireless communication terminal 46.
- this field information input screen 182 information regarding the field where the tractor 1 travels can be input. Specifically, on the farm field information input screen 182, a plane display unit 88 that displays the shape of the farm field as a graphic (graphically) is arranged. In the field information input screen 182, “record start” and “reset” buttons are arranged in the “field outer periphery position” field and the “obstacle outer periphery position” field, respectively. In the field information input screen 182, “designation” and “reset” buttons are arranged in the “work start position / work end position” and “work direction” fields.
- the storage unit 32 can store information on the farm field input by the user operating the touch panel of the wireless communication terminal 46, and can also store information on the generated travel route.
- the field outer periphery setting part 33 sets the position of the outer periphery of the field used as the object which the tractor 1 performs autonomous driving
- the obstacle outer periphery setting unit 34 is configured to set the outer periphery region of the obstacle arranged in the target field where the tractor 1 performs autonomous traveling. Specifically, when the user operates the “recording start” button of “the position of the outer periphery of the obstacle” on the field information input screen 182, the wireless communication terminal 46 switches to the obstacle outer periphery recording mode. In this obstacle outer periphery recording mode, when the position information of the positioning antenna 6 is recorded by the obstacle outer periphery setting unit 34 at the corner of the outer periphery region of the obstacle and the obstacle outer periphery setting unit 34 records the obstacle outer periphery setting unit.
- a shape in which the obstacle is surrounded by a polygon (for example, a rectangle) is set (acquired).
- This polygon can be calculated, for example, as a polygon specified by a so-called closed graph so that line segments connecting the corners do not intersect.
- region of an obstruction can be set.
- region of the obstruction set in the obstruction outer periphery setting part 34 is a hollow polygonal area
- the work area setting unit 35 sets the position of a work area (running area) where the tractor 1 is disposed in a target field where autonomous traveling is performed and where farm work is performed while autonomously traveling.
- the width of the headland and the width of the non-cultivated land can be set on an input screen (not shown) different from the farm field information input screen 182. It is configured.
- a non-working area composed of a headland and a non-cultivated land is determined based on the above-described setting content and the position and shape of the field set by the field outer periphery setting unit 33, and the non-working area is not operated from the field of the field.
- An area excluding the area is defined as a work area.
- the start / end position setting unit 151 sets a start point that is a point at which the tractor 1 starts autonomous traveling and an end point that is a point at which autonomous traveling ends. Specifically, when the user operates the “designation” button of “work start position / work end position” on the field information input screen 182, the field data set by the field outer periphery setting unit 33 is displayed on the plane display unit 88. It is displayed superimposed on the data. In this state, when the user selects an arbitrary point near the contour of the field, the position information of the selected point can be set (recorded) by the start / end position setting unit 151 as the start point and the end point. The function of the “reset” button is the same as described above.
- the work direction setting unit 36 sets the direction in which the tractor 1 travels while performing farming work in the work area (the direction of the travel path). Specifically, when the user operates the “designation” button for “work direction” on the field information input screen 182, the shape of the field set by the field outer periphery setting unit 33 is superimposed on the map data on the plane display unit 88. Is displayed. In this state, for example, when the user selects two points from a plurality of points specified when specifying the field, the work direction is set with the direction of the straight line connecting the two points as the work direction (traveling direction). It can be set (recorded) by the unit 36.
- the number of points to be selected when specifying the work direction is not limited to two, and may be a plurality of three or more points. Thereby, it is possible to designate a more accurate work direction along the contour of the field or the like.
- the function of the “reset” button is the same as described above.
- the autonomous travel route generation unit 147 in the present embodiment generates a travel route on which the tractor 1 travels autonomously in the field. Similar to the first embodiment, this travel route includes a straight or broken line travel route and an arcuate turning circuit alternately.
- the autonomous traveling route generation unit 147 includes the position of the field outer periphery set by the field outer periphery setting unit 33, the position of the work area set by the work region setting unit 35, the start point and the end set by the start / end position setting unit 151. Information on the position of the spot and the work direction set by the work direction setting unit 36 is acquired, and a travel route is automatically generated based on the information.
- This travel route is basically generated such that a linear or broken line travel route is included in the work area, and a turning circuit is included in an area (non-work area) other than the work area in the field.
- the autonomous traveling route generation unit 147 generates a traveling route so as to avoid the obstacle. This will be described in detail later.
- the travel route created by the autonomous travel route generation unit 147 is stored in the storage unit 32.
- FIG. 20 is a flowchart illustrating processing performed by the autonomous travel route generation unit 147 when generating a travel route.
- FIG. 21 is a flowchart showing the continuation of the process of FIG.
- the autonomous traveling route generation unit 147 sets the position of the field outer periphery set by the field outer periphery setting unit 33, the position of the work area set by the work region setting unit 35, and the start set by the start / end position setting unit 151.
- Information on the position of the point and the end point, and information on the work direction set by the work direction setting unit 36 is acquired, and a provisional travel route T0 is generated based on the information (see FIG. 22).
- the autonomous travel route generation unit 147 considers that there is no obstacle in the field, and generates a temporary travel route T0 in which a plurality of provisional travel routes P0 are arranged at intervals in the work area. (Step S201). Each temporary travel path P0 is arranged along the working direction.
- FIG. 22 is a diagram illustrating an example in which a provisional travel route T0 in which a plurality of provisional travel routes P0 are arranged is generated.
- a route indicated by a solid arrow is a travel route on which the unmanned tractor 1 travels.
- a manned tractor for performing cooperative work is located on a traveling road that is adjacent to the traveling road on which the unmanned tractor 1 travels (arranged between two traveling roads with arrows) and that is not attached with an arrow.
- a traveling path traveling along with the unmanned tractor 1 is shown.
- FIG. 22 is a diagram illustrating an example in which a provisional travel route T0 in which a plurality of provisional travel routes P0 are arranged is generated.
- a route indicated by a solid arrow is a travel route on which the unmanned tractor 1 travels.
- a manned tractor for performing cooperative work is located on a traveling road that is adjacent to the traveling road on which the unmanned tractor 1 travels (arranged between two traveling roads with arrows) and that is not
- the manned tractor is located on the right path behind the unmanned tractor 1 on the forward path (traveling path in the direction toward the upper side of FIG. 22) and on the return path (traveling path in the direction of the lower direction on the paper in FIG. 22). In this case, it is assumed that the vehicle will follow the diagonally left behind.
- the autonomous traveling route generation unit 147 acquires the obstacle outer peripheral region from the obstacle outer periphery setting unit 34, and the provisional traveling route that interferes with the obstacle outer peripheral region in the temporary traveling route P0 generated in step S201. It is determined whether or not there is (step S202).
- step S202 if there is no provisional traveling path that interferes with the obstacle outer peripheral area (No in step S202), the provisional traveling path T0 that is created assuming that there is no obstacle in the field is used as the traveling path T as it is. Since it can be used, the autonomous travel route generation unit 147 sets the provisional travel route T0 as the travel route T (step S203), and ends the generation of the route.
- step S202 when there is a provisional travel path that interferes with the obstacle outer peripheral area (step S202, Yes), the autonomous travel path generation unit 147 creates a travel path that avoids the obstacle. The process after step S204 is performed.
- the autonomous travel route generation unit 147 starts the point F, which is the starting end of the temporary travel route P0, for each provisional travel route P0 that interferes with the obstacle outer periphery region, and reaches the obstacle outer periphery region.
- a first travel path P1 having a point G, which is a point, as an end point is acquired.
- FIG. 23 shows a state where the first travel path P1 is generated for one provisional travel path P0.
- the autonomous travel route generation unit 147 starts from the end point (point G) of the first travel route P1 and travels to the opposite side of the obstacle while passing through the obstacle outer peripheral region.
- a detour Q is generated that is located on the virtual extension line L that extends the first travel path P1 so as to penetrate the object and that reaches the position (point H) that exits from the obstacle outer peripheral region.
- FIG. 24 shows a state where a detour Q is generated for one provisional travel path P0. As shown in FIG. 24, this detour route Q detours to the unworked region side (in other words, the far side as viewed from the travel route up to the first travel route P1) with respect to the provisional travel route P0. Is generated.
- the autonomous travel route generation unit 147 sets the second travel route P2 having the end point (point H) of the detour Q as the start point and the end point (point J) of the temporary travel route P0 as the end point. get.
- the second travel path P2 is disposed on the provisional travel path P0. Note that FIG. 24 shows a state where the second travel path P2 is generated for one provisional travel path P0.
- the autonomous travel route generation unit 147 includes the detours Q1, Q2, Q3,... Generated for each temporary travel route P0 that interferes with the obstacle outer peripheral region. It is determined whether or not there is at least one detour having a route length equal to or greater than the predetermined distance L1.
- step S207 if there is no detour Q having a length equal to or longer than the predetermined distance L1 (No in step S207), the travel route is extremely long even if the tractor 1 travels along the detour Q. Therefore, this detour Q is adopted as a travel route.
- step S208 the autonomous travel route generation unit 147 generates the first travel route P1, the detour route Q, the first travel route P0 generated based on the provisional travel route P0 for each of the provisional travel routes P0 that interfere with the obstacle outer peripheral region. It replaces with the travel path which consists of 2 travel paths P2. As a result, a travel route T1 that bypasses the obstacle is generated.
- FIG. 25 shows an example in which a travel route T1 that avoids an obstacle by detouring the obstacle is generated.
- step S207 if it is determined in step S207 that there is one or more detours Q having a length equal to or longer than the predetermined distance L1 (Yes in step S207), the travel route is excessive when the tractor 1 travels along the detour Q. Therefore, this detour Q is not adopted as a travel route.
- step S211 when there is a detour Q whose length is equal to or longer than the predetermined distance L1, in step S211 shown in FIG. 21, the autonomous traveling route generation unit 147 generates each detour Q1, Q2, Q3,. -And discard the 2nd driving path P2. Subsequently, in step S212, the autonomous travel route generation unit 147 generates a return route D that starts from the end point (point G) of the first travel route P1 and turns back to the unworked region side while passing through the obstacle outer peripheral region. .
- FIG. 26 shows a state in which a turnback path D is generated for one first travel path P1.
- step S213 the autonomous travel route generation unit 147 is arranged in parallel to the unworked side of the provisional travel route P0 that generated the first travel route P1 with the end point (point K) of the turnback route D as the start point.
- a third travel path P3 having the end point (point M) of the next provisional travel path P0 as an end point is generated.
- FIG. 26 shows a state where the third travel path P3 as the return path is generated with respect to one first travel path P1.
- step S214 the autonomous travel route generation unit 147 interferes with the obstacle outer peripheral region, and selects the continuous round trip temporary travel route P0 (if there are a plurality of round trip routes, respectively), the first It replaces with the travel path which consists of the travel path P1, the return
- a travel route T2 that is folded back before the obstacle is generated.
- FIG. 27 shows an example in which a travel route T2 that avoids an obstacle is generated by turning back in front of the obstacle.
- a travel route T3 that turns back before the obstacle is appropriately displayed in the region on the opposite side of the obstacle as shown by a broken line in FIG. Generated.
- the unmanned tractor 1 performs farm work while traveling on the travel route T2, reaches the end point, moves to the start point of the travel route T3 through the non-work area, and performs farm work while traveling on the travel route T3.
- An example to do is shown.
- a travel route may be generated so as to work on the opposite side immediately after working on the region on one side separated by an obstacle.
- the autonomous traveling route generation system 199 generates a traveling route for causing the tractor 1 to autonomously travel in a predetermined work area.
- the autonomous traveling route generation system 199 includes a work direction setting unit 36, an autonomous traveling route generation unit 147, and an obstacle outer periphery setting unit 34.
- the work direction setting unit 36 sets the traveling direction (work direction) of the tractor 1 within the work area.
- the autonomous travel route generation unit 147 can generate a travel route including a plurality of travel routes provided along the work direction set by the work direction setting unit 36 in the work area.
- the obstacle outer circumference setting unit 34 sets an obstacle outer circumference area for the obstacle in the work area.
- the autonomous travel route generation unit 147 can generate a travel route so as to include the first travel route P1, the detour route Q, and the second travel route P2 (see FIGS. 22 to 25). ).
- the first travel path P1 is arranged along the work direction.
- the detour Q starts from the end point (point G) of the first travel path P1 and travels to the opposite side of the obstacle while passing through the obstacle outer peripheral area, and passes through the first travel path P1 so as to penetrate the obstacle. It reaches a position on the extended virtual extension line L.
- the second travel path P2 is arranged on the virtual extension line L, starting from the end point (point H) of the detour Q.
- a travel route including the first travel route P1, the detour route Q, and the second travel route P2 is generated. Therefore, by making the tractor 1 autonomously travel along this travel route, the tractor 1 can travel so as to bypass the obstacle. Moreover, since the detour Q is disposed so as to pass through the obstacle outer peripheral region set in advance, the unmanned tractor 1 can be generated by systematically generating the detour taking into account the relationship with the entire travel route and the like. The work by can be made smooth. Further, in a portion other than the detour Q, the travel route can be a route along the work direction, and the algorithm for generating the autonomous travel route can be simplified. In this way, by making the travel path basically a linear or broken line path along the work direction, it becomes easy to handle a plurality of travel paths as one set, and farm work is performed for each set. Any method can be easily realized.
- the autonomous travel route generation unit 147 performs the first travel route P1, the detour route Q, and the first travel route when the route length of the detour route Q is less than the predetermined distance L1. It is possible to generate a travel route so as to include two travel routes P2 (see FIG. 25). On the other hand, the autonomous travel route generation unit 147 generates the travel route so as to include the first travel route P1, the turnback route D, and the third travel route P3 when the detour route is equal to or longer than the predetermined distance L1. It is possible (see FIG. 27).
- the turnback path D starts from the end point (point G) of the first travel path P1, and turns back before the obstacle while passing through the obstacle outer peripheral area (see FIG. 26).
- the third travel path P3 is arranged in parallel with the first travel path P1, starting from the end point (point K) of the turnback path D.
- the autonomous travel route generation unit 147 leads the detour Q to the first travel route P1 when obstacles are arranged in an island shape in the work area. It is generated so as to turn from the far side (unworked area side) to the opposite side of the obstacle as seen from the travel route up to.
- the processing performed by the autonomous travel route generation unit 147 when generating a travel route is substantially the same as that of the second embodiment, but instead of step S207. The difference is that the process of step S307 is performed.
- the autonomous travel route generation unit 147 includes the detours Q1, Q2, Q3,... Generated for each temporary travel route P0 that interferes with the obstacle outer peripheral region. Whether or not there is one or more detours in which an avoidance distance L10 (see FIG. 24), which is a distance that must move in a direction perpendicular to the work direction to avoid (detour) an obstacle, is equal to or greater than a predetermined distance L2. Determine whether.
- step S307 if there is no detour Q having the avoidance distance L10 equal to or greater than the predetermined distance L2 (No in step S307), the tractor 1 is not allowed to travel within the work area even if the tractor 1 travels along the detour Q. Since the route length of the travel route does not become extremely long as compared with the case where there is no obstacle, this bypass Q is used to avoid the obstacle. That is, the process of step S208 is performed and the travel route T1 including the detour Q is generated.
- step S307 if there is one or more detours Q where the avoidance distance L10 is equal to or greater than the predetermined distance L2 (step S307, Yes), when the tractor 1 travels along the detour Q, the travel route Since the route length becomes extremely long and the work becomes inefficient, this detour Q is not adopted. That is, the autonomous traveling route generation unit 147 generates a return route D that can be used as a substitute for the detour by the processing from step S211 to step S214 shown in FIG.
- the processing of this embodiment can also prevent the detour from becoming excessively long.
- the autonomous travel route generation unit 147 can easily determine whether the detour Q is too long.
- the autonomous travel route generation unit 147 of the present embodiment has the avoidance distance L10 that is a distance that the tractor 1 must move in a direction perpendicular to the work direction in order to avoid an obstacle as the predetermined distance.
- L10 a distance that the tractor 1 must move in a direction perpendicular to the work direction in order to avoid an obstacle as the predetermined distance.
- the avoidance distance L10 is equal to or greater than the predetermined distance L2
- the autonomous travel route generation unit 147 can generate the travel route so as to include the first travel route P1, the turnback route D, and the third travel route P3. It is.
- the turnback path D starts from the end point (point G) of the first travel path P1 and turns back before the obstacle while passing through the obstacle outer peripheral area.
- the third travel path P3 is arranged in parallel with the first travel path P1 with the end point (point K) of the return path as the start point (see FIG. 26).
- the avoidance distance L10 that must move in the direction perpendicular to the work direction in order to bypass the obstacle is equal to or greater than the predetermined distance L2, instead of the path that bypasses the obstacle, the obstacle is in front.
- the route T2 that is turned back can be generated as a travel route. Therefore, it is possible to prevent the portion of the travel route T2 that does not contribute to work from becoming excessively long.
- the processing performed by the autonomous travel route generation unit 147 when generating a travel route is substantially the same as in the second embodiment, but instead of step S207. The difference is that the process of step S407 is performed.
- the autonomous traveling route generation unit 147 includes the tractor 1 in the detours Q1, Q2, Q3,... Generated for each temporary traveling route P0 that interferes with the obstacle outer peripheral region. It is determined whether or not there is one or more detours in which the number of turns or the turn angle required for avoiding (bypassing) an obstacle is greater than or equal to a predetermined value (for example, five times or more, or 120 ° or more).
- step S407 determines whether there is no detour Q having a turn count or angle greater than a predetermined value. If the result of determination in step S407 is that there is no detour Q having a turn count or angle greater than a predetermined value (step S407, No), even if the tractor 1 travels along the detour Q, the route is so complicated. Therefore, the detour Q is used to avoid an obstacle. That is, the process of step S208 is performed and a travel route including the detour Q is generated.
- step S407 if there is one or more detours Q having a turn count or turn angle greater than or equal to a predetermined value (step S407, Yes), the travel route is determined by causing the tractor 1 to travel along the detour Q.
- This detour Q is not adopted because it may become complicated and work may become inefficient or the user may be confused. That is, the autonomous traveling route generation unit 147 generates a return route D that can be used as a substitute for the detour by the processing from step S211 to step S214 shown in FIG.
- the autonomous travel route generation unit 147 of the present embodiment when the number of turns or the turn angle in the detour Q is less than a predetermined value, the first travel path P1, the detour Q, and the second travel It is possible to generate a travel route so as to include the road P2.
- the autonomous travel route generation unit 147 generates a travel route so as to include the first travel route P1, the turnback route D, and the third travel route P3 when the number of turns or the turn angle in the detour Q is greater than or equal to a predetermined value. Is possible.
- the turnback path D starts from the end point (point G) of the first travel path P1 and turns back before the obstacle while passing through the obstacle outer peripheral area.
- the third travel path P3 is arranged in parallel with the first travel path P1, starting from the end point (point K) of the turnback path D.
- a route including the return path D that turns back before the obstacle is used instead of the route that detours the obstacle. It can be generated as a travel route. Therefore, it is possible to prevent a travel route having a large number of turns or a large turn angle from being generated, so that work can be performed smoothly.
- the traveling route is made as straight as possible and an obstacle can be avoided.
- a path for avoiding an obstacle a path that bypasses the obstacle and a path that turns back before the obstacle are properly used.
- the travel route is generated in a straight line as much as possible, whereby the algorithm for generating the autonomous travel route can be simplified, and the travel route can be easily understood by the user.
- the autonomous travel route generation unit 147 generates a travel route including the first travel route P1, the detour route Q, and the second travel route P2 in the work area.
- the traveling path for avoiding the obstacle is generated so as to be within the work area.
- the present invention is not necessarily limited to this.
- the traveling path may be generated so that the detour Q protrudes into the non-cultivated land (non-working area).
- the autonomous traveling route generation unit 147 generates the detour Q so as to detour to the unworked area side.
- a detour QA that makes a detour to the unworked area side
- a detour QB that makes a detour to the work area side (the side that has already been farmed) are provisionally provided. It is also possible to generate and compare the path lengths of these detours QA and QB and adopt the detour whose length is shorter.
- a warning to that effect may be displayed on the display 37 of the wireless communication terminal 46.
- display data indicating a warning may be generated by the display control unit 31, and a warning screen based on the display data may be displayed on the display 37.
- a display example of the warning screen as described above is shown in FIG.
- FIG. 31 shows an example in which an obstacle is arranged so as to protrude from the end of the field toward the center.
- the autonomous travel route generation system 199 of the present invention can generate an efficient travel route while avoiding obstacles.
- a detour is made to the work area (the side that has already been farmed). It is good also as producing
- the invention disclosed in the above embodiment can also be applied when the contour of the field is complicated.
- the shape of the outer periphery of the field is set by the field outer periphery setting unit 33. Even in such a case, it can be considered exactly the same as in the case of FIG. 31 if it is considered that the obstacle is arranged in a projecting shape toward the inside in a simple rectangular field. That is, the present invention can also be applied to a case where a part of the contour of the field is substantially concave and thus becomes an “obstacle”.
- step S207 of FIG. 20 instead of determining whether or not there are one or more detours having a path length of the predetermined distance L1 or more in the plurality of detours, the total of the path lengths of the plurality of detours is calculated. It may be determined whether or not there is a predetermined distance or more. Similarly, in step S307 in FIG. 28, it may be determined whether the total avoidance distance is equal to or greater than a predetermined distance.
- a turn indicator such as a blinker may be operated to alert the user of the wireless communication terminal 46, the operator of the manned tractor, or the like.
- a turn indicator such as a blinker
- the unmanned tractor 1 may approach a manned tractor, for example, a user can detect this and a collision etc. can be prevented beforehand.
- the first travel is made so that the end point G of the first travel path P1 is the starting point, passes through the obstacle outer peripheral region, turns to the opposite side of the obstacle, and penetrates the obstacle.
- the detour Q that reaches the position on the virtual extension line L extending the path P1 is generated, the present invention is not limited to this.
- the detour is a path that connects the end point of the first travel path (point reaching the obstacle outer peripheral area) and the start point of the second travel path (point that exits from the outer peripheral area of the obstacle) that is arranged with an obstacle therebetween.
- the starting point of the second travel path may not be a point on the virtual extension line extending the first travel path.
- the provisional traveling path P0 ′ is a broken line traveling path
- the travel path P1 ′ and the second travel path P2 ′ are connected via a refracting part to form a tentative traveling path P0 ′ having a broken line shape, and the refracting part is an obstacle outer peripheral region or an obstacle.
- the refracting part is an obstacle outer peripheral region or an obstacle.
- the start point of the first travel path P1 ′ is indicated as F ′
- the end point is indicated as G ′
- the start point of the second travel path P2 ′ is indicated as H ′
- the end point is indicated as J ′
- the detour is indicated as Q ′.
- the detour Q when obstacles are present in the work area in the form of islands, the obstacles are seen from the far side in the obstacle outer peripheral area when the detour Q is viewed from the travel route up to the first travel route P1.
- the detour may be generated on the side near the end point in the obstacle outer peripheral area. In other words, the detour reaches the end point in the obstacle outer peripheral area after reaching the obstacle outer peripheral area. What is necessary is just to produce
- the number of travel paths in the work area is determined in consideration of the width of the work area and the vehicle width of the tractor 1 (work machine 3), but the work order in each work path should be set as appropriate according to the user's specification. Is possible.
- the designation of the user it is possible to designate the number of work paths (the number of skips) between the currently traveling road P10 and the next traveling road P11, and when the number is zero, When the traveling path P10 and the traveling path P11 are adjacent and the number of the traveling paths is two, the traveling path P10 and the traveling path P11 are arranged with two traveling paths therebetween.
- the work order in each work path is set sequentially from the start point to the end point, but when the number is other than 0, in part, it is set from the end point to the start point (in other words, After driving on a road near the end point, it may run on an uncultivated road near the start point). And when there is an obstacle on an uncultivated traveling road that travels after moving from the end point to the starting point, the detour route passes the other uncultivated traveling path side, that is, the obstacle outer peripheral region so as to pass the end point side. Generated within.
- the path length of the detour is shorter.
- a detour or a detour with a smaller number of turns may be generated.
- a provisional traveling path including a plurality of provisional traveling paths is generated, and the provisional traveling paths are corrected as appropriate depending on whether or not each temporary traveling path interferes with the obstacle outer peripheral area.
- the method for generating the travel route is not limited to this.
- the provisional travel route is generated assuming that there are no obstacles.
- a determination process for determining whether to replace the provisional travel route with a travel route including a detour (for example, This is because step S207 in FIG. 20 is performed after the provisional travel route is generated, but the travel route may be generated without generating the provisional travel route by making the determination in advance.
- this can be realized by determining whether or not to generate a detour in the outer peripheral area of the obstacle when the outer peripheral area of the obstacle is set by the obstacle outer peripheral setting unit 34. For example, when there is one or more detours having a length equal to or longer than a predetermined distance in the process of step S207 in FIG. 20 described above, in order to avoid an excessively long path length of the detour and inefficient work.
- the detour is not adopted as the travel route, the route length of the detour when the detour is temporarily generated in the outer periphery region of the obstacle set by the obstacle outer periphery setting unit 34 is calculated in advance. Is possible.
- the maximum path length of the detour is, in principle, the length of the lateral side of the outer edge of the outer peripheral area (side in the direction perpendicular to the working direction), This is the total length (hereinafter referred to as the maximum path length A) of the lengths of the vertical sides (sides in the direction parallel to the working direction).
- “in principle” means that the path length of the detour is generated so as to be the shortest.
- the autonomous travel route generation unit 147 generates a travel route that does not include a detour in at least the outer peripheral region of the obstacle where the maximum route length A is equal to or greater than the predetermined distance, and the maximum route length A and the maximum route length B. It is possible to generate a travel route including a detour and generate a travel route including each travel route in an outer peripheral region of an obstacle where both of them are less than a predetermined distance.
- steps S501 to S504 of FIG. 34 a process performed by the autonomous travel route generation unit 147 when the travel route is generated by the above-described method is simply shown by a flowchart.
- the autonomous travel route generation unit 147 calculates the maximum route length in advance for all obstacle outer peripheral regions (step S501). Thereafter, the autonomous travel route generation unit 147 generates a travel route that does not turn back or detour for a portion of the work area that does not interfere with the obstacle outer peripheral region (obstacle) (step S502).
- the autonomous travel route generation unit 147 determines a travel route including a turn-around route for a portion of the work area that interferes with the obstacle outer peripheral region when the maximum route length of the obstacle outer peripheral region is equal to or greater than a predetermined value. It generates (step S503), and when it is less than the predetermined value, a travel path including a detour is generated (step S504). In this way, by associating whether or not to generate a travel route including a detour with the outer peripheral area of the obstacle, it is possible to generate a travel route without generating a provisional travel route.
- the non-working area is determined by setting the width of the headland and the width of the non-cultivated land on the input screen (not shown), and the working area is determined as the remaining area excluding the non-working area from the field. It has been.
- the method of setting the work area is not limited to the above.
- the work area and the non-work area can be specified by the user specifying an arbitrary point on the farm field displayed on the plane display unit 88 on the farm field information input screen 182 described above. May be configured to be settable.
- the autonomous traveling route generation system of the present invention is not limited to the cooperative work of the unmanned tractor 1 and the manned tractor described above, and can also be applied to the case where only the unmanned tractor 1 performs autonomous traveling / autonomous work alone.
- the work direction setting unit 36, the autonomous travel route generation unit 147, and the obstacle outer periphery setting unit 34 that constitute the autonomous travel route generation system 199 are provided on the wireless communication terminal 46 side.
- the work direction setting unit 36, the autonomous traveling route generation unit 147, and the obstacle outer periphery setting unit 34 may be provided on the tractor 1 side.
- FIG. 35 is a block diagram illustrating main components of the electrical system of the robot tractor 1 and the wireless communication terminal 46 according to the sixth embodiment.
- the tractor 1 of this embodiment includes a camera (external environment information acquisition unit).
- the camera 247 detects a moving image or an image by photographing the front of the tractor 1. Although not shown in FIGS. 1 and 2, the camera 247 is attached to the roof 29 of the tractor 1.
- the moving image or image data captured by the camera 247 is transmitted from the wireless communication antenna 48 to the wireless communication terminal 46 by the wireless communication unit 40.
- the wireless communication terminal 46 that has received the moving image or image data displays the content on the display 37.
- the moving image or image captured by the camera 247 is subjected to image analysis by the control unit 4 or the wireless communication terminal 46.
- the external environment information in the field for example, the position, size, etc. of a specific object (for example, a field surface shape such as a fence or a groove, an edge of an obstacle field such as a stone) existing around the tractor 1 is detected. Is done.
- the position where the specific target is displayed, etc., the position of the specific target (the direction in which the specific target exists and the specific target) Distance) is detected.
- the process performed according to the detection result of a specific object is mentioned later.
- the main configuration of the autonomous traveling route generation system 299 of the present embodiment is provided in the wireless communication terminal 46.
- the autonomous travel route generation system 299 of the present embodiment includes the control unit 71, the communication unit 72, the display control unit 31, the storage unit 32, the field outer periphery setting unit 33, the obstacle outer periphery setting unit 34, and the work area setting unit (travel In addition to the area setting unit 35, the start / end position setting unit 151, the work direction setting unit (traveling direction setting unit) 36, and the like, the route generation unit 276, the correction information calculation unit 277, the correction route generation unit 278, and the like. Is provided.
- the wireless communication terminal 46 of the present embodiment is also configured as a route generation unit 276, a correction information calculation unit 277, a correction route generation unit 278, and the like by the cooperation of the above-described software and hardware. Can work.
- the route generation unit 276 of the present embodiment also includes a travel route, basically, a straight or broken line-like travel path is included in the work area, and a turning circuit is the work area in the field. It is generated so as to be included in an area other than (non-work area). However, when there is an obstacle in the field, the route generation unit 276 generates a travel route so as to avoid the obstacle. This will be described in detail later.
- the travel route generated by the route generation unit 276 is stored in the storage unit 32.
- the correction information calculation unit 277 corrects the travel route based on the detection result of the specific object acquired by the camera 247 (for example, a field surface shape such as a ridge or a groove, an obstacle such as a stone, or an end of the field).
- the correction information is calculated.
- the correction route generation unit 278 generates a correction route in which the travel route is corrected based on the correction information calculated by the correction information calculation unit 277. Detailed processing performed by the correction information calculation unit 277 and the correction path generation unit 278 will be described later.
- the automatic correction means that the wireless communication terminal 46 generates a correction route in which the travel route is corrected, and additionally includes updating the travel route stored in the storage unit 32 to the correction route. Good.
- the travel route T is composed of travel routes P5 to P8 and turning circuits U5 to U7.
- the traveling paths P5 to P8 are linear paths formed so as to pass through the center of the basket formed in the field.
- the turning circuit U5 is an arcuate path that connects the travel path P5 and the travel path P6.
- the turning circuit U6 is an arcuate path that connects the travel path P6 and the travel path P7.
- the turning circuit U7 is an arcuate path that connects the travel path P7 and the travel path P8.
- the wireless communication terminal 46 can correct the travel route T in consideration of the misalignment of the kite by performing processing based on the flowchart shown in FIG.
- the wireless communication terminal 46 determines whether or not wrinkles have been detected by analyzing an image (which may be a moving image, the same applies hereinafter) detected by the camera 247 (step S601). For example, since the portion where the wrinkles are formed is higher than the other portions, the wireless communication terminal 46 forms the wrinkles and the portion where the wrinkles are formed based on the image detected by the camera 247. It can be distinguished from the parts that are not. As described above, the wireless communication terminal 46 detects wrinkles. In the example shown in FIG.
- a suitable timing such as a timing at which the tractor 1 is instructed to start autonomous driving and autonomous work, a timing at which the tractor 1 arrives at the starting point, or a timing just before that, 46 detects the wrinkles at the end on the start point side.
- the wireless communication terminal 46 detects the center position (actual center position) of the wrinkle detected by the camera 247 (step S602).
- the center position of the heel is the center position in the width direction (short direction) of the heel.
- the wireless communication terminal 46 calculates the distance from the tractor 1 to the heel based on the image detected by the camera 247. Thereby, the relative position of the heel with respect to the tractor 1 is detectable.
- the absolute position of the tractor 1 can be detected by the position information calculation unit 49.
- the wireless communication terminal 46 can detect the absolute position of the kite (that is, the position of the kite on the travel route) based on the relative position of the kite with respect to the tractor 1 and the absolute position of the tractor 1.
- the wireless communication terminal 46 calculates the center position (absolute position) of the eyelid by specifying the center in the width direction of the eyelid for which the absolute position has been obtained. In the example shown in FIG. 38, the wireless communication terminal 46 detects the center position of the heel at the end on the start point side.
- the wireless communication terminal 46 determines whether or not the registered travel route and the center position of the bag are different from each other by a threshold value (step S603).
- the wireless communication terminal 46 compares the travel route stored in the storage unit 32 (specifically, the travel route passing through the saddle detected this time in the travel route) with the center position of the saddle detected in step S602. Then, the amount of deviation between the two is calculated.
- the wrinkles are formed so as to be shifted in parallel with the width direction, and therefore the amount of shift is constant over the longitudinal direction of the wrinkles.
- the threshold value in step S603 is arbitrary, but for example, it is preferably a value satisfying the following conditions. That is, in this embodiment, a high-accuracy satellite positioning system using the GNSS-RTK method is used, but a measurement error of a trace amount (about 2 to 3 cm) may occur. Therefore, the threshold value is preferably a value larger than the measurement error of the position of the tractor 1 (for example, 2 cm or more, 3 cm or more, 4 cm or more). Further, the threshold value may be set based on a shift amount that does not hinder the work of the tractor 1. Further, the threshold value may be changed by the operator operating the wireless communication terminal 46.
- step S603 When the wireless communication terminal 46 determines that the amount of deviation (difference) between the registered travel route and the center position of the bag is smaller than the threshold (No in step S603), the wireless communication terminal 46 does not generate a correction route for the bag. The process returns to step S601. On the other hand, if the wireless communication terminal 46 determines that the registered travel route and the center position of the kite are different from each other by a threshold value (step S603, Yes), if the tractor 1 is autonomously traveling, an autonomous travel stop signal is generated. Transmission is made to the tractor 1 to temporarily stop the tractor 1 (step S604). If the tractor 1 is not autonomously traveling, the process proceeds to step S605.
- the wireless communication terminal 46 determines whether or not the operator has permission for automatic correction of the travel route (step S605).
- the wireless communication terminal 46 determines that the operator has permission when the setting for permitting automatic correction of the travel route has been made in advance.
- the wireless communication terminal 46 displays predetermined content on the display 37 and asks the operator for permission for automatic correction.
- the wireless communication terminal 46 displays, for example, “Permit automatic correction of travel route” and “Do not allow automatic correction of travel route” on the display 37.
- “permit automatic correction of travel route” is selected by the operator, for example, “automatic correction of one travel route” and “automatic correction of all travel routes” are displayed.
- “automatic correction of one travel path” is selected by the operator, the wireless communication terminal 46 automatically corrects one travel path (travel path P5 in FIG. 38) and another travel path (travel in FIG. 38). Roads P6 to P8) are not automatically corrected.
- “automatic correction of all travel paths” is selected by the operator, the wireless communication terminal 46 automatically corrects all travel paths (travel paths P5 to P8 in FIG. 38).
- the wireless communication terminal 46 will “manually correct the travel route”, “continue work without correcting the travel route”, Options such as “Cancel work” are displayed.
- the wireless communication terminal 46 determines that the operator has permission for automatic correction of the travel route (step S605, Yes), the position information of the tractor 1, the center position of the kite, etc. Based on this, correction information is calculated (step S606).
- the wireless communication terminal 46 determines the actual absolute position of the kite (that is, on the travel route) based on the absolute position of the tractor 1 detected by the position information calculation unit 49 and the relative position of the kite with respect to the tractor 1. The actual heel position) can be detected.
- the correction information is information for correcting the travel route, and specifically, the travel route offset amount, the offset direction, the travel route angle change amount, and the like.
- the ridges are formed so as to be shifted in parallel with the width direction, and therefore the offset amount and the offset direction of the travel route correspond to the correction information.
- correction information is calculated for each route.
- the wireless communication terminal 46 uses the amount of deviation between the travel route and the center position of the kite obtained in step S603 as an offset amount.
- the wireless communication terminal 46 sets the direction in which the travel route is shifted from the actual center position of the bag as the shift direction.
- the wireless communication terminal 46 (specifically, the correction route generation unit 278) generates a correction route based on the correction information calculated in step S606, and updates the travel route stored in the storage unit 32 (step). S607).
- a correction path is generated as shown in FIG.
- FIG. 39 shows a correction route that is generated when automatic correction of one traveling route is selected.
- the wireless communication terminal 46 generates a travel route P51 that is a correction route obtained by correcting the travel route P5.
- the wireless communication terminal 46 generates a turning circuit U51 which is a correction path obtained by correcting the turning circuit U5.
- the start point and end point positions of the travel path P5 are offset based on the correction information, and a path connecting the start point and end point after the offset is generated as the travel path P51.
- the correction route generation unit 278 calculates correction information calculated based on the position of the travel path P5 generated in advance (the center position when width information is included as the travel path P5) and the detected center position of the kite. Based on this, it is possible to offset the start point and end point of the travel path P5, and to generate a new travel path P51 different from the travel path P5 as a correction path based on the offset start point and end point.
- the wireless communication terminal 46 resumes traveling of the tractor 1 and causes the tractor 1 to travel along the travel route updated in step S607 (step S608). Thereafter, the wireless communication terminal 46 determines whether or not wrinkles have been detected (step S601). If wrinkles are detected, the processing after step S602 is performed. By continuously performing the above processing in this way, even when the travel paths P6 to P8 and the actual center position of the kite are misaligned, the travel paths P6 to P8 can be corrected.
- FIG. 36, 40 and 41 the case where a plurality of ridges are inclined to be inclined will be described with reference to FIGS. 36, 40 and 41.
- FIG. 36, 40 and 41 the case where a plurality of ridges are inclined to be inclined will be described with reference to FIGS. 36, 40 and 41.
- the actual kite (the kite detected by the camera 247) is inclined with respect to the travel route generated in advance.
- the camera 247 captures not only the image of the latest kite of the tractor 1 but also the image of the kite in front. Therefore, the wireless communication terminal 46 can calculate the position of the heel further forward as well as the latest by analyzing this image. Therefore, in step S ⁇ b> 603, the wireless communication terminal 46 can calculate the amount of deviation between the registered traveling route and the center position of the kite detected by the camera 247 not only in the immediate vicinity of the tractor 1 but also in front of it.
- the determination is made based on the positional deviation between the travel route and the center position of the kite. Instead, the difference between the direction of the travel route and the direction in which the kite is formed is used. A determination may be made based on this.
- step S606 the wireless communication terminal 46 (correction information calculation unit 277) calculates the angle change amount of the travel route as the correction information. .
- the wireless communication terminal 46 can detect the direction in which wrinkles are formed based on the image detected by the camera 247. Therefore, the amount of change in the angle of the travel route is calculated by comparing the direction of the travel route with the direction in which the heel is formed.
- the wireless communication terminal 60 determines the travel route P51, as the correction route, based on the angle change amount obtained in step S606 for the travel routes P5 to P8 in step S608.
- the travel route P61, the travel route P71, the travel route P81, the turning circuit U51, and the turning circuit U71 are generated and the traveling route stored in the storage unit 32 is updated.
- the travel route P51 As shown in FIG. 41, as a method of generating the travel path P51 when the starting point of the travel path P5 and the center position of the kite coincide with each other but the direction in which the kite is formed is shifted, for example, the travel path P5
- the position of the end point is offset by a value calculated based on the correction information (angle change amount) and the route length of the travel path P5 (for example, route length ⁇ tan (angle change amount)) while maintaining the start point of A route connecting the start point and the end point after the offset is generated as a travel route P51.
- the correction route generation unit 278 offsets the end point of the travel route P5 based on the correction information calculated based on the formation direction of the ridges, and a new different from the travel route P5 based on the start point and the post-offset end point. It is possible to generate a simple travel route P51 as a correction route.
- a correction path can also be generated by combining FIG. 39 and FIG.
- the starting point of the travel path is offset based on the correction information calculated based on the former shift.
- the wireless communication terminal 46 determines whether an obstacle has been detected by analyzing an image detected by the camera 247 (step S701). For example, since a part where an obstacle (stone, garbage, another work vehicle) is formed is different in color and size from the other part, the wireless communication terminal 46 can check the obstacle based on the image detected by the camera 247. An object can be detected. In the example shown in FIG. 43, an obstacle is detected while the tractor 1 is traveling along the traveling path P5.
- the wireless communication terminal 46 detects the position and size of the obstacle detected by the camera 247 as in the case of the bag (step S702).
- the size of the obstacle is at least one of the width, height, and depth of the obstacle. For example, the depth of the obstacle cannot be detected depending on the height of the obstacle. In this case, the wireless communication terminal 46 detects the width and height of the obstacle. Further, since the height of the obstacle is not related to the travel route, the detection of the height of the obstacle may be omitted.
- the wireless communication terminal 46 determines whether or not the detected obstacle has been registered (step S703).
- the determination in step S703 is performed by comparing the obstacle information registered (stored) in the storage unit 32 with the position and size of the obstacle detected in step S702. More specifically, whether or not the detected obstacle has been registered is determined to be registered if the area where the detected obstacle exists overlaps at least a part of the registered obstacle area. If it does not overlap the registered obstacle area, it is determined that it has not been registered.
- the wireless communication terminal 46 determines whether the registered obstacle and the detected obstacle are different in position or size by a threshold value or more (step S704). ). As in step S603, this threshold value is preferably determined based on the error of the satellite positioning system or whether the work of the tractor 1 is obstructed.
- step S704 When the position and / or size of the detected obstacle differs from the registered obstacle by a threshold value or more (step S704, Yes), the wireless communication terminal 46 transmits an autonomous travel stop signal to the tractor 1 and Is temporarily stopped (step S705). In addition, when the amount of deviation between the registered obstacle and the detected obstacle position and / or size is smaller than the threshold (No in step S704), the wireless communication terminal 46 generates a correction path for the obstacle. Without returning to the processing of step S701. More specifically, if the area where the detected obstacle is present matches or is included in the registered obstacle area, and the area where the detected obstacle exists is the registered obstacle area. If, for example, the size of the non-overlapping area is equal to or greater than the threshold, the process proceeds to step S705.
- the wireless communication terminal 46 transmits an autonomous travel stop signal to the tractor 1 to temporarily stop the tractor 1 (step S705).
- a threshold value for example, not to hinder the work of the tractor 1.
- the wireless communication terminal 46 determines whether or not the operator has permission for automatic correction of the travel route (step S706). This determination is basically the same as step S605 in FIG. However, the obstacle may be removed manually by the operator. Therefore, the operator can continue the work along the registered travel route by selecting “Continue the work without correcting the travel route” after removing the obstacle. Further, depending on the shape of the obstacle, there may be a case where a correction route is generated in which the traveling roads overlap (or exceed a preset allowable overlap amount). In this case, the wireless communication terminal 46 asks the operator for permission regarding the overlap.
- the radio communication terminal 46 determines that the operator has permission for automatic correction of the travel route (Yes in step S706), the position information of the tractor 1, the position and size of the obstacle. Correction information is calculated based on the above (step S707).
- the wireless communication terminal 46 determines the actual absolute position of the obstacle (that is, traveling) based on the absolute position of the tractor 1 detected by the position information calculation unit 49 and the relative position of the obstacle with respect to the tractor 1.
- the actual obstacle position on the route can be detected.
- the correction information indicates that if the detected obstacle is a registered obstacle, the corrected area obtained by correcting the registered obstacle area is the presence of the registered obstacle area and the detected obstacle. This is information for correcting the area to be included in the area.
- the detected obstacle is not a registered obstacle, the area is corrected so that the area including the detected obstacle exists as the area of the obstacle to be newly registered. This is information for (new registration).
- the wireless communication terminal 46 (specifically, the correction route generation unit 278) generates a correction route based on the correction information calculated in step S707 and updates the travel route stored in the storage unit 32 (step). S708).
- the wireless communication terminal 46 corrects the traveling path P5, the traveling path P6, and the turning circuit U5, and the traveling path P51, the traveling path P61, and the turning circuit are the correction paths that turn forward. U51 is generated.
- the travel path on which the correction information affects autonomous traveling / autonomous work is specified based on the correction information.
- the correction information based on the deviation affects the traveling path P5.
- the correction information based on the deviation is identified as affecting the traveling road P6 adjacent to the traveling road P5.
- the end point provided around the obstacle is offset based on the correction information to correct the new travel route based on the start point and the end point after the offset.
- the traveling path in which the correction information affects autonomous traveling / autonomous work is specified based on the correction information, as described above. Then, among the start point and end point of the identified travel route, the end point is changed from the field end to the periphery of the obstacle based on the correction information, and the new travel route is used as the correction route based on the start point and the changed end point. Generate.
- the wireless communication terminal 46 resumes traveling of the tractor 1 and causes the tractor 1 to travel along the travel route updated in step S708 (step S709). Thereafter, the wireless communication terminal 46 determines whether or not an obstacle has been detected (step S701). If an obstacle is detected, the processing from step S702 is performed. By continuously performing the above processing in this way, the travel route can be corrected even when there are a plurality of unregistered obstacles in the field.
- the wireless communication terminal 46 generates a correction route and, in addition, generates an obstacle periphery setting unit 34 for the user. If it is desirable to propose a registration change for obstacles based on re-registration or correction information, and the detected obstacle is not a registered obstacle, in addition to generating a correction route, the obstacle to the user It is desirable to propose new obstacle registration by the object outer periphery setting unit 34 or new obstacle registration based on correction information.
- the autonomous travel route generation system 299 of the present embodiment includes the route generation unit 276, the storage unit 32, the camera 247, the correction information calculation unit 277, and the correction route generation unit 278.
- the route generation unit 276 generates a travel route.
- the storage unit 32 stores the travel route generated by the route generation unit 276.
- the camera 247 is provided in the tractor 1 and acquires external environment information (such as the position and size of a specific target (such as a bag or an obstacle)) in the work area.
- the correction information calculation unit 277 calculates correction information for correcting the travel route based on the external environment information acquired by the camera 247.
- the correction route generation unit 278 generates a correction route in which the travel route is corrected based on the correction information calculated by the correction information calculation unit 277 and stores the correction route in the storage unit 32.
- the travel route is corrected based on the external environment information acquired by the camera 247 provided in the tractor 1. Therefore, the travel route generated in advance can be corrected based on the current environment or the like. Further, by storing the correction route in the storage unit 32, it is possible to eliminate the trouble of correcting the travel route after the next time.
- the specific target specified by the external environment information has been described using the bag and the obstacle, but may be another specific target (a groove or an end of a field).
- the tractor 1 is rotated once along the outer periphery of the field.
- the wireless communication terminal 46 can detect the end of the field based on the camera 247.
- the wireless communication terminal 46 corrects the setting of the outer periphery of the field and is affected by the outer periphery of the field when the amount of deviation between the registered end of the field and the detected end of the field is equal to or greater than the threshold value. Also corrects the travel route.
- the camera 247 has been described as an example of the external environment information acquisition unit, but the external environment information acquisition unit may be a radar device. Further, at least a part of the information stored in the storage unit 32 in the above embodiment may be stored in the storage unit 55. Similarly, at least part of the information stored in the storage unit 55 may be stored in the storage unit 32.
- the route generation unit 276, the storage unit 32, the correction information calculation unit 277, and the correction route generation unit 278 constituting the autonomous traveling route generation system 299 are provided on the wireless communication terminal 46 side. However, it is not limited to this. That is, some or all of these may be provided on the tractor 1 side or another device.
- the correction information calculation unit 277 calculates correction information based on the information acquired by the external environment information acquisition unit (for example, the camera 247), and the correction route based on the correction information calculated by the correction information calculation unit 277.
- the generation unit 278 generates the correction route
- the correction information does not have to be calculated by the correction information calculation unit 277 and is input by the user operating the external input device (for example, the display 37). It may be a correction value.
- the correction value can be input by operating the display 37.
- the display control unit 31 may display a correction value recommended on the basis of the correction information calculated by the correction information calculation unit 277 on the display 37. . Further, when the correction value input by the user deviates from the recommended correction value, the wireless communication terminal 46 may issue a warning and request correction of the correction value.
- a correction route when a correction route is generated for a specific travel route among a plurality of travel routes, the travel route including the specific travel route and in which autonomous traveling / autonomous work is not performed by the tractor 1 (hereinafter referred to as travel) (Referred to as a scheduled travel route) may be corrected as the correction route is generated, or only the specific travel route may be corrected and other routes may not be corrected.
- travel the travel route including the specific travel route and in which autonomous traveling / autonomous work is not performed by the tractor 1
- a scheduled travel route may be corrected as the correction route is generated, or only the specific travel route may be corrected and other routes may not be corrected.
- travel the travel route including the specific travel route and in which autonomous traveling / autonomous work is not performed by the tractor 1
- travel Referred to as a scheduled travel route
- the correction information calculation unit 277 calculates correction information based on the position information of the tractor 1, the position and size of the obstacle, and the like. In the case of an obstacle, the correction information further includes information that can specify the positional change of the obstacle over time.
- the information that can identify the position change with time may include information indicating the moving direction and moving speed of the dynamic obstacle, and the position (separation distance) between the tractor 1 and the dynamic obstacle. And the position information of the dynamic obstacle when the time (hereinafter, time TM1) until the tractor 1 calculated based on the moving speed comes into contact with the dynamic obstacle may be included.
- time TM1 time TM1
- Whether the obstacle is dynamic or static can be specified by capturing the position change of the obstacle, for example, based on a moving image or a plurality of images detected by the camera 247.
- the wireless communication terminal 46 determines whether or not the tractor 1 and the dynamic obstacle come into contact with each other when the time TM1 has elapsed, and determines that the obstacle does not come into contact.
- the correction route based on the correction information is not generated.
- a correction route based on the correction information is generated.
- the correction route is a route in which the tractor 1 and the dynamic obstacle do not contact when the time TM1 has elapsed. Therefore, when the obstacle that has not been registered is a static obstacle, the correction route is generated by changing the end point among the start point and the end point of the identified travel route.
- a correction path including a detour that avoids a dynamic obstacle after the time TM1 has elapsed without generating a start point and an end point is generated.
- the detour includes a turning circuit for avoiding contact with the dynamic obstacle, but the turning direction is the moving direction of the dynamic obstacle. The opposite direction is desirable.
- a dynamic obstacle does not always move constantly, and may move differently over time.
- a correction path that avoids contact with a dynamic obstacle may be generated as appropriate.
- the tractor 1 may be stopped when it is determined that contact avoidance is difficult, for example, the moving direction of the dynamic obstacle is continuously changed in a short time. In that case, a correction route from the position where the tractor 1 stops to the end point may be generated.
- FIG. 45 is a side view illustrating an overall configuration of the robot tractor 1 that travels along the autonomous traveling route 93 generated by the autonomous traveling route generation system 399 according to the seventh embodiment of the present disclosure.
- the robot tractor 1 of this embodiment includes a work machine 300 instead of the work machine 3 in the first embodiment.
- a mowing machine including a mowing working unit (working unit) 3A that performs mowing work with a rotary blade (not shown) is used.
- This mowing machine is configured as an offset type mowing machine (offset type working machine) capable of performing mowing work in a state where the mowing working unit 3A is offset from the traveling machine body 2 in the horizontal direction of the machine body.
- FIG. 46 shows a state in which the mowing operation unit 3A is offset to the right in the traveling direction with respect to the traveling machine body 2.
- the work machine 300 includes a hydraulic cylinder (offset actuator 345 described later). By driving the hydraulic cylinder, the mowing working unit 3A is moved to the opposite side of FIG. It can also be offset (to the left in the direction) or positioned directly behind the vehicle 2.
- the work machine 300 includes a work machine control unit 350 for controlling the mowing work unit 3A and the like.
- the work machine control unit 350 includes a CPU, a ROM, a RAM, an I / O, and the like (not shown), and the CPU can read various programs from the ROM and execute them.
- the work machine control unit 350 is electrically connected to the control unit 4 of the traveling machine body 2, and can control the work machine 300 based on a command from the control unit 4.
- An offset controller 365 is electrically connected to the work machine control unit 350.
- the offset controller 365 controls the offset amount of the mowing work unit 3A of the work machine 300.
- the work machine 300 includes an offset actuator 345.
- the offset actuator 345 include, but are not limited to, a hydraulic cylinder and an electric motor.
- the offset controller 365 drives the offset actuator 345 based on the control signal input from the work machine control unit 350. By this control, the mowing working unit 3A of the work machine 300 can be displaced in the left-right direction of the machine body.
- the offset actuator 345 is controlled by the control unit 4 (the work machine control unit 350), and the mowing work unit 3A is caused to travel by moving the tractor 1 in a state where the mowing work unit 3A of the work machine 300 is appropriately offset from the traveling machine body 2.
- the work by the mowing operation unit 3A can be performed in a state in which the center of the route through which the traveling machine 2 passes and the center of the route through which the traveling machine body 2 passes are shifted in the lateral direction of the machine body.
- the plurality of controllers (for example, the engine controller 61 and the like) including the offset controller 365 of the work machine 300 controls each part of the work machine 300 and the like based on a signal input from the control unit 4 of the tractor 1. Therefore, it can be grasped that the control unit 4 substantially controls each unit.
- the wireless communication terminal 46 of this embodiment includes a work vehicle information setting unit (offset setting unit) in addition to the control unit 71, the display (display unit) 37, the communication unit 72, and the like. 51, an agricultural field information setting unit (start / end position setting unit) 52, a work information setting unit 53, an autonomous travel route generation unit 354, and the like.
- the wireless communication terminal 46 of the present embodiment also has a work vehicle information setting unit (offset setting unit) 51, a farm field information setting unit (start / end) by the cooperation of the software and hardware described above. (Position setting unit) 52, work information setting unit 53, autonomous travel route generation unit 354, and the like.
- the work vehicle information setting unit 51 is for setting information related to the tractor 1 (hereinafter sometimes referred to as work vehicle information).
- the work vehicle information setting unit 51 includes the model of the tractor 1, the position where the positioning antenna 6 is attached to the tractor 1, the type of the work machine 300, the size and shape of the work machine 300, and the position of the work machine 300 with respect to the traveling machine body 2.
- the vehicle speed and engine speed during operation of the tractor 1, the vehicle speed and engine speed during turning of the tractor 1, and the like can be stored by the operator by appropriately operating the wireless communication terminal 46.
- the work vehicle information setting unit 51 has an effective width in the left-right direction in which the work is performed by the mowing work unit 3A as the size of the work machine 300 (width E2 shown in FIG. 46; hereinafter, sometimes referred to as work width). Can be set. Further, when the work machine 300 is an offset type work machine, the work vehicle information setting unit 51 is configured to offset the mowing work part 3A with respect to the travel machine body 2 as the position of the work machine 300 with respect to the travel machine body 2. It is possible to set (the aircraft left direction, the aircraft right direction, or both) and the offset distance E1 in the aircraft left-right direction when performing the offset work.
- the offset distance E1 is between a reference point 2C appropriately set for the traveling machine body 2 and a reference point 3C appropriately set for the work machine 300 (mowing working unit 3A). It can be defined as the distance in the left-right direction of the aircraft.
- the reference point 2 ⁇ / b> C of the traveling machine body 2 can be arbitrarily determined as a point representing the position of the traveling machine body 2, but the reference point 2 ⁇ / b> C is preferably set so as to be located at the center in the left-right direction of the traveling machine body 2.
- the reference point 3C of the work machine 300 can also be arbitrarily determined as a point representing the position of the work machine 300 (mowing work unit 3A), but the reference point 3C is the mowing work unit 3A. It is preferable to set so that it is located in the center in the left-right direction.
- the reference position is the reference position instead of the reference point 2C (the connection position center when connected at a plurality of positions).
- the distance in the left-right direction between the reference point and the reference point 3C may be defined as the offset distance E1.
- the mounting position of the positioning antenna 6 may or may not coincide with the reference point 2C of the traveling machine body 2 as shown in FIG.
- the field information setting unit 52 is for setting field information.
- the farm field information setting unit 52 can store the contents set by the operator operating the wireless communication terminal 46 with respect to the position and shape of the farm field 90, the start position and end position to be autonomously run, the work direction, and the like.
- the work information setting unit 53 is for setting information relating to how the work is specifically performed (hereinafter sometimes referred to as work information).
- the work information setting unit 53 includes, as work information, whether or not the robot tractor 1 and the manned tractor perform cooperative work, the number of skips that is the number of work paths 383A to be skipped when the tractor 1 turns in the headland, and the width of the headland And the width of the non-cultivated land can be set.
- the autonomous traveling route generation unit 354 is for generating an autonomous traveling route 383 that is a route for allowing the tractor 1 to autonomously travel.
- the autonomous traveling route generation unit 354 may generate and store the autonomous traveling route 383 of the tractor 1 based on the information set by the work vehicle information setting unit 51, the farm field information setting unit 52, and the work information setting unit 53. it can.
- FIG. 50 is a diagram illustrating a display example of the work vehicle information input screen 391 on the display 37 of the wireless communication terminal 46.
- FIG. 6 is a diagram illustrating a display example of the field information input screen 392 on the display 37 of the wireless communication terminal 46.
- FIG. 51 is a diagram showing another display example of the field information input screen 392 on the display 37 of the wireless communication terminal 46.
- FIG. 52 is a diagram showing a display example of the work information input screen 393 on the display 37 of the wireless communication terminal 46.
- control unit 71 controls to display the work vehicle information input screen 391 shown in FIG.
- the model of the tractor which is the same information as the work vehicle information input screen 81 according to the first embodiment, the size of the tractor 1, the mounting position of the positioning antenna 6 with respect to the traveling machine body 2,
- the traveling machine body 2 Direction in which the work machine 300 (mowing work unit 3A) can be offset and the offset distance in the horizontal direction of the machine when the work machine 300 is offset (specifically, the reference point 2C of the traveling machine body 2 and the mowing work unit) Fields for inputting the distance (E1) between the reference point 3C of 3A and the left-right direction of the body are arranged.
- the operator performs settings by operating the wireless communication terminal 46 and inputting a numerical value in a text box arranged in each column of the work vehicle information input screen 391 or selecting from a drop-down box list. .
- the working width E2 of the mowing working unit 3A included in the working machine 300 the left-right offset direction (right, left, or both) and the offset distance in which the mowing working unit 3A can be offset with respect to the traveling machine body 2.
- Various types of information including E1 can be set.
- Work vehicle information specified by the operator on the work vehicle information input screen 391 is stored in the work vehicle information setting unit 51.
- the control unit 71 controls the display 37 to display a field information input screen 392 that is substantially the same as that shown in FIG. 7 of the first embodiment (FIG. 51).
- the field information input screen 392 is input with the field information having almost the same contents as those shown in the first embodiment, and the settings are performed. However, the setting contents unique to the present embodiment will be described in detail below. .
- FIG. 6 shows an example in which the position and shape of the farm field 90, the work start position, and the work end position are set.
- a start position is set at one of the corners of the rectangular field 90
- an end position is set at a corner that is diagonal to the corner.
- both the start position and the end position are set at the end portion of the agricultural field 90 as shown in the first embodiment. .
- the work vehicle information setting unit 51 is set so that the work machine 300 (the mowing work unit 3A) can work while being offset in any of the left and right directions of the machine body 2 with respect to the traveling machine body 2. If it is, a point near the center of the work area 381 can be designated for one (only) of the start position and the end position of the autonomous running.
- FIG. 51 shows an example of such a case. In the example of FIG. 51, the start position is set at the corner of the farm field 90, and the end position is set at the center of the farm field 90. Note that such a setting is unique when using an offset type work machine, and when using a non-offset type work machine, designation as shown in FIG. 51 cannot be performed.
- the farm field information specified by the operator on the farm field information input screen 392 is stored in the farm field information setting unit 52.
- the control unit 71 controls the display 37 to display a work information input screen 393 as shown in FIG.
- the work information input screen 393 specific work information (the work information) can be input.
- the work information input screen 393 includes the presence / absence of cooperative work between the robot tractor 1 and the manned tractor, the pattern when the manned tractor cooperates, and the manned tractor when the manned tractor cooperates.
- Work width, number of skips of the robot tractor 1 when manned tractors collaborate (how many work paths are skipped), allowable overlap of work widths in adjacent work paths, initial offset of work machine 300 Fields for inputting the direction, the width of the headland, the width of the non-cultivated land, and the like are provided.
- the set value may be limited. Thereby, even when the offset type work machine is mounted, the autonomous traveling route in the headland or the like while considering that the end of the work machine 300 (the end of the mowing work part 3A) does not stick out from the field 90. Can be easily formed.
- FIG. 53 is a flowchart showing a process for generating the autonomous traveling route 383.
- the “Generate Autonomous Travel Route” button When the “Generate Autonomous Travel Route” button is operated on the work information input screen 393 shown in FIG. 52, first, the shape of the field 90 set on the field information input screen 392 and the work information input screen 393 are set. Based on the width of the headland and the width of the non-cultivated land, a work area 381 and a non-work area 382 are defined. Thereafter, the process of FIG. 53 is started, and the autonomous travel route generation unit 354 first generates a route 384 through which the mowing work unit 3A passes in the work area 381, as indicated by the broken line arrow in FIG. 54 (step S801).
- the calculation of the route at this time is performed based on the reference point (reference point of the mowing working unit 3A) 3C of the work machine 300, not the reference point 2C of the traveling machine body 2.
- the path 384 through which the reference point 3C of the work machine 300 passes in the work area 381 may be referred to as a “work machine work path”.
- the autonomous travel route generation unit 354 is based on the work implement work route (the route 384) generated in the process of step S801 and the offset direction and offset distance set by the work vehicle information setting unit 51.
- a route (working path 383A) through which the traveling machine body 2 passes in the work area 381 is generated as indicated by a thick arrow in FIG. 55 (step S802). This calculation can be based on simple geometric relationships.
- a route through which the reference point 2C of the traveling machine body 2 passes in the work area 381 may be referred to as a “traveling machine body work route”.
- the autonomous travel route generation unit 354 passes the reference point 2C of the travel aircraft 2 in the non-work area 382 so as to connect the end points of the travel aircraft work route (work route 383A) generated in the process of step S802 ( A non-work path 383B) is generated as indicated by a thick arrow in FIG. 56 (step S803).
- a path connecting the start position of the autonomous traveling and the end point of the traveling machine work path, and a path connecting the endpoint of the traveling machine work path and the end position of the autonomous traveling are also generated in the same manner.
- the route through which the traveling machine body 2 passes in the non-working area 382 is appropriately corrected within a predetermined margin as necessary from the viewpoint of preventing the end of the working machine 300 from sticking out of the field 90.
- the autonomous traveling route 383 of the traveling machine body 2 in the farm field 90 (the work area 381 and the non-work area 382) can be generated.
- autonomous traveling routes 383 there are two types of autonomous traveling routes 383 that can be generated by the autonomous traveling route generating system 399, and one of them is a folded traveling route indicated by a thick arrow in FIG.
- This return travel route is applied when the start position and end position of the autonomous travel set by the field information setting unit 52 are both ends of the field 90 as in the example of FIG. It is generated so as to work while repeating the folding between the 90 edges.
- the work machine work path is characterized in that the work machine work route shown in FIG. 54 alternates with a forward path, a return path, a forward path,... It is formed by arranging them in a row.
- the work width E2 of the work machine 300 and the like are taken into consideration so that work leakage of the work machine 300 with respect to the work area 381 does not occur and work efficiency is improved.
- the work machine work path is arranged such that the first work is performed in accordance with the above work direction from the designated start position (or the vicinity of the start position), and the work is performed at the end position (or near the end position) as much as possible. Considered as appropriate to end.
- the forward path and the return path may be replaced with a broken line or the like.
- the work machine 300 is configured to be able to change the offset direction of the mowing work unit 3A.
- the autonomous travel route generation unit 354 can change the offset direction of the mowing work unit 3A in the non-work route 383B that connects the work route 383A and the work route 383A as necessary.
- the offset direction of the mowing work unit 3A in the first and second work paths 383A from the left is the right, but in the third, the offset direction is switched to the left, and thereafter further alternate. It has been switched to.
- the autonomous traveling route 383 can be generated by a simple process by switching the offset direction of the mowing working unit 3A in the non-working route 383B.
- the circular travel route shown in FIG. 57 is generated when one of the start position and the end position of the autonomous travel set by the farm field information setting unit 52 is at the center of the farm field 90 as in the example of FIG. .
- the autonomous traveling end position is set at the center of the field 90, so that the circular traveling route circulates from the outside to the inside in an angular spiral shape as indicated by the thick arrow in FIG. Is generated.
- the starting position of autonomous traveling can be set at the center of the farm field 90 and the end position can be set at the end of the farm field 90, respectively.
- the circular traveling path is an angular spiral from the inside to the outside of the farm field 90. It is generated so as to go around.
- This circular travel route is also generated by the processing shown in FIG. Specifically, in the work area 381, a work machine work path (a path 384 indicated by a broken arrow in FIG. 57) is generated in a spiral shape with reference to the reference point 3C of the work machine 300, and the work machine work path is offset. Thus, the traveling machine work path (working path 383A) is generated (based on the reference point 2C of the traveling machine body 2). Furthermore, since the portion in the vicinity of the autonomous driving start position is a non-working area 382, the path through which the reference point 2C of the traveling machine body 2 passes in the non-working area 382 (non-working path 383B) And the end point of the traveling machine work path. As described above, it is possible to generate the circular travel route indicated by the thick arrow in FIG.
- the offset direction of the work machine 300 is not changed in the middle of the autonomous traveling route 383.
- the state in which the work machine 300 is offset from the traveling machine body 2 to the center side of the farm field 90 is maintained in the entire path of the work route from the outside to the inside of the farm field 90. ing. Therefore, since the traveling machine body 2 travels in a portion where the work by the work machine 300 has been completed, for example, in the mowing work, the work can always be performed in a state of good visibility.
- the offset direction of the work implement 300 may be changed in the middle of the autonomous travel route 383 in accordance with the work content, similarly to the return travel route.
- the work area 381 and the non-work area 382 are included in the agricultural field (traveling area) 80, but the work area 381 and the non-work area 382 may be partially overlapping areas.
- the work area 381 and the non-work area 382 partially overlap, when the tractor 1 travels N times (N is an integer of 2 or more) in the overlap area, X times (X is an integer less than N) It means that the vehicle travels without performing the work by the machine 300, and NX times travels while the work by the work machine 300 is performed. Therefore, in this embodiment, the work area 381 can be said to be an area where the tractor 1 travels with work performed by the work machine 300, and the non-work area 382 is the tractor 1 without work performed by the work machine 300. It can be said that this is a traveling area.
- the work machine 300 works on the remaining area narrower than the turning radius of the tractor 1 at the center of the farm field 90. In order to perform the above, it may be necessary to switch back (the operation of moving the tractor 1 backward once and moving it to the remaining area after being separated from the remaining area). Since this series of turning operations is not performed by the work machine 300, it can be said that the area where the series of turning operations is performed is the non-work area 382.
- the autonomous traveling route generation unit 354 generates a route based on the reference point 2C of the traveling machine body 2 instead of the reference point 3C of the work machine 300 when generating a route for performing such a switching operation.
- the autonomous travel route generation unit 354 generates a route (work machine work route) based on the reference point 3C of the work machine 300 for an area where the tractor 1 travels with work by the work machine 300, For a region in which the tractor 1 travels without work performed by the work machine 300, a route (traveling machine work route) can be generated based on the reference point 2C of the traveling machine body 2.
- the autonomous traveling route generation system 399 of the present embodiment autonomously travels the tractor 1 including the traveling machine body 2 and the work machine 300 attached to the traveling machine body 2 in the predetermined farm field 90.
- the autonomous traveling route 383 is generated.
- the autonomous traveling route generation system 399 includes a work vehicle information setting unit 51 and an autonomous traveling route generation unit 354.
- the work vehicle information setting unit 51 can set the offset direction and the offset distance of the reference point 3C of the work machine 300 with respect to the reference point 2C of the traveling machine body 2.
- the autonomous traveling route generation unit 354 can generate the autonomous traveling route 383 in the farm field 90 based on the reference point 3C of the work machine 300.
- an autonomous traveling route 383 that is shifted from the route 384 through which the reference point 3C of the work machine 300 passes and the route through which the reference point 2C of the traveling machine body 2 passes (work route 383A).
- the autonomous traveling of the tractor 1 can be applied to various work forms, for example, when traveling while weeding the field edge.
- the farm field 90 includes a work area 381 where work is performed by the work machine 300 and a non-work area 382 set around the work area 381.
- the autonomous travel route generation unit 354 generates a work route 383A in the work area 381 based on the reference point 3C of the work machine 300, and a non-work path 383B in the non-work area 382 based on the reference point 2C of the travel machine body 2. Is generated.
- the working machine 300 (the mowing working unit 3A) is offset in the work area 381 by making the reference of the position when generating the autonomous traveling route 383 different between the work area 381 and the non-work area 382. Even when working, the generation process of the autonomous traveling route 383 can be simplified in both the work area 381 and the non-work area 382.
- the autonomous traveling route generation system of the present embodiment includes a field information setting unit 52 that sets a start position and an end position of work by the tractor 1 in the field 90. As shown in FIG. 6, when both the start position and the end position are set at the end of the farm field 90 by the farm field information setting unit 52, the autonomous travel path generation unit 354 uses the edge of the farm field 90 as the autonomous travel path 383. A return travel route (FIG. 56) from the start position to the end position is generated while the return is repeated between the part and the edge. As shown in FIG.
- the autonomous traveling route generation unit 354 when one of the start position and the end position is set at the end of the farm field 90 and the other is set at the center of the farm field 90 by the farm field information setting unit 52, the autonomous traveling route generation unit 354 Then, as the autonomous traveling route 383, a spiral circular traveling route (FIG. 57) from the start position to the end position is generated.
- the return traveling route is generated.
- the autonomous travel route generation system 399 proposes the operator to generate a circular travel route by an appropriate method such as displaying a message. May be.
- the offset working machine is not limited to the mowing working machine described above, and for example, an offset plow can be used.
- the farm field 90 is set as the start position or the end position of the autonomous travel.
- the central part of the can be selected.
- the center portion of the farm field 90 may be selected as the start position or the end position of the autonomous traveling.
- the working machine 300 can be offset with respect to the traveling machine body 2 in the left direction of the machine body and the right direction of the machine body.
- the work vehicle information setting unit 51 is configured to set only the offset distance E1 (when the offset is not offset, the offset distance E1 is 0), and the autonomous travel route generation system 399 generates the autonomous travel route 383. Can be done.
- the tractor 1 in the reciprocating travel route, the tractor 1 is alternately directed in the opposite direction with respect to the work progressing direction, and in the circular travel route, the tractor 1 is always directed in the same direction with respect to the work progressing direction. ing. That is, it is highly necessary to reverse the offset direction in the reciprocating travel route, and it is less necessary to reverse the offset direction in the circular travel route. Therefore, if the generated route is a reciprocating travel route, the offset direction is reversed as necessary, and if the generated route is a circular travel route, the offset direction may not be changed (reversed) halfway. Good.
- those that can be offset only to the left and right sides may not be attached to the traveling machine body 2, but only those that can be offset to the left and right sides may be attached to the traveling machine body 2.
- the items “only left” and “only right” of “direction in which the work implement can be offset left and right” are set on the setting screen of FIG. Can be omitted.
- the non-working area 382 is determined based on the width of the headland and the width of the non-cultivated land set on the work information input screen 393, and the remaining area excluding the non-working area 382 from the field 380 A work area 381 is defined.
- the method of setting the work area 381 is not limited to the above.
- the operator designates an arbitrary point of the farm field 380 displayed on the plane display unit 88 on the farm field information input screen 392, and the work area 381 and The non-work area 382 may be set.
- the work vehicle information setting unit 51 and the autonomous travel route generation unit 354 constituting the autonomous travel route generation system 399 are provided on the wireless communication terminal 46 side. However, some or all of the work vehicle information setting unit 51 and the autonomous traveling route generation unit 354 may be provided on the tractor 1 side.
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Transportation (AREA)
- Electromagnetism (AREA)
- Multimedia (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Guiding Agricultural Machines (AREA)
Abstract
Description
初めに、本開示の第1実施形態に係る自律走行経路生成システム99について、図1から図17までを参照して説明する。
次に、本開示の第2実施形態に係る自律走行経路生成システム199について、主として図18から図34までを参照して詳細に説明する。図18は、第2実施形態に係るロボットトラクタ1及び無線通信端末46の電気系の主要な構成を示すブロック図である。以下では、第1実施形態と同様の構成の部材及びステップには同一の符号を付し、説明を適宜省略する場合がある。
次に、本開示の第3実施形態に係る自律走行経路生成システム199について、図24及び図28等を参照して説明する。以下では、第2実施形態と同様の構成の部材及びステップには同一の符号を付し、説明を適宜省略する場合がある。
次に、本開示の第4実施形態に係る自律走行経路生成システム199について、図29等を参照して説明する。以下では、第2実施形態と同様の構成の部材及びステップには同一の符号を付し、説明を適宜省略する場合がある。
上記の実施形態では障害物がないものとみなして複数の暫定走行路を含む暫定走行経路を生成し、各暫定走行路が障害物外周領域と干渉するか否かに応じて、適宜、修正して(置き換えて)走行経路を生成することとしたが、走行経路の生成方法はこれに限られるものではない。上記の実施形態において障害物がないものとみなして暫定走行経路を生成したのは、走行経路を生成する処理において、暫定走行路を迂回路を含む走行路に置き換えるか否かの判断処理(例えば図20のステップS207)が、暫定走行路を生成した後に行われるためであるが、事前に当該判断を行うことで暫定走行路を生成することなく走行路を生成することとしてもよい。
次に、本開示の第6実施形態に係る自律走行経路生成システム299について、主として図35から図44までを参照して詳細に説明する。図35は、第6実施形態に係るロボットトラクタ1及び無線通信端末46の電気系の主要な構成を示すブロック図である。
次に、本開示の第7実施形態に係る自律走行経路生成システム399について、主として図45から図57までを参照して詳細に説明する。図45は、本開示の第7実施形態に係る自律走行経路生成システム399が生成した自律走行経路93に沿って走行するロボットトラクタ1の全体的な構成を示す側面図である。
47 自律走行経路生成部(経路生成部)
54 作業領域分割部(領域分割部)
91 作業領域(走行領域)
93 自律走行経路(走行経路)
93A 作業経路(走行路)
99 自律走行経路生成システム
BP 基本単位経路数(所定値)
S 区画
SE 例外の区画
SN スキップ数(基準値)
Claims (8)
- 予め定められた走行領域内の作業領域に対して作業を行うために作業車両を自律走行させる走行経路を生成する自律走行経路生成システムであって、
前記作業領域を複数の区画に分割する領域分割部と、
前記領域分割部により分割された各区画のそれぞれに配置された複数の走行路を含むように前記走行経路を生成する経路生成部と、
を備え、
前記領域分割部は、前記各区画に含まれる前記走行路の数が互いに等しい所定値となるように前記作業領域を分割可能であることを特徴とする自律走行経路生成システム。 - 請求項1に記載の自律走行経路生成システムであって、
前記経路生成部は、前記複数の走行路に対して基準値に基づいて作業順序を設定し、
含まれる前記走行路の数が前記所定値と等しい前記区画が複数ある場合に、前記経路生成部は、当該区画の間で、互いに対応する各々の前記走行路に対して同一の作業順序を設定することを特徴とする自律走行経路生成システム。 - 請求項1又は2に記載の自律走行経路生成システムであって、
前記領域分割部は、前記作業領域に含まれる前記走行路の数が前記所定値の整数倍でない場合に、
含まれる前記走行路の数が前記所定値と等しい第1区画と、
含まれる前記走行路の数が前記所定値より大きい第2区画と、
を形成するように前記作業領域を複数の区画に分割することを特徴とする自律走行経路生成システム。 - 請求項1から3までの何れか一項に記載の自律走行経路生成システムであって、
前記走行領域内における前記作業車両の走行方向を設定する走行方向設定部と、
前記走行領域内の障害物に対して障害物外周領域を設定する障害物外周設定部と、
を備え、
前記経路生成部は、前記走行領域内において前記走行方向設定部により設定された前記走行方向に沿って設けられた複数の前記走行路を含む前記走行経路を生成可能であり、
前記経路生成部は、
前記走行方向に沿って配置される第1走行路と、
前記第1走行路の終点を始点とし、前記障害物外周領域を通過しつつ前記障害物の反対側に回って、当該障害物を貫くように前記第1走行路を延長した仮想延長線上の位置に至る迂回路と、
前記迂回路の終点を始点とし、前記仮想延長線上に配置される第2走行路と、
を含むように前記走行経路を生成することが可能であることを特徴とする自律走行経路生成システム。 - 請求項4に記載の自律走行経路生成システムであって、
前記経路生成部は、
前記迂回路の経路長が所定距離未満である場合に、前記第1走行路、前記迂回路及び前記第2走行路を含むように前記走行経路を生成し、
前記迂回路の経路長が所定距離以上である場合に、
前記第1走行路と、
前記第1走行路の終点を始点とし、前記障害物外周領域を通過しつつ前記障害物の手前で折り返す折返し路と、
前記折返し路の終点を始点とし、前記第1走行路と平行に配置される第3走行路と、
を含むように前記走行経路を生成することが可能であることを特徴とする自律走行経路生成システム。 - 請求項4に記載の自律走行経路生成システムであって、
前記経路生成部は、
前記作業車両が前記障害物を回避するために前記走行方向と垂直な向きに移動しなければならない距離である回避距離が所定距離未満である場合に、前記第1走行路、前記迂回路及び前記第2走行路を含むように前記走行経路を生成し、
前記回避距離が所定距離以上である場合に、
前記第1走行路と、
前記第1走行路の終点を始点とし、前記障害物外周領域を通過しつつ前記障害物の手前で折り返す折返し路と、
前記折返し路の終点を始点とし、前記第1走行路と平行に配置される第3走行路と、
を含むように前記走行経路を生成することが可能であることを特徴とする自律走行経路生成システム。 - 請求項4に記載の自律走行経路生成システムであって、
前記経路生成部は、
前記迂回路における旋回回数又は旋回角度が所定未満である場合に、前記第1走行路、前記迂回路及び前記第2走行路を含むように前記走行経路を生成し、
前記迂回路における前記旋回回数又は前記旋回角度が所定以上である場合に、
前記第1走行路と、
前記第1走行路の終点を始点とし、前記障害物外周領域を通過しつつ前記障害物の手前で折り返す折返し路と、
前記折返し路の終点を始点とし、前記第1走行路と平行に配置される第3走行路と、
を含むように前記走行経路を生成することが可能であることを特徴とする自律走行経路生成システム。 - 請求項4から7までの何れか一項に記載の自律走行経路生成システムであって、
前記経路生成部は、前記走行領域において前記障害物が島状に配置されている場合、前記迂回路を、前記第1走行路に至るまでの前記走行経路から見て遠い側から前記障害物の反対側に回るように生成することを特徴とする自律走行経路生成システム。
Priority Applications (6)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201780027984.4A CN109074081A (zh) | 2016-05-10 | 2017-04-07 | 自主行驶路径生成系统 |
KR1020207017172A KR20200075029A (ko) | 2016-05-10 | 2017-04-07 | 자율 주행 경로 생성 시스템 |
KR1020207004115A KR102126168B1 (ko) | 2016-05-10 | 2017-04-07 | 자율 주행 경로 생성 시스템 |
KR1020217003434A KR102283928B1 (ko) | 2016-05-10 | 2017-04-07 | 자율 주행 경로 생성 시스템 |
KR1020187026558A KR102079890B1 (ko) | 2016-05-10 | 2017-04-07 | 자율 주행 경로 생성 시스템 |
CN202210633017.5A CN114995427A (zh) | 2016-05-10 | 2017-04-07 | 自主行驶路径生成系统 |
Applications Claiming Priority (8)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016094515A JP6739228B2 (ja) | 2016-05-10 | 2016-05-10 | 自律走行経路生成システム |
JP2016094513A JP6739227B2 (ja) | 2016-05-10 | 2016-05-10 | 自律走行経路生成システム |
JP2016-094515 | 2016-05-10 | ||
JP2016-094513 | 2016-05-10 | ||
JP2016-102978 | 2016-05-24 | ||
JP2016-102980 | 2016-05-24 | ||
JP2016102978A JP6692692B2 (ja) | 2016-05-24 | 2016-05-24 | 自律走行経路生成システム |
JP2016102980A JP6682354B2 (ja) | 2016-05-24 | 2016-05-24 | 自律走行経路生成システム |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2017195510A1 true WO2017195510A1 (ja) | 2017-11-16 |
Family
ID=60267829
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2017/014436 WO2017195510A1 (ja) | 2016-05-10 | 2017-04-07 | 自律走行経路生成システム |
Country Status (3)
Country | Link |
---|---|
KR (4) | KR20200075029A (ja) |
CN (2) | CN109074081A (ja) |
WO (1) | WO2017195510A1 (ja) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109857096A (zh) * | 2017-11-30 | 2019-06-07 | 井关农机株式会社 | 作业车辆 |
CN115290095A (zh) * | 2022-09-28 | 2022-11-04 | 陕西耕辰科技有限公司 | 一种农机作业路径自动规划方法、系统、农机及存储介质 |
US20230069372A1 (en) * | 2021-08-27 | 2023-03-02 | Kubota Corporation | Travel Control System |
EP4218390A1 (en) * | 2018-05-25 | 2023-08-02 | The Toro Company | Autonomous grounds maintenance machines with path planning for trap and obstacle avoidance |
Families Citing this family (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7075695B2 (ja) * | 2019-02-22 | 2022-05-26 | 株式会社ナイルワークス | ドローン操縦機、および、操縦用プログラム |
KR102049937B1 (ko) * | 2019-03-11 | 2019-11-28 | 엘에스엠트론 주식회사 | 농작업차량 자동제어 시스템 |
CN110209154B (zh) * | 2019-04-09 | 2022-10-14 | 丰疆智能科技股份有限公司 | 自动收割机的残留收割路径规划系统及其方法 |
CN110057364B (zh) * | 2019-04-30 | 2020-08-07 | 盐城工业职业技术学院 | 一种水田拖拉机位姿检测和偏航角提取方法及装置 |
KR102168104B1 (ko) * | 2019-05-24 | 2020-10-21 | 장진만 | 농업용기계의 자율 주행 방법 |
CN110502021B (zh) * | 2019-09-24 | 2022-07-15 | 一米信息服务(北京)有限公司 | 一种农机作业路径规划方法及系统 |
JP7237788B2 (ja) * | 2019-09-26 | 2023-03-13 | 株式会社クボタ | 作業車両 |
JP7358163B2 (ja) * | 2019-09-30 | 2023-10-10 | 株式会社小松製作所 | 制御システム、作業車両の制御方法、および、作業車両 |
KR102304098B1 (ko) * | 2019-11-05 | 2021-09-23 | 대한민국 | 영상 기반 경로 인식 및 조향각 산출 기술을 지원하는 자율 주행 농기계 장치 및 그 동작 방법 |
CN110825091A (zh) * | 2019-11-29 | 2020-02-21 | 洛阳中科龙网创新科技有限公司 | 一种基于无人机的智能拖拉机智能选路方法及装置 |
CN112868367B (zh) * | 2019-11-29 | 2024-07-09 | 株式会社久保田 | 自动行驶控制系统、联合收割机、收获机 |
CN112868366A (zh) * | 2019-11-29 | 2021-06-01 | 株式会社久保田 | 自动行驶控制系统、自动行驶路径生成系统、联合收割机 |
CN113448324B (zh) * | 2020-03-09 | 2023-08-04 | 北京合众思壮科技股份有限公司 | 路径规划方法、装置、电子设备和存储介质 |
SE2050727A1 (en) * | 2020-06-17 | 2021-12-18 | Husqvarna Ab | Methods of navigating a self-propelled robotic tool, and robotic tools, and computer pograms implementing such methods |
CN111854744A (zh) * | 2020-07-17 | 2020-10-30 | 无锡卡尔曼导航技术有限公司 | 一种gnss单点定位和惯性导航割草机的运行方法 |
CN114475602B (zh) * | 2020-11-12 | 2023-05-09 | 宇通客车股份有限公司 | 一种车辆、车辆调头方法及装置 |
CN115016451B (zh) * | 2021-03-05 | 2024-10-29 | 广东博智林机器人有限公司 | 机器人作业轨迹规划方法、装置、计算机设备和存储介质 |
US11622495B2 (en) | 2021-06-01 | 2023-04-11 | Gint Co., Ltd. | Method of automatically combining farm vehicle and work machine and farm vehicle |
CN113678587B (zh) * | 2021-08-09 | 2023-04-14 | 华南农业大学 | 一种无人驾驶水稻中耕除草机及其作业方法 |
CN113804212B (zh) * | 2021-08-23 | 2022-07-26 | 上海联适导航技术股份有限公司 | 一种耙地作业的路径规划方法及装置 |
KR102691506B1 (ko) | 2021-10-06 | 2024-08-05 | 대한민국 | 농기계 제어를 위한 자율 주행 장치, 이를 포함하는 농기계 및 자율 주행 방법 |
KR102669118B1 (ko) * | 2021-12-29 | 2024-05-24 | 재단법인대구경북과학기술원 | 농업용 자율 주행 차량 관제 장치 및 방법 |
KR102592085B1 (ko) * | 2023-02-02 | 2023-10-20 | 주식회사 긴트 | 농업용 차량의 정밀한 자율주행을 위한 ab주행 기준선 이동 가이드 시스템 및 이의 운용방법 |
CN116149337B (zh) * | 2023-04-14 | 2023-07-07 | 未岚大陆(北京)科技有限公司 | 割草控制方法、设置方法、割草机、设置装置和电子设备 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH1165657A (ja) * | 1997-08-22 | 1999-03-09 | Minolta Co Ltd | 移動体の制御装置 |
JP2003114719A (ja) * | 2001-08-03 | 2003-04-18 | Sanyo Electric Co Ltd | 自走ロボット |
JP2003345437A (ja) * | 2002-05-22 | 2003-12-05 | Toshiba Tec Corp | 自律走行ロボット |
JP2016021181A (ja) * | 2014-07-15 | 2016-02-04 | シャープ株式会社 | 自走式電子機器 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4543247B2 (ja) * | 2003-12-25 | 2010-09-15 | 井関農機株式会社 | 田植機 |
JP4999965B2 (ja) * | 2010-06-04 | 2012-08-15 | 中国電力株式会社 | 自動耕作方法、及び自動耕作システム |
CN102167038B (zh) * | 2010-12-03 | 2013-09-04 | 北京农业信息技术研究中心 | 农田地块全区域覆盖最优作业路径生成方法及装置 |
WO2015118731A1 (ja) | 2014-02-06 | 2015-08-13 | ヤンマー株式会社 | 併走作業システムの制御装置 |
JP5667731B1 (ja) * | 2014-03-06 | 2015-02-12 | ジオサーフ株式会社 | 圃場ガイダンスシステム及び圃場ガイダンス方法並びにソフトウェア及びソフトウェアを格納した記憶媒体 |
JP6189779B2 (ja) * | 2014-03-27 | 2017-08-30 | 株式会社クボタ | 作業車協調システム |
JP6339427B2 (ja) | 2014-03-31 | 2018-06-06 | ヤンマー株式会社 | 併走作業システム |
-
2017
- 2017-04-07 KR KR1020207017172A patent/KR20200075029A/ko active Application Filing
- 2017-04-07 KR KR1020207004115A patent/KR102126168B1/ko active IP Right Grant
- 2017-04-07 WO PCT/JP2017/014436 patent/WO2017195510A1/ja active Application Filing
- 2017-04-07 CN CN201780027984.4A patent/CN109074081A/zh active Pending
- 2017-04-07 CN CN202210633017.5A patent/CN114995427A/zh active Pending
- 2017-04-07 KR KR1020217003434A patent/KR102283928B1/ko active IP Right Grant
- 2017-04-07 KR KR1020187026558A patent/KR102079890B1/ko active Application Filing
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH1165657A (ja) * | 1997-08-22 | 1999-03-09 | Minolta Co Ltd | 移動体の制御装置 |
JP2003114719A (ja) * | 2001-08-03 | 2003-04-18 | Sanyo Electric Co Ltd | 自走ロボット |
JP2003345437A (ja) * | 2002-05-22 | 2003-12-05 | Toshiba Tec Corp | 自律走行ロボット |
JP2016021181A (ja) * | 2014-07-15 | 2016-02-04 | シャープ株式会社 | 自走式電子機器 |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109857096A (zh) * | 2017-11-30 | 2019-06-07 | 井关农机株式会社 | 作业车辆 |
JP2019097454A (ja) * | 2017-11-30 | 2019-06-24 | 井関農機株式会社 | 作業車両 |
CN109857096B (zh) * | 2017-11-30 | 2024-10-29 | 井关农机株式会社 | 作业车辆 |
EP4218390A1 (en) * | 2018-05-25 | 2023-08-02 | The Toro Company | Autonomous grounds maintenance machines with path planning for trap and obstacle avoidance |
US11832553B2 (en) | 2018-05-25 | 2023-12-05 | The Toro Company | Autonomous grounds maintenance machines with path planning for trap and obstacle avoidance |
US20230069372A1 (en) * | 2021-08-27 | 2023-03-02 | Kubota Corporation | Travel Control System |
CN115290095A (zh) * | 2022-09-28 | 2022-11-04 | 陕西耕辰科技有限公司 | 一种农机作业路径自动规划方法、系统、农机及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
KR102283928B1 (ko) | 2021-07-29 |
KR20210016086A (ko) | 2021-02-10 |
KR20180116319A (ko) | 2018-10-24 |
KR20200075029A (ko) | 2020-06-25 |
KR102079890B1 (ko) | 2020-02-20 |
KR20200018732A (ko) | 2020-02-19 |
CN114995427A (zh) | 2022-09-02 |
CN109074081A (zh) | 2018-12-21 |
KR102126168B1 (ko) | 2020-06-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2017195510A1 (ja) | 自律走行経路生成システム | |
JP6682354B2 (ja) | 自律走行経路生成システム | |
JP6663366B2 (ja) | 経路生成システム、及びそれによって生成された経路に沿って作業車両を走行させる自律走行システム | |
JP6692692B2 (ja) | 自律走行経路生成システム | |
KR102144244B1 (ko) | 경로 생성 장치 | |
JP6832660B2 (ja) | 経路生成システム | |
JP6739228B2 (ja) | 自律走行経路生成システム | |
WO2017154715A1 (ja) | 作業車両および走行領域特定装置 | |
JP6440647B2 (ja) | 自律走行システム | |
JP6947872B2 (ja) | 自律走行システム | |
JP6854312B2 (ja) | 走行領域特定装置 | |
JP2021112203A (ja) | 作業車両 | |
JP6739227B2 (ja) | 自律走行経路生成システム | |
JP7022161B2 (ja) | 自律走行システム | |
JP6708724B2 (ja) | 自律走行システム | |
JP7492043B2 (ja) | 自律走行システム及び作業経路の生成方法 | |
JP2020109693A (ja) | 自律走行経路生成システム | |
JP6997889B2 (ja) | 経路生成システム | |
JP7179891B2 (ja) | 走行領域特定システム、走行領域特定方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
ENP | Entry into the national phase |
Ref document number: 20187026558 Country of ref document: KR Kind code of ref document: A |
|
WWE | Wipo information: entry into national phase |
Ref document number: 1020187026558 Country of ref document: KR |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 17795871 Country of ref document: EP Kind code of ref document: A1 |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 17795871 Country of ref document: EP Kind code of ref document: A1 |