WO2017195510A1 - 自律走行経路生成システム - Google Patents

自律走行経路生成システム Download PDF

Info

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
Application number
PCT/JP2017/014436
Other languages
English (en)
French (fr)
Inventor
敏史 平松
Original Assignee
ヤンマー株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Priority claimed from JP2016094515A external-priority patent/JP6739228B2/ja
Priority claimed from JP2016094513A external-priority patent/JP6739227B2/ja
Priority claimed from JP2016102980A external-priority patent/JP6682354B2/ja
Priority claimed from JP2016102978A external-priority patent/JP6692692B2/ja
Application filed by ヤンマー株式会社 filed Critical ヤンマー株式会社
Priority to KR1020207017172A priority Critical patent/KR20200075029A/ko
Priority to KR1020187026558A priority patent/KR102079890B1/ko
Priority to KR1020217003434A priority patent/KR102283928B1/ko
Priority to CN202210633017.5A priority patent/CN114995427A/zh
Priority to KR1020207004115A priority patent/KR102126168B1/ko
Priority to CN201780027984.4A priority patent/CN109074081A/zh
Publication of WO2017195510A1 publication Critical patent/WO2017195510A1/ja

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0219Control 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
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246Control 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/0253Control 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
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0257Control 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)
  • Automation & Control Theory (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Transportation (AREA)
  • Human Computer Interaction (AREA)
  • Mechanical Engineering (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Multimedia (AREA)
  • Electromagnetism (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Guiding Agricultural Machines (AREA)

Abstract

自律走行経路生成システムは、予め定められた作業領域(91)に対して作業を行うためにトラクタを自律走行させる自律走行経路(93)を生成する。自律走行経路生成システムは、作業領域分割部と、自律走行経路生成部と、を備える。作業領域分割部は、作業領域(91)を複数の区画(S)に分割する。自律走行経路生成部は、作業領域分割部により分割された各区画(S)のそれぞれに配置された複数の作業経路(93A)を含むように自律走行経路(93)を生成する。作業領域分割部は、各区画(S)に含まれる作業経路(93A)の数が互いに等しい基本単位経路数(スキップ数が1の場合、5つ)となるように作業領域(91)を分割可能である。

Description

自律走行経路生成システム
 本発明は、作業車両を自律走行させるための走行経路を生成する自律走行経路生成システムに関する。
 従来から、予め生成された走行経路に従って作業車両を自律走行させる自律走行システムが知られている。特許文献1は、この種の自律走行システムを開示する。この特許文献1に開示される農業用作業車両は、GPS衛星から送信される電波を受信して移動通信機において設定時間間隔で機体の位置情報を求め、ジャイロセンサ及び方位センサから機体の変位情報および方位情報を求め、これら位置情報と変位情報と方位情報に基づいて機体が予め設定した設定経路に沿って走行するように、操舵アクチュエータ、変速手段、昇降アクチュエータ、PTO入切手段、エンジンコントローラ等を制御して自動走行しながら自動で作業するための自動走行手段としての制御装置を備えている。
特開2015-201155号公報
 農業用作業車両が圃場において自律走行しつつ作業を行う場合、特許文献1でも開示されているが、等間隔で並べられた複数の直線状の作業経路を、並べられる方向の一側の端から他側の端まで1つずつ順番に走行して作業を行うことが広く行われている。このとき、農業用作業車両は、ある作業経路について作業を完了した後、圃場の縁部で折り返して走行方向を反転させ、当該作業経路に隣接する作業経路について作業を行う。
 しかしながら、このような走行経路では、上記の折返しの際に、作業車両の最小旋回半径等の事情により、前後の切返しを伴う旋回が必要になって効率を低下させることがある。そこで、農業用作業車両が、ある作業経路について作業を完了した後、当該作業経路の隣の作業経路ではなく1~2本程度飛ばした作業経路について作業を行うように走行することが考えられる(スキップ走行)。この場合の農業用作業車両の走行経路としては、例えば、複数並べられる作業経路について、並べられる方向の一側の端から当該作業経路を1つ飛ばして走行して他側の端まで到達し、その後、残りの作業経路を(作業済の作業経路を飛ばして)走行しながら当該一側に戻るように生成される。
 しかしながら、広い圃場でスキップ走行をしながら作業を行う場合において、何らかの事情により作業を途中で中断すると、作業済の箇所と未作業の箇所とが交互に現れる部分が広範囲にわたって生じることがあった。この場合、圃場における作業済の箇所及び未作業の箇所のそれぞれをまとまった領域として把握することが難しくなって、作業の円滑な再開が困難になってしまう。また、作業の中断前後で雨等により土壌環境が変化した場合に、作業品質が異なる部分が櫛歯状に生じて、その後の作業効率を低下させることがあった。
 ところで、上記のように農業用作業車両を自律走行させる構成は、特に圃場が広大であると、省力化等の効果を良好に発揮する。しかし、例えば1日で作業を完了させることができない程広い圃場においては、上記のような作業の中断を考慮しなければならず、改善の余地が残されていた。
 本発明は以上の事情に鑑みてされたものであり、その潜在的な目的は、スキップ走行による作業を行うときに、作業が途中で中断した場合でも、作業済の箇所と未作業の箇所とが交互に現れる部分が広範囲に生じることを防止できる自律走行経路生成システムを提供することにある。
課題を解決するための手段及び効果
 本発明の解決しようとする課題は以上の如くであり、次にこの課題を解決するための手段とその効果を説明する。
 本開示の第1の観点によれば、以下の構成の自律走行経路生成システムが提供される。即ち、この自律走行経路生成システムは、予め定められた作業領域に対して作業を行うために作業車両を自律走行させる走行経路を生成する。この自律走行経路生成システムは、領域分割部と、経路生成部と、を備える。前記領域分割部は、前記作業領域を複数の区画に分割する。前記経路生成部は、前記領域分割部により分割された各区画のそれぞれに配置された複数の走行路を含むように前記走行経路を生成する。前記領域分割部は、前記各区画に含まれる前記走行路の数が互いに等しい所定値となるように前記作業領域を分割可能である。
 これにより、スキップ走行による作業を行う場合でも、分割された小さな区画を単位として、作業領域の端から順番に作業していくことができる。従って、作業が途中で中断した場合でも、作業領域において作業済みの箇所と未作業の箇所が交互に現れる部分を、区画内の小さな範囲に留めることができる。従って、作業済みの箇所が明確になり易く、円滑に作業の再開を行うことができる。また、作業の中断前後で雨等により土壌環境が変化した場合でも、作業品質が異なる部分が広範囲にわたって櫛歯状に生じるのを防止することができる。
 前記の自律走行経路生成システムにおいては、以下の構成とすることが好ましい。即ち、前記経路生成部は、前記複数の走行路に対して基準値に基づいて作業順序を設定する。含まれる前記走行路の数が前記所定値と等しい前記区画が複数ある場合に、前記経路生成部は、当該区画の間で、互いに対応する各々の前記走行路に対して同一の作業順序を設定する。
 これにより、区画を単位として一定の作業順序を走行路に対して設定することができるので、規則的なスキップ走行を実現できるとともに、走行経路の生成処理を簡略化することができる。
 前記の自律走行経路生成システムにおいては、以下の構成とすることが好ましい。即ち、前記領域分割部は、前記作業領域に含まれる前記走行路の数が前記所定値の整数倍でない場合に、第1区画と、第2区画と、を形成するように前記作業領域を複数の区画に分割する。前記第1区画に含まれる前記走行路の数は、前記所定値と等しい。前記第2区画に含まれる前記走行路の数は、前記所定値より大きい。
 これにより、含まれる走行路の数が所定値に満たない区画が生じなくなるので、スキップ走行を伴う走行経路を容易に生成することができる。
 本開示の第2の観点によれば、以下の構成の自律走行経路生成システムが提供される。即ち、この自律走行経路生成システムは、走行方向設定部と、障害物外周設定部と、を備える。前記走行方向設定部は、前記走行領域内における前記作業車両の走行方向を設定する。前記障害物外周設定部は、前記走行領域内の障害物に対して障害物外周領域を設定する。前記経路生成部は、前記走行領域内において前記走行方向設定部により設定された前記走行方向に沿って設けられた複数の前記走行路を含む前記走行経路を生成可能である。前記経路生成部は、第1走行路と、迂回路と、第2走行路と、を含むように前記走行経路を生成することが可能である。前記第1走行路は、前記走行方向に沿って配置される。前記迂回路は、前記第1走行路の終点を始点とし、前記障害物外周領域を通過しつつ前記障害物の反対側に回って、当該障害物を貫くように前記第1走行路を延長した仮想延長線上の位置に至る。前記第2走行路は、前記迂回路の終点を始点とし、前記仮想延長線上に配置される。
 これにより、第1走行路と、迂回路と、第2走行路とを含む走行経路が生成される。よって、この走行経路に沿って作業車両を自律走行させることにより、障害物を迂回するように作業車両を走行させることが可能である。しかも、迂回路は事前に設定された障害物外周領域を通過するように配置されるので、走行経路全体との関係等を考慮して迂回路を計画的に生成することで、作業車両による作業を円滑にすることができる。また、迂回路以外の部分では、走行経路を走行方向に沿った経路とすることができ、自律走行経路生成のアルゴリズムをシンプルにすることができる。
 前記の自律走行経路生成システムにおいては、以下の構成とすることが好ましい。即ち、前記経路生成部は、前記迂回路の経路長が所定距離未満である場合に、前記第1走行路、前記迂回路及び前記第2走行路を含むように前記走行経路を生成することが可能である。一方、前記経路生成部は、前記迂回路の経路長が所定距離以上である場合に、前記第1走行路、折返し路及び第3走行路を含むように前記走行経路を生成することが可能である。前記折返し路は、前記第1走行路の終点を始点とし、前記障害物外周領域を通過しつつ前記障害物の手前で折り返す。前記第3走行路は、前記折返し路の終点を始点とし、前記第1走行路と平行に配置される。
 これにより、迂回路の経路長が所定距離以上になる場合には、障害物を迂回する経路に代えて、障害物の手前で折り返す経路を走行経路として生成することができる。従って、走行経路のうち作業に寄与しない部分が過剰に長くなってしまうことを防止できる。
 前記の自律走行経路生成システムにおいては、以下の構成とすることが好ましい。即ち、前記経路生成部は、前記作業車両が前記障害物を回避するために前記走行方向と垂直な向きに移動しなければならない距離である回避距離が所定距離未満である場合に、前記第1走行路、前記迂回路及び前記第2走行路を含むように前記走行経路を生成することが可能である。一方、前記経路生成部は、前記回避距離が所定距離以上である場合に、前記第1走行路、折返し路及び第3走行路を含むように走行経路を生成することが可能である。前記折返し路は、前記第1走行路の終点を始点とし、前記障害物外周領域を通過しつつ前記障害物の手前で折り返す。前記第3走行路は、前記折返し路の終点を始点とし、前記第1走行路と平行に配置される。
 これにより、障害物を迂回するために走行方向と垂直な向きに移動しなければならない回避距離が所定距離以上になる場合には、障害物を迂回する経路に代えて、障害物の手前で折り返す経路を走行経路として生成することができる。従って、走行経路のうち作業に寄与しない部分が過剰に長くなってしまうことを防止できる。
 前記の自律走行経路生成システムにおいては、以下の構成とすることが好ましい。即ち、前記経路生成部は、前記迂回路における旋回回数又は旋回角度が所定未満である場合に、前記第1走行路、前記迂回路及び前記第2走行路を含むように前記走行経路を生成することが可能である。一方、前記経路生成部は、前記迂回路における前記旋回回数又は前記旋回角度が所定以上である場合に、前記第1走行路、折返し路及び第3走行路を含むように前記走行経路を生成することが可能である。前記折返し路は、前記第1走行路の終点を始点とし、前記障害物外周領域を通過しつつ前記障害物の手前で折り返す。前記第3走行路は、前記折返し路の終点を始点とし、前記第1走行路と平行に配置される。
 これにより、障害物を迂回するために必要となる旋回回数又は旋回角度が所定以上である場合には、障害物を迂回する経路に代えて、障害物の手前で折り返す経路を走行経路として生成することができる。従って、旋回回数又は旋回角度が多い走行経路を生成してしまうことを防止できるので、作業を円滑に行うことができる。
 前記の自律走行経路生成システムにおいては、前記経路生成部は、前記走行領域において前記障害物が島状に配置されている場合、前記迂回路を、前記第1走行路に至るまでの前記走行経路から見て遠い側から前記障害物の反対側に回るように生成することが好ましい。
 これにより、作業車両を走行経路に沿って走行させても、障害物を迂回するときに、第1走行路に至るまでに作業車両が走行してきた領域に再度踏み込むことがない。よって、作業車両に行わせた作業に影響が出ないように、障害物を回避して作業車両を走行させることができる。
 本開示の第3の観点によれば、以下の構成の自律走行経路生成システムが提供される。即ち、この自律走行経路生成システムは、経路生成部と、記憶部と、外部環境情報取得部と、補正情報算出部と、補正経路生成部と、を備える。前記経路生成部は、前記走行経路を生成する。前記記憶部は、前記経路生成部が生成した前記走行経路を記憶する。前記外部環境情報取得部は、前記作業車両に設けられ、前記走行領域内における外部環境情報を取得する。前記補正情報算出部は、前記外部環境情報取得部が取得した前記外部環境情報に基づいて、前記走行経路を補正するための補正情報を算出する。前記補正経路生成部は、前記補正情報算出部が算出した前記補正情報に基づいて前記走行経路を補正した補正経路を生成し、前記記憶部に記憶する。
 これにより、作業車両に設けられた外部環境情報取得部で取得された外部環境情報に基づいて走行経路が補正される。従って、予め生成された走行経路を現在の環境等に基づいて補正できる。また、補正経路を記憶部に記憶することで、次回以降に走行経路を補正する手間をなくすことができる。
 前記の自律走行経路生成システムにおいては、以下の構成とすることが好ましい。即ち、この自律走行経路生成システムは、前記作業車両の絶対位置を算出する位置情報算出部を備える。前記補正情報算出部は、前記外部環境情報により特定される特定対象が前記作業車両による作業を阻害する場合に、前記位置情報算出部が算出した前記作業車両の位置と、前記特定対象の位置と、に基づいて前記補正情報を算出する。
 これにより、特定対象が作業車両の作業を阻害する場合に、当該特定対象の有無又は位置ズレ等を検出して、当該ズレ等を補正した補正経路を生成できる。
 前記の自律走行経路生成システムにおいては、以下の構成とすることが好ましい。即ち、この自律走行経路生成システムは、前記作業車両の絶対位置を算出する位置情報算出部を備える。前記補正情報算出部は、前記外部環境情報により特定される特定対象の位置が前記記憶部に予め登録された位置と閾値以上異なる、又は、当該特定対象が前記記憶部に登録されていない場合に、前記位置情報算出部が算出した前記作業車両の位置と、前記特定対象の位置と、に基づいて前記補正情報を算出する。
 これにより、特定対象の位置がズレていたり、登録されていない特定対象が存在した場合に、走行経路を補正することができる。
 本開示の第4の観点によれば、以下の構成の自律走行経路生成システムが提供される。即ち、予め定められた走行領域において、車体部と前記車体部に装着される作業機を備える作業車両を自律走行させるための走行経路を生成する。この自律走行経路生成システムは、オフセット設定部と、経路生成部と、を備える。前記オフセット設定部は、前記車体部の基準点に対する前記作業機の基準点のオフセット方向及びオフセット距離を設定可能である。前記経路生成部は、前記作業機の基準点に基づいて前記走行領域内における前記走行経路を生成可能である。
 これにより、作業機の基準点が通る経路と車体部の基準点が通る経路とをズラした走行経路を生成することができる。その結果、作業車両の自律走行を、例えば圃場端を除草しながら走行する場合等、様々な作業形態に適用することができる。
 前記の自律走行経路生成システムにおいては、以下の構成とすることが好ましい。即ち、前記走行領域は、前記作業機により作業が行われる第1領域と、前記第1領域の周囲に設定される第2領域と、を含む。前記経路生成部は、前記作業機の基準点に基づいて前記第1領域内における前記走行経路を生成し、前記車体部の基準点に基づいて前記第2領域内における前記走行経路を生成する。
 このように、自律走行経路を生成するときの位置の基準を作業領域と非作業領域との間で異ならせることで、作業領域において作業機を走行機体に対して左右方向にオフセットさせて作業する場合でも、作業領域及び非作業領域の両方において、自律走行経路の生成処理を単純化することができる。
 前記の自律走行経路生成システムにおいては、以下の構成とすることが好ましい。即ち、この自律走行経路生成システムは、前記走行領域における前記作業車両による作業の開始位置及び終了位置を設定する開始終了位置設定部を備える。前記開始終了位置設定部により前記開始位置及び前記終了位置の両方が前記走行領域の端部に設定された場合、前記経路生成部は、前記走行経路として、前記走行領域の縁部と縁部の間で折返しを反復しながら前記開始位置から前記終了位置に向かう折返し走行経路を生成する。前記開始終了位置設定部により前記開始位置及び前記終了位置の一方が前記走行領域の端部に設定され、他方が前記走行領域の中央部に設定された場合、前記経路生成部は、前記走行経路として、前記開始位置から前記終了位置に向かう渦巻き状の周回走行経路を生成する。
 これにより、2種類の自律走行経路から作業内容等に応じて適宜選択して生成することができるので、作業効率を向上させることができる。
圃場において生成された自律走行経路に沿ってロボットトラクタが自律走行・自律作業を行う様子を示す概念図。 本開示の第1実施形態に係る自律走行経路生成システムが生成した自律走行経路に沿って走行するロボットトラクタの全体的な構成を示す側面図。 ロボットトラクタの平面図。 自律走行経路生成システムの主要な構成が備えられる無線通信端末を示す図。 第1実施形態に係るロボットトラクタ及び無線通信端末の電気系の主要な構成を示すブロック図。 無線通信端末に表示される作業車両情報入力画面の表示例を示す図。 無線通信端末に表示される圃場情報入力画面の表示例を示す図。 無線通信端末に表示される作業情報入力画面の表示例を示す図。 自律走行経路を生成するときに自律走行経路生成部で行われる処理を示すフローチャート。 スキップ走行を行う自律走行経路を生成するために、作業領域に複数の作業経路が配置される様子を示す図。 スキップ走行を行う場合に作業の単位となる、特定の数の作業経路からなるグループを示す図。 作業領域が分割されて複数の区画が生成される様子を示す図。 作業領域が分割されて、作業経路の数が特定の数より大きい例外の区画を含む複数の区画が生成される様子を示す図。 作業経路の作業順序が決定された様子を示す図。 図14で決定された作業順序に基づいて自律走行経路が生成される様子を示す図。 非作業領域においてトラクタが複数回の旋回を行う例を示す図。 非作業領域においてトラクタが複数回の旋回及び切り返しを行う例を示す図。 第2実施形態に係るロボットトラクタ及び無線通信端末の電気系の主要な構成を示すブロック図。 無線通信端末に表示される、ロボットトラクタが走行する圃場に関する情報を入力するための画面の一例を示す図。 走行経路を生成するときに経路生成部で行われる処理を示すフローチャート。 図20の処理の続きを示すフローチャート。 複数の暫定走行路を並べた暫定走行経路を生成した例を示す図。 1つの暫定走行路に関して第1走行路を生成している様子を示す図。 1つの暫定走行路に関して、迂回路及び第2走行路を生成している様子を示す図。 障害物を迂回することにより障害物を回避する走行経路を生成した例を示す図。 1つの第1走行路に関して、折返し路及び第3走行路を生成している様子を示す図。 障害物の手前で折り返すことにより障害物を回避する走行経路を生成した例を示す図。 第3実施形態において、走行経路を生成するときに経路生成部で行われる処理を示すフローチャート。 第4実施形態において、走行経路を生成するときに経路生成部で行われる処理を示すフローチャート。 障害物を回避することにより無人トラクタが有人トラクタに接近するおそれがある場合に、無線通信端末のディスプレイに表示される警告画面の表示例を示す図。 障害物が圃場の端部から中央に向けて突出するように配置されている例を示す図。 凹状の部分が圃場の輪郭に形成されている例を示す図。 折れ線状の1つの暫定走行路に関して、迂回路を生成している様子を示す図。 第5実施形態において、走行経路を生成するときに経路生成部で行われる処理を簡易的に示すフローチャート。 本開示の第6実施形態に係るロボットトラクタ及び無線通信端末の電気系の主要な構成を示すブロック図。 畝を検出して補正経路を生成する処理を示すフローチャート。 予め記憶部に記憶された走行経路を示す図。 畝の位置が幅方向にズレている様子を示す図。 幅方向にオフセットした補正経路を示す図。 畝が形成される方向がズレている様子を示す図。 角度を補正した補正経路を示す図。 障害物を検出して補正経路を生成する処理を示すフローチャート。 未登録の障害物が存在する様子を示す図。 未登録の障害物の手前で折り返す補正経路を示す図。 本開示の第7実施形態に係る自律走行経路生成システムが生成した自律走行経路に沿って走行するロボットトラクタの全体的な構成を示す側面図。 ロボットトラクタの平面図。 ロボットトラクタの電気系の主要な構成を示すブロック図。 自律走行経路生成システムを備えた無線通信端末の電気系の主要な構成を示すブロック図。 作業機を走行機体の左右一側にオフセットさせた場合において、作業機の基準点と走行機体の基準点との位置関係を示す模式図。 無線通信端末のディスプレイにおける作業車両情報入力画面の表示例を示す図。 無線通信端末のディスプレイにおける圃場情報入力画面の別の表示例を示す図。 無線通信端末のディスプレイにおける作業情報入力画面の表示例を示す図。 自律走行経路を生成する処理を示すフローチャート。 折返し走行経路を生成するために、作業領域における作業機の経路が生成される様子を示した図。 作業領域における走行機体の経路が生成される様子を示した図。 非作業領域における走行機体の経路が生成され、折返し走行経路が完成する様子を示す図。 周回走行経路が生成される様子を示した図。
 次に、図面を参照して本開示の実施の形態を説明する。以下では、図面の各図において同一の部分には同一の符号を付し、重複する説明を省略することがある。また、同一の符号に対応する部材等の名称が、簡略的に言い換えられたり、上位概念又は下位概念の名称で言い換えられたりすることがある。
 本開示は、予め定められた圃場内で1台又は複数台の作業車両を走行させて、圃場内における農作業の全部又は一部を実行させるときに、作業車両を自律走行させるための走行経路を生成する自律走行経路生成システムに関する。本実施形態では作業車両としてトラクタを例に説明するが、作業車両としては、トラクタの他、田植機、コンバイン、土木・建築作業装置、除雪車等、乗用型作業機に加え、歩行型作業機も含まれる。本明細書において自律走行とは、トラクタが備える走行に関する構成がトラクタの制御部(ECU)により制御されて、予め定められた経路に沿ってトラクタが走行することを意味し、自律作業とは、トラクタが備える作業に関する構成が前記制御部により制御されて、予め定められた経路に沿ってトラクタが作業を行うことを意味する。これに対して、手動走行・手動作業とは、トラクタが備える各構成がオペレータにより操作され、走行・作業が行われることを意味する。
 以下の説明では、自律走行・自律作業されるトラクタを「無人(の)トラクタ」又は「ロボットトラクタ」と称することがあり、手動走行・手動作業されるトラクタを「有人(の)トラクタ」と称することがある。圃場内において農作業の一部が無人トラクタにより実行される場合、残りの農作業は有人トラクタにより実行される。単一の圃場における農作業を無人トラクタ及び有人トラクタで実行することを、農作業の協調作業、追従作業、随伴作業等と称することがある。無人トラクタと有人トラクタは、互いに異なる構成とすることもでき、共通の構成とすることもできる。無人トラクタと有人トラクタの構成が共通である場合、無人トラクタであってもオペレータが搭乗(乗車)して操作することが可能であり(即ち有人トラクタとして使用することができ)、或いは有人トラクタであってもオペレータが降車して自律走行・自律作業させることが可能である(即ち、無人トラクタとして使用することができる)。なお、農作業の協調作業としては、「単一圃場における農作業を無人車両及び有人車両で実行すること」に加え、「隣接する圃場等の異なる圃場における農作業を同時期に無人車両及び有人車両で実行すること」が含まれてもよい。
 <第1実施形態>
 初めに、本開示の第1実施形態に係る自律走行経路生成システム99について、図1から図17までを参照して説明する。
 図1は、圃場90において生成された自律走行経路93に沿ってロボットトラクタ1が自律走行・自律作業を行う様子を示す概念図である。図2は、本開示の第1実施形態に係る自律走行経路生成システム99が生成した自律走行経路93に沿って走行するロボットトラクタ1の全体的な構成を示す側面図である。図3は、ロボットトラクタ1の平面図である。図4は、自律走行経路生成システム99の主要な構成が備えられる無線通信端末46を示す図である。図5は、ロボットトラクタ1及び無線通信端末46の電気系の主要な構成を示すブロック図である。
 本実施形態に係る自律走行経路生成システム99は、図1に示すように圃場90においてロボットトラクタ1が自律走行・自律作業をするための自律走行経路93を生成するものであって、図2及び図4等に示す無線通信端末46に備えられている。ロボットトラクタ1は、図5に示すように、当該ロボットトラクタ1の走行及び作業を制御する制御部4を備えており、前記無線通信端末46は、当該制御部4と無線通信することにより、ロボットトラクタ1に対して自律走行・自律作業に関する所定の信号を出力することができる。無線通信端末46が制御部4に出力する信号としては、自律走行・自律作業の経路に関する信号や自律走行・自律作業の開始信号、停止信号、終了信号等が考えられるが、これらに限定されない。
 初めに、ロボットトラクタ(以下、単に「トラクタ」と称する場合がある。)1について、主として図2及び図3を参照して説明する。
 トラクタ1は、圃場90を自律走行することが可能な走行機体(車体部)2を備える。走行機体2には、図2及び図3に示す作業機3が着脱可能に取り付けられている。この作業機3としては、例えば、耕耘機(管理機)、プラウ、施肥機、草刈機、播種機等の種々の作業機があり、これらの中から必要に応じて所望の作業機3を選択して走行機体2に装着することができる。走行機体2は、装着された作業機3の高さ及び姿勢を変更可能に構成されている。
 トラクタ1の構成について、図2及び図3を参照して説明する。トラクタ1の走行機体2は、図2に示すように、その前部が左右1対の前輪7,7で支持され、その後部が左右1対の後輪8,8で支持されている。
 走行機体2の前部にはボンネット9が配置されている。このボンネット9内にはトラクタ1の駆動源であるエンジン10や燃料タンク(図略)等が収容されている。このエンジン10は、例えばディーゼルエンジンにより構成することができるが、これに限るものではなく、例えばガソリンエンジンにより構成してもよい。また、駆動源としてエンジン10に加えて、又は、代えて電気モータを採用してもよい。
 ボンネット9の後方には、オペレータが搭乗するためのキャビン11が配置されている。このキャビン11の内部には、オペレータが操向操作するためのステアリングハンドル12と、オペレータが着座可能な座席13と、各種の操作を行うための様々な操作装置と、が主として設けられている。ただし、作業車両は、キャビン11付きのものに限るものではなく、キャビン11を備えないものであってもよい。
 上記の操作装置としては、図3に示すモニタ装置14、スロットルレバー15、主変速レバー27、複数の油圧操作レバー16、PTOスイッチ17、PTO変速レバー18、副変速レバー19、及び作業機昇降スイッチ28等を例として挙げることができる。これらの操作装置は、座席13の近傍、又はステアリングハンドル12の近傍に配置されている。
 モニタ装置14は、トラクタ1の様々な情報を表示可能に構成されている。スロットルレバー15は、エンジン10の出力回転数を設定するための操作具である。主変速レバー27は、トラクタ1の走行速度を無段階で変更するための操作具である。油圧操作レバー16は、図略の油圧外部取出バルブを切換操作するための操作具である。PTOスイッチ17は、トランスミッション22の後端から突出した図略のPTO軸(動力取出軸)への動力の伝達/遮断を切換操作するための操作具である。即ち、PTOスイッチ17がON状態であるときPTO軸に動力が伝達されてPTO軸が回転し、作業機3が駆動される一方、PTOスイッチ17がOFF状態であるときPTO軸への動力が遮断されてPTO軸が回転せず、作業機3が停止される。PTO変速レバー18は、作業機3に入力される動力の変更操作を行うものであり、具体的にはPTO軸の回転速度の変速操作を行うための操作具である。副変速レバー19は、トランスミッション22内の走行副変速ギア機構の変速比を切り換えるための操作具である。作業機昇降スイッチ28は、走行機体2に装着された作業機3の高さを所定範囲内で昇降操作するための操作具である。
 図2に示すように、走行機体2の下部には、トラクタ1のシャーシ20が設けられている。当該シャーシ20は、機体フレーム21、トランスミッション22、フロントアクスル23、及びリアアクスル24等から構成されている。
 機体フレーム21は、トラクタ1の前部における支持部材であって、直接、又は防振部材等を介してエンジン10を支持している。トランスミッション22は、エンジン10からの動力を変化させてフロントアクスル23及びリアアクスル24に伝達する。フロントアクスル23は、トランスミッション22から入力された動力を前輪7に伝達するように構成されている。リアアクスル24は、トランスミッション22から入力された動力を後輪8に伝達するように構成されている。
 図5に示すように、トラクタ1は、走行機体2の動作(前進、後進、停止及び旋回等)及び作業機3の動作(昇降、駆動及び停止等)を制御するための制御部4を備える。制御部4は、図示しないCPU、ROM、RAM、I/O等を備えて構成されており、CPUは、各種プログラム等をROMから読み出して実行することができる。制御部4には、トラクタ1が備える各構成(例えば、エンジン10等)を制御するためのコントローラ、及び、他の無線通信機器と無線通信可能な無線通信部40等がそれぞれ電気的に接続されている。
 上記のコントローラとして、トラクタ1は少なくとも、エンジンコントローラ61、車速コントローラ62、操向コントローラ63、及び昇降コントローラ64を備える。それぞれのコントローラは、制御部4からの電気信号に応じて、トラクタ1の各構成を制御することができる。
 エンジンコントローラ61は、エンジン10の回転数を制御するものである。具体的には、エンジン10には、当該エンジン10の回転数を変更させる図略のアクチュエータを備えたガバナ装置41が設けられている。エンジンコントローラ61は、ガバナ装置41を制御することで、エンジン10の回転数を制御することができる。
 車速コントローラ62は、トラクタ1の車速を制御するものである。具体的には、トランスミッション22には、例えば可動斜板式の油圧式無段変速装置である変速装置42が設けられている。車速コントローラ62は、変速装置42の斜板の角度を図略のアクチュエータによって変更することで、トランスミッション22の変速比を変更し、所望の車速を実現することができる。
 操向コントローラ63は、ステアリングハンドル12の回動角度を制御するものである。具体的には、ステアリングハンドル12の回転軸(ステアリングシャフト)の中途部には、操向アクチュエータ43が設けられている。この構成で、予め定められた経路をトラクタ1が(無人トラクタとして)走行する場合、制御部4は、当該経路に沿ってトラクタ1が走行するようにステアリングハンドル12の適切な回動角度を計算し、得られた回動角度となるように操向コントローラ63に制御信号を出力する。操向コントローラ63は、制御部4から入力された制御信号に基づいて操向アクチュエータ43を駆動し、ステアリングハンドル12の回動角度を制御する。
 昇降コントローラ64は、作業機3の昇降を制御するものである。具体的には、トラクタ1は、作業機3を走行機体2に連結している3点リンク機構の近傍に、油圧シリンダ等からなる昇降アクチュエータ44を備えている。この構成で、昇降コントローラ64は、制御部4から入力された制御信号に基づいて昇降アクチュエータ44を駆動して作業機3を適宜に昇降動作させることにより、所望の高さで作業機3により農作業を行うことができる。この制御により、作業機3を、退避高さ(農作業を行わない高さ)及び作業高さ(農作業を行う高さ)等の所望の高さで支持することができる。
 なお、上述したエンジンコントローラ61等の複数のコントローラは、制御部4から入力される信号に基づいてエンジン10等の各部を制御している。従って、制御部4が実質的に各部を制御していると把握することができる。
 上述のような制御部4を備えるトラクタ1は、オペレータがキャビン11内に搭乗して各種操作をすることにより、当該制御部4によりトラクタ1の各部(走行機体2、作業機3等)を制御して、圃場90内を走行しながら農作業を行うことができるように構成されている。加えて、本実施形態のトラクタ1は、オペレータがトラクタ1に搭乗しなくても、無線通信端末46により出力される所定の制御信号に基づいて自律走行及び自律作業させることが可能となっている。
 具体的には、図5等に示すように、トラクタ1は、自律走行・自律作業を可能とするための各種の構成を備えている。例えば、トラクタ1は、測位システムに基づいて自ら(走行機体2)の位置情報を取得するために必要な測位用アンテナ6等の構成を備えている。このような構成により、トラクタ1は、測位システムに基づいて自らの位置情報を取得して、圃場90を自律走行することが可能となっている。
 次に、自律走行を可能とするためにトラクタ1が備える構成について詳細に説明する。具体的には、本実施形態のトラクタ1は、図2及び図5に示すように、測位用アンテナ6、無線通信用アンテナ48、及び記憶部55等を備える。また、これらに加えて、トラクタ1には、走行機体2の姿勢(ロール角、ピッチ角、ヨー角)を特定することが可能な慣性計測ユニット(IMU)が備えられていてもよい。
 測位用アンテナ6は、例えば衛星測位システム(GNSS)等の測位システムを構成する測位衛星からの信号を受信するものである。図2に示すように、測位用アンテナ6は、トラクタ1のキャビン11のルーフ29の上面に配置されている。測位用アンテナ6で受信された測位信号は、図5に示す位置情報算出部49に入力される。位置情報算出部49は、トラクタ1の走行機体2(厳密には、測位用アンテナ6)の位置情報を、例えば緯度・経度情報として算出する。当該位置情報算出部49で検出された位置情報は、制御部4に入力されて、自律走行に利用される。
 なお、本実施形態ではGNSS-RTK法を利用した高精度の衛星測位システムが用いられているが、これに限られるものではなく、高精度の位置座標が得られる限りにおいて他の測位システムを用いてもよい。例えば、相対測位方式(DGPS)、又は静止衛星型衛星航法補強システム(SBAS)を使用することが考えられる。
 無線通信用アンテナ48は、オペレータが操作する無線通信端末46からの信号を受信したり、無線通信端末46への信号を送信したりするものである。図1に示すように、無線通信用アンテナ48は、トラクタ1のキャビン11が備えるルーフ29の上面に配置されている。無線通信用アンテナ48で受信した無線通信端末46からの信号は、図5に示す無線通信部40で信号処理された後、制御部4に入力される。また、制御部4等から無線通信端末46に送信する信号は、無線通信部40で信号処理された後、無線通信用アンテナ48から送信されて無線通信端末46で受信される。
 記憶部55は、トラクタ1を自律走行させる経路である走行経路(パス)を記憶したり、走行中のトラクタ1(厳密には、測位用アンテナ6)の位置の推移(走行軌跡)を記憶したりすることができる。その他にも、記憶部55は、トラクタ1を自律走行・自律作業させるために必要な様々な情報を記憶している。記憶部55は、例えば、フラッシュメモリ(フラッシュディスク及びメモリーカード等)、ハードディスク、又は光ディスク等の不揮発性メモリである。
 無線通信端末46は、図2及び図4に示すように、タブレット型のパーソナルコンピュータとして構成されている。オペレータは、無線通信端末46のディスプレイ37に表示された情報を参照して確認することができる。また、オペレータは、ディスプレイ37の近傍に配置されたハードウェアキー38、及びディスプレイ37を覆うように配置された図示しないタッチパネル等を操作して、トラクタ1の制御部4に、トラクタ1を制御するための制御信号(例えば、緊急停止信号等)を送信することができる。なお、無線通信端末46はタブレット型のパーソナルコンピュータに限るものではなく、これに代えて、例えばノート型のパーソナルコンピュータで構成することも可能である。あるいは、前述の協調作業を行うために有人のトラクタを無人のトラクタ1に付随して走行させる場合、有人側のトラクタに搭載されるモニタ装置を無線通信端末とすることもできる。
 このように構成されたトラクタ1は、無線通信端末46を用いるオペレータの指示に基づいて、圃場上の経路に沿って自律的に走行しつつ、作業機3による農作業を行うことができる。
 具体的には、オペレータは、無線通信端末46を用いて各種設定を行うことにより、図1等に示す自律走行経路93を形成することができる。この自律走行経路93は、農作業を行う直線状又は折れ線状の作業経路93Aと、当該作業経路93Aの端同士を繋ぐ円弧状の非作業経路93Bと、を交互に繋いだ一連の経路として構成される。そして、無線通信端末46側で上記のように生成された自律走行経路93の情報を、トラクタ1の制御部4に電気的に接続された記憶部55に入力(転送)して所定の操作をすることにより、当該制御部4によりトラクタ1を制御して、自律走行経路93に沿って当該トラクタ1に自律走行・自律作業を行わせることができる。
 以下では、主として図5を参照して、自律走行経路生成システム99を備える無線通信端末46の構成についてより詳細に説明する。
 図5に示すように、無線通信端末46は、制御部71と、ディスプレイ(表示部)37と、通信部72と、作業車両情報設定部51と、圃場情報設定部52と、作業情報設定部53と、作業領域分割部(領域分割部)54と、自律走行経路生成部(経路生成部)47と、を備える。
 具体的には、無線通信端末46の制御部71は、トラクタ1の制御部4と同様に、図示しないCPU、ROM、RAM、I/O等を備えたコンピュータとして構成されており、CPUは、各種プログラム等をROMから読み出して実行することができる。また、前記ROMには、トラクタ1に自律走行・自律作業を行わせるための適宜のプログラムが記憶されている。そして、上記したソフトウェアとハードウェアの協働により、無線通信端末46を、通信部72、作業車両情報設定部51、圃場情報設定部52、作業情報設定部53、作業領域分割部54、及び自律走行経路生成部47等として動作させることができる。
 通信部72は、トラクタ1側との間で通信を行うためのものである。無線通信端末46の制御部71は、通信部72によりトラクタ1の制御部4と通信することで、自律走行経路生成部47が生成した自律走行経路93の情報をトラクタ1側に送信することができる。また、無線通信端末46の制御部71は、通信部72を用いて制御信号をトラクタ1側に送信することで、トラクタ1に対して自律走行の開始及び停止等を指示することができる。また、トラクタ1が自律走行している場合、無線通信端末46の制御部71は、当該トラクタ1の状態(位置、走行速度等)をトラクタ1側から受信してディスプレイ37に表示することができる。
 作業車両情報設定部51は、トラクタ1に関する情報(以下、作業車両情報と呼ぶことがある。)を設定するためのものである。作業車両情報設定部51は、トラクタ1の機種、トラクタ1の大きさ、トラクタ1において測位用アンテナ6が取り付けられている位置、作業機3の種類、作業機3のサイズ及び形状、作業機3の位置等について、オペレータが無線通信端末46を適宜操作することにより指定した内容を記憶することができる。
 圃場情報設定部52は、圃場90に関する情報(以下、圃場情報と呼ぶことがある。)を設定するためのものである。圃場情報設定部52は、圃場90の位置及び形状、自律走行させたい開始位置及び終了位置、作業領域、作業方向等について、オペレータが無線通信端末46を操作することにより指定した内容を記憶することができる。なお、作業方向とは、図1に示すように、圃場90から(枕地や非耕作地等の)非作業領域92を除いた領域である作業領域91において、作業機3で作業を行いながらトラクタ1を走行させる方向を意味する。
 圃場90の位置及び形状の情報は、例えばオペレータがトラクタ1に搭乗して圃場の外周に沿って1回り周回するように運転し、そのときの測位用アンテナ6の位置情報の推移を記録することで、自動的に取得することができる。ただし、圃場90の位置及び形状は、ディスプレイ37に地図を表示させた状態でオペレータが無線通信端末46を操作して当該地図上の複数の点を指定することで得られた多角形に基づいて取得することもできる。
 作業情報設定部53は、作業を具体的にどのように行うかに関する情報(以下、作業情報と呼ぶことがある。)を設定するためのものである。作業情報設定部53は、作業情報として、ロボットトラクタ1と有人のトラクタの協調作業の有無、トラクタ1が枕地において旋回する場合にスキップする作業経路93Aの数であるスキップ数(基準値)、枕地の幅、及び非耕作地の幅等を設定可能に構成されている。
 作業領域分割部54は、スキップ走行を伴う自律走行経路93が自律走行経路生成部47において生成されるときに、図12等に示すように、作業領域91を複数の区画Sに分割するためのものである。この分割により生成された区画Sが、スキップ走行を行う作業の単位となる。なお、作業領域91の分割の詳細については後述する。
 図5に示す自律走行経路生成部47は、トラクタ1を自律走行させる経路である自律走行経路93を生成するためのものである。自律走行経路生成部47は、作業車両情報設定部51、圃場情報設定部52、及び作業情報設定部53で設定された情報に基づいて、トラクタ1の自律走行経路93を生成して記憶することができる。
 自律走行経路93は、図1に示すように、作業領域91に配置される作業経路93Aと、非作業領域92に配置される非作業経路93Bと、により構成される。自律走行経路生成部47が自律走行経路93を生成する過程では、作業機3の作業幅、作業領域91において互いに隣接する作業経路93Aの間で作業機3の作業幅同士が一部重複することの可否(可能な場合は、重複幅の上限値)、非作業領域92の大きさ及び形状(言い換えれば、枕地の幅及び非耕作地の幅)、トラクタ1が枕地での非作業経路93Bにおいて旋回する場合にスキップする作業経路93Aの数(スキップ数)等が考慮される。また、無人トラクタ1と有人トラクタとで協調作業を行う場合は、自律走行経路93の生成過程において、無人トラクタ1と有人トラクタとの位置関係、有人トラクタの作業機の作業幅等が考慮される。
 次に、図6から図8までを参照して、自律走行経路93を生成するための無線通信端末46における設定について説明する。図6は、無線通信端末46に表示される作業車両情報入力画面81の表示例を示す図である。図7は、無線通信端末46に表示される圃場情報入力画面82の表示例を示す図である。図8は、無線通信端末46に表示される作業情報入力画面83の表示例を示す図である。
 無線通信端末46においてオペレータが所定の操作を行うと、制御部71は、図6に示す作業車両情報入力画面81をディスプレイ37に表示するように制御する。
 作業車両情報入力画面81では、走行機体2及び当該走行機体2に装着される作業機3に関する情報(前記作業車両情報)を入力することができる。具体的には、作業車両情報入力画面81には、トラクタ1の機種、トラクタ1の大きさ、測位用アンテナ6の走行機体2に対する取付位置、作業機3の種類、作業機3の作業幅W、3点リンク機構の後端(ロアリンクの後端)から作業機3の後端までの距離等を入力する欄がそれぞれ配置されている。
 オペレータは、無線通信端末46を操作して、作業車両情報入力画面81の各欄に配置されているテキストボックスに数値を入力したりドロップダウンボックスの一覧から選択したりすることにより、設定を行う。これにより、走行機体2及び作業機3に関する各種の情報を設定することができる。
 作業車両情報入力画面81においてオペレータが指定した作業車両情報は、作業車両情報設定部51に記憶される。作業車両情報の入力が完了すると、制御部71は、図7に示すような圃場情報入力画面82を表示するようにディスプレイ37を制御する。
 圃場情報入力画面82では、走行機体2が走行する圃場90に関する情報(前記圃場情報)を入力することができる。具体的には、圃場情報入力画面82には、圃場90の位置及び形状と、自律走行の開始位置及び終了位置と、を図形で示す平面表示部88が配置されている。また、圃場情報入力画面82には、圃場90の外周、自律走行の開始位置、自律走行の終了位置、及び作業方向のそれぞれについて、「指定」、「リセット」のボタンが配置されている。
 なお、圃場情報入力画面82等におけるボタンは、何れもディスプレイ37に表示される仮想的なボタンとして構成され、当該ボタンの表示領域に相当するタッチパネルの位置をオペレータが指で触れることによって操作することができる。
 「圃場外周」の「指定」ボタンを操作すると、無線通信端末46が圃場形状記録モードに切り換わる。この圃場形状記録モードにおいて、オペレータがトラクタ1に乗り込んで運転し、圃場90の外周に沿って1回り周回させると、そのときの測位用アンテナ6の位置情報の推移に基づいて、圃場90の位置及び形状が取得(算出)される。これにより、圃場90の位置及び形状の指定を行うことができる。
 無線通信端末46の制御部71は、得られた圃場90の位置及び形状を、図7に示すように、圃場情報入力画面82の平面表示部88にグラフィカルに表示する。圃場90の位置及び形状の指定をやり直したい場合は、今まで指定した内容を「リセット」ボタンの操作により破棄し、再度「指定」ボタンを操作すればよい。
 なお、上記のように圃場90においてトラクタ1を実際に走行させることで圃場90の位置及び形状を指定することに代えて、例えば、無線通信端末46のディスプレイ37に地図を表示させ、地図上においてオペレータが複数の点を指定することにより、指定した点同士を結ぶ線が交わらないようにいわゆる閉路グラフにより特定した多角形の位置及び形状を圃場90の位置及び形状として指定することもできる。
 「作業開始位置」の「指定」ボタンを操作すると、図7に示すように、指定された圃場90の位置及び形状が平面表示部88に表示された状態で、オペレータは適宜の点を自律走行の開始位置として指定することができる。指定された開始位置には開始位置マークC1が表示される。なお、「リセット」ボタンの動作は上記と同様である。
 「作業終了位置」の「指定」ボタンを操作すると、「作業開始位置」の「指定」ボタンと同様に、適宜の点を、自律走行の終了位置として指定することができる。指定された終了位置には、終了位置マークC2が表示される。「リセット」ボタンの動作は上記と同様である。
 圃場情報入力画面82においてオペレータが指定した圃場情報は、圃場情報設定部52に記憶される。圃場情報の入力が完了すると、制御部71は、図8に示すような作業情報入力画面83を表示するようにディスプレイ37を制御する。
 作業情報入力画面83では、具体的な作業の情報(前記作業情報)を入力することができる。具体的には、作業情報入力画面83には、ロボットトラクタ1と有人のトラクタの協調作業の有無、有人のトラクタが協調作業する場合のパターン、有人のトラクタが協調作業する場合の当該有人のトラクタの作業幅、ロボットトラクタ1のスキップ数、隣接する作業経路93Aにおける作業幅のオーバーラップ許容量、枕地幅、及び非耕作地の幅等を入力する欄がそれぞれ設けられている。
 「有人トラクタの協調作業の有無」の欄では、ロボットトラクタ1を単独で自律走行させて農作業を行うか(有人トラクタの随伴無し)、又は、自律走行するロボットトラクタ1と有人のトラクタ(オペレータが搭乗するトラクタ)とを随伴させることにより農作業を行うか(有人トラクタの随伴有り)、の何れかを選択することが可能となっている。
 「随伴有り」の場合、「協調作業パターン」の欄で、ロボットトラクタ1に対する有人のトラクタの位置のパターンを、ロボットトラクタ1の真後ろ、左斜め後ろ、右斜め後ろ、の何れかから選択することが可能となっている。また、「有人トラクタの作業幅」の欄で、有人トラクタの作業幅(作業機により作業が行われる有効幅)を入力することができる。
 「ロボットトラクタのスキップ数」の欄には、ドロップダウンリストボックスが配置されており、ドロップダウン操作により、スキップ数として設定可能な数値の一覧が選択可能に表示される。オペレータは、その一覧から1つを選択することで、作業経路93Aをいくつ飛ばして農作業を行うかを指定することができる。本実施形態においては、スキップ数SNを、0、1又は2の何れかから選択することで設定することができる。スキップ走行を希望しない場合は、スキップ数SNとしてゼロを選択すればよい。
 「作業幅のオーバーラップ許容量」の欄では、互いに隣接する作業経路93Aの間で作業幅同士が一部重複してもよい場合、その重複幅の上限値を入力することができる。重複を全く許容しない場合は、この欄にゼロを入力すればよい。
 「枕地幅」の欄では、例えば、無人のトラクタ1に装着される作業機3のサイズ等に基づいて予め算出される枕地の幅の下限値と同じかそれよりも大きい値を設定することができる。
 「非耕作地の幅」の欄では、自律走行の終了後に圃場90の外周に沿って手動走行で周回しつつ作業すること等を考慮しながら、適宜の値を設定することができる。
 オペレータが作業情報入力画面83の入力欄を全て入力して「自律走行経路を生成」ボタンを操作した場合、自律走行経路生成部47により自律走行経路93が生成されるとともに、当該自律走行経路93が作業領域分割部54に記憶される。生成された自律走行経路93は確認のためにディスプレイ37に適宜表示され、オペレータが図略の「確定」ボタンを操作することで、自律走行経路93を確定させることができる。
 自律走行経路93の確定後は、制御部71は、図示しない経路データ転送画面をディスプレイ37に表示するように制御する。この経路データ転送画面では、オペレータは、自律走行経路生成部47により生成した自律走行経路93のデータを、トラクタ1側へ例えば無線により転送し、トラクタ1が備える記憶部55に記憶させることができる。
 自律走行経路93のデータがトラクタ1に入力されると、オペレータが無線通信端末46を適宜操作することで、トラクタ1に自律走行の開始を指示することができる。自律走行の開始が指示されると、トラクタ1は、無線通信端末46から当該トラクタ1に送信された自律走行経路93に従って自律走行し、自律作業を行う。
 次に、自律走行経路93を生成するときに自律走行経路生成部47で行われる具体的な処理について、図9から図15までを参照して説明する。図9は、自律走行経路生成部47を生成するときに自律走行経路生成部47で行われる処理を示すフローチャートである。図10は、スキップ走行を行う自律走行経路93を生成するために、作業領域91に複数の作業経路93Aが配置される様子を示す図である。図11は、スキップ走行を行う場合に作業の単位となる、特定の数の作業経路93Aからなるグループを示す図である。図12は、作業領域91が分割されて複数の区画Sが生成される様子を示す図である。図13は、作業領域91が分割されて、作業経路93Aの数が特定の数より大きい例外の区画SEを含む複数の区画S,SEが生成される様子を示す図である。図14は、作業経路93Aの作業順序が決定された様子を示す図である。図15は、図14で決定された作業順序に基づいて自律走行経路93が生成される様子を示す図である。
 図8に示す作業情報入力画面83において「自律走行経路を生成」ボタンが操作されると、最初に、圃場情報入力画面82において設定された圃場90の形状と、作業情報入力画面83において設定された枕地幅及び非耕作地の幅と、に基づいて、作業領域91及び非作業領域92が定められる。その後に図9の処理が開始され、自律走行経路生成部47は、作業領域91内に作業経路93Aを互いに間隔をあけて配置する(ステップS101)。それぞれの作業経路93Aは、図7の圃場情報入力画面82で設定された作業方向に沿うように配置される。また、作業経路93Aを配置する間隔は、作業領域91に対する作業機3の作業漏れが生じないように、かつ、作業効率が良好となるように、当該作業機3の作業幅W等を考慮して決定される。なお、作業領域91において配される作業経路93Aの列数(本数)は、作業領域91の大きさ、作業機3の作業幅W、及び、オーバーラップ許容量に基づいて算出可能であるため、本ステップにおいては作業領域91に作業経路93Aを配することなく、配されるべき作業経路93Aの列数を算出し、ステップS102に進むこととしてもよい。
 次に、自律走行経路生成部47は、作業情報設定部53で設定された(作業情報入力画面83で入力された)ロボットトラクタ1のスキップ数SNの情報を取得して、スキップ数SNが1以上であるか否かを判断する(ステップS102)。
 ステップS102の判断の結果、スキップ数SNが0である場合、自律走行経路生成部47は、作業経路93Aが並べられる方向の一側の端から当該作業経路93Aを順番に(飛ばすことなく)走行して他側の端まで到達する自律走行経路93を生成し(ステップS103)、処理を終了する。これにより、スキップなしの自律走行経路93が生成される。
 ステップS102の判断の結果、スキップ数SNが1以上である場合、自律走行経路生成部47は、作業領域91における作業経路93Aの数(作業経路数TP)が、基本単位経路数BP以上であるか否かを判断する(ステップS104)。
 ここで、基本単位経路数BPについて説明する。即ち、本実施形態のロボットトラクタ1におけるスキップ走行は、互いに隣接しながら並ぶ特定の数の作業経路93Aからなるグループを単位として行われる。あるグループについてスキップ走行がいったん開始されると、当該グループに属する全ての作業経路93Aについて作業が完了するまで、他のグループについてスキップ走行が行われることはない。
 例えばスキップ数SNが1である場合、図11(a)に示すように、互いに隣接しながら並ぶ5つ(5列)の作業経路93Aを考える。なお、以下の説明では、それぞれの作業経路93Aを、自律走行の開始位置に近い側からA,B,C,D,Eというようにアルファベットで呼ぶことがある。このグループについてスキップ走行を行う場合、トラクタ1は、Aを走行した後、1つ飛ばしてCを走行し、更に1つ飛ばしてEを走行する。その後、飛ばす方向をいったん反転させ、かつ通常よりも多く2つ飛ばして、Bを走行する。その後、飛ばす方向を更に反転して、Dを走行する。以上のように、A,C,E,B,Dの順に作業を行うことで、設定されたスキップ数SN(即ち、1)に概ね従いながら、5つの作業経路93Aについて作業を完了させることができる。
 また、スキップ数SNが2である場合、図11(b)に示すように、互いに隣接しながら並ぶ7つの作業経路93Aを考える。なお、以下の説明では、それぞれの作業経路93Aを、自律走行の開始位置に近い側からA,B,C,D,E,F,Gというようにアルファベットで呼ぶことがある。このグループについてスキップ走行を行う場合、トラクタ1は、Aを走行した後、2つ飛ばしてDを走行し、更に2つ飛ばしてGを走行する。その後、飛ばす方向をいったん反転させ、かつ設定数よりも多く3つ飛ばして、Cを走行する。続いて、飛ばす方向を反転してFを走行する。その後、飛ばす方向を反転させ、かつ設定数よりも多く3つ飛ばして、Bを走行する。続いて、飛ばす方向を反転させ、Eを走行する。以上のように、A,D,G,C,F,B,Eの順に作業を行うことで、設定されたスキップ数SN(即ち、2)に概ね従いながら、7つの作業経路93Aについて作業を完了させることができる。
 以上を踏まえて説明すると、基本単位経路数BPとは、スキップ走行によって作業を完了させる基本的な単位(グループ)における作業経路93Aの数を意味する。スキップ数SNが1の場合は、基本単位経路数BPは5となり、スキップ数SNが2の場合は、基本単位経路数BPは7となる。一般化すると、基本単位経路数BPは、スキップ数SNに対して、2(SN+1)+1で表される。
 従って、ステップS104は、ステップS101で配置された作業経路93Aの数が、上記のグループを少なくとも1つ形成するのに十分であるか否かを判断することを実質的に意味する。
 ステップS104の判断で、作業経路数TPが基本単位経路数BPに満たない場合、上記のグループを1つも形成することができないことを意味する。従って、制御部71は、設定されたスキップ数SNでの自律走行経路93の生成ができない旨のメッセージをディスプレイ37に表示させるように制御して(ステップS105)、処理を終了する。
 ステップS104の判断で、作業経路数TPが基本単位経路数BP以上である場合、自律走行経路生成部47は、作業経路数TPが基本単位経路数BPの整数倍であるか否かを判断する(ステップS106)。
 ステップS106の判断で、作業経路数TPが基本単位経路数BPの整数倍である場合、自律走行経路生成部47は、作業経路93Aが並べられる方向で作業領域91を分割して、複数の区画Sを生成する(ステップS107)。この分割は、それぞれの区画Sに含まれる作業経路93Aの数が基本単位経路数BPと等しくなるように行われる。図12には、スキップ数SNが1(基本単位経路数BPが5)である場合に、15つの作業経路93Aが配置された作業領域91を分割して、それぞれが5つの作業経路93Aを有する3つの区画Sを形成する例が示されている。ただし、作業経路数TPが基本単位経路数BPと等しい場合は、分割する必要がないので、作業領域91の全体に1つの区画Sが生成される。
 ステップS106の判断で、作業経路数TPが基本単位経路数BPの整数倍と異なる場合でも、自律走行経路生成部47は、作業経路93Aが並べられる方向で作業領域91を分割して、複数の区画Sを生成する(ステップS108)。この分割は、それぞれの区画Sに含まれる作業経路93Aの数が基本単位経路数BPと等しくなるのを原則とするが、例外として、1つの区画SEだけは、当該区画SEに含まれる作業経路93Aの数が基本単位経路数BPを上回るように行われる。図13には、スキップ数SNが1(基本単位経路数BPが5)である場合に、16つの作業経路93Aが配置された作業領域91を分割して、それぞれが5つの作業経路93Aを有する2つの区画(第1区画)Sと、6つの作業経路93Aを有する1つの例外の区画(第2区画)SEと、を形成する例が示されている。この例外の区画SEは、作業経路93Aが並べられる方向の端部、更に言えば、自律走行の終了位置に近い側の端部に配置されることが好ましい。作業経路数TPが基本単位経路数BPの2倍を下回る場合は、分割する必要がないので、作業領域91の全体に1つの(例外の)区画SEが生成される。
 1又は複数の区画Sが生成されると、自律走行経路生成部47は、作業経路93Aの数が基本単位経路数BPと等しい(原則の)区画Sと、基本単位経路数BPを上回る(例外の)区画SEと、の両方について、作業経路93Aをトラクタ1が所定の作業順序に従って走行するように自律走行経路93を生成する(ステップS109)。
 上記の作業順序とは、作業経路93Aの数が基本単位経路数BPと等しい(原則の)区画Sについては、スキップ数SNが1の場合は上述したA,C,E,B,Dの順を意味し、スキップ数SNが2の場合は上述したA,D,G,C,F,B,Eの順を意味する。なお、図14には、スキップ数SNが1であって作業領域91が図12のように分割された場合に、作業経路93Aの作業順序が決定される様子が示されている。図14においてそれぞれの作業経路93Aに付されている丸付き数字は、決定された作業順序を示す。
 それぞれの区画Sに配置されている作業経路93Aを上記の順序に従って走行するように自律走行経路93を(図15に示すように)生成することで、当該区画Sを単位とする細かいスキップ走行パターンの繰返しが実現される。即ち、自律走行開始位置に最も近い区画Sについてスキップ走行が上記のスキップ走行パターンに従って行われ、当該区画Sの作業が完了すると、それに隣接する区画Sについてスキップ走行が上記のスキップ走行パターンに従って行われる。上記を反復しながら自律走行・自律作業を行うことで、作業が途中で中断しても、作業済の箇所と未作業の箇所とが交互に現れる部分を区画S内の小さな範囲に留めることができる。
 なお、作業経路93Aの数が基本単位経路数BPを上回る区画(例外の区画)SEについては、原則の区画Sでの作業順序と類似した作業順序となることが好ましいが、作業経路93Aをスキップする数をある程度柔軟に考えて、適当な作業順序で作業経路93Aを走行するように自律走行経路93を生成すればよい。
 以上の処理により、スキップ走行を伴う作業に適した自律走行経路93を生成することができる。なお、図12から図15までにはスキップ数SNが1である場合が示されているが、スキップ数SNが2である場合も、図11(b)に示すように基本単位経路数BPが7になる点、作業順序がA,D,G,C,F,B,Eとなる点を除いて、上記と全く同様に生成することができる。
 以上に説明したように、本実施形態の自律走行経路生成システム99は、予め定められた作業領域91に対して作業を行うためにトラクタ1を自律走行させる自律走行経路93を生成する。自律走行経路生成システム99は、作業領域分割部54と、自律走行経路生成部47と、を備える。作業領域分割部54は、作業領域91を複数の区画Sに分割する。自律走行経路生成部47は、作業領域分割部54により分割された各区画Sのそれぞれに配置された複数の作業経路93Aを含むように自律走行経路93を生成する。作業領域分割部54は、各区画Sに含まれる作業経路93Aの数が互いに等しい基本単位経路数BPとなるように作業領域91を分割可能である。
 これにより、スキップ走行による作業を行う場合でも、分割された小さな区画Sを単位として、作業領域91の端から順番に作業していくことができる。従って、作業が途中で中断した場合でも、作業領域91において作業済みの箇所と未作業の箇所が交互に現れる部分を、区画S内の小さな範囲に留めることができる。従って、作業済みの箇所が明確になり易く、円滑に作業の再開を行うことができる。また、作業の中断前後で雨等により土壌環境が変化した場合でも、作業品質が異なる部分が広範囲にわたって櫛歯状に生じるのを防止することができる。
 また、本実施形態の自律走行経路生成システム99において、自律走行経路生成部47は、複数の作業経路93Aに対してスキップ数SNに基づいて作業順序を設定する。含まれる作業経路93Aの数が基本単位経路数BPと等しい区画Sが複数ある場合に、自律走行経路生成部47は、図14に示すように、当該区画Sの間で互いに対応する各々の作業経路93Aに対して同一の作業順序を設定する。
 これにより、区画Sを単位として一定の作業順序を作業経路93Aに対して設定することができるので、規則的なスキップ走行を実現できるとともに、自律走行経路93の生成処理を簡略化することができる。
 また、本実施形態の自律走行経路生成システム99において、作業領域分割部54は、作業領域91に含まれる作業経路93Aの数が基本単位経路数BPの整数倍でない場合に、図13に示すように、含まれる作業経路93Aの数が基本単位経路数BPと等しい原則の区画Sと、含まれる作業経路93Aの数が基本単位経路数BPより大きい例外の区画SEと、を形成するように作業領域91を複数の区画S,SEに分割する。
 これにより、含まれる作業経路93Aの数が基本単位経路数BPに満たない区画が生じなくなるので、スキップ走行を伴う自律走行経路93を容易に生成することができる。
 次に、図16及び図17を参照して、圃場90及び作業領域91の形状によって、トラクタ1が非作業領域92において複数回の旋回や切返し操作を必要とする例を説明する。図16は、非作業領域92においてトラクタ1が複数回の旋回を行う例を示す図である。図17は、非作業領域92においてトラクタ1が複数回の旋回及び切返しを行う例を示す図である。
 図16に示した圃場90Pでは、非作業領域92に、L字路が連続するクランク形状の部分が存在している。作業順序が決定された作業経路93Aの端点同士を繋ぐ非作業経路93Bが当該部分を通過する場合、非作業経路93Bは、非作業領域92に収まるように(即ち、トラクタ1が作業領域91に進入することも、圃場90Pの外側にハミ出すこともないように)、所定のマージンを見込んで生成される。このとき、L字路の部分においては、走行機体2の旋回半径Rが考慮される。図16の例では、非作業領域92がクランク状の部分を有するために、図15で示した圃場90と比較して、非作業領域92での旋回が2回余分に必要となっている。
 また、図16と同様の圃場90Pであっても、図17に示すように、作業経路93Aから非作業経路93Bに入った直後にクランク形状の部分を通過する必要が生じる場合がある。このとき、非作業経路93Bに入った直後にL字路での旋回を行ったとしても、走行機体2又は作業機3が圃場90Pの外側にはみ出してしまう。この場合は、図17に示すように、非作業経路93Bは、L字路の部分の旋回に加えて、走行機体2を一端前後させる切返しも伴う経路として生成される。
 このように、非作業領域92が不定形である場合、自律走行経路生成部47が必要に応じて旋回や切返しを伴うように非作業経路93Bを生成することで、スキップ走行を適切に行うことができる。
 以上に本発明の好適な実施の形態を説明したが、上記の構成は例えば以下のように変更することができる。
 上記の実施形態においては、基本単位経路数BPがスキップ数SNに対して2(SN+1)+1で表される数値としたが、他の数値に変更してもよい。即ち、基本単位経路数BPは、M(SN+1)+1(Mは2以上の自然数)で表される。
 上記の実施形態においては、スキップ数SNは1又は2から選択できるとしたが、必要に応じて3以上の数値を選択できる構成にしてもよい。
 作業を行う作業経路93Aの順番(作業順序)は、図11で示した例に限らず、適宜変更することもできる。
 ステップS102の判断の結果、スキップ数SNが0である場合、自律走行経路生成部47は、作業領域91を分割することなく自律走行経路93を生成することとしたが、作業領域91を分割した上で、自律走行経路93を生成することとしてもよい。
 図9に示すステップS105において、メッセージを表示する代わりに、上述の発明が解決しようとする課題で述べた(単純なスキップ走行を行う)自律走行経路を生成してもよい。或いは、作業経路数TPが基本単位経路数BPに満たない場合には、スキップ数SNを0に変更するよう促し、ユーザがスキップ数SNを0に変更した場合はステップS103に進み、ユーザがスキップ数SNを0に変更しなかった場合にステップS105に進むこととしてもよい。
 ところで、図14及び図15に示すように作業領域91が複数の区画Sに分割され、或いは、複数の区画Sと単一の区画SEに分割される場合、トラクタ1により自律走行・自律作業される区画に対する作業順は、例えば、開始位置に近い区画から順に設定され、特定の区画について作業が完了すると、それに隣接する区画にて作業が行われる。しかしながら各区画に対する作業順は、これに限られるものではなく任意の順番が設定可能であってもよい。
 上記の実施形態では、作業情報入力画面83で設定された枕地幅及び非耕作地の幅に基づいて非作業領域92が定められ、圃場90から非作業領域92を除外した残りの領域として作業領域91が定められている。しかしながら、作業領域91を設定する方法は上記に限らず、例えば、上述の圃場情報入力画面82において平面表示部88に表示された圃場90の任意の点をオペレータが指定することで作業領域91及び非作業領域92を設定できるように構成されてもよい。
 上記の実施形態では、自律走行経路生成システム99を構成する作業領域分割部54及び自律走行経路生成部47は、無線通信端末46側に備えられている。しかしながら、作業領域分割部54及び自律走行経路生成部47のうちの一部又は全部がトラクタ1側に備えられてもよい。
 <第2実施形態>
 次に、本開示の第2実施形態に係る自律走行経路生成システム199について、主として図18から図34までを参照して詳細に説明する。図18は、第2実施形態に係るロボットトラクタ1及び無線通信端末46の電気系の主要な構成を示すブロック図である。以下では、第1実施形態と同様の構成の部材及びステップには同一の符号を付し、説明を適宜省略する場合がある。
 本実施形態の自律走行経路生成システム199の主たる構成は、無線通信端末46に備えられる。本実施形態の無線通信端末46は、上述した制御部71、ディスプレイ(表示部)37、及び通信部72の他に、更に、表示制御部31、記憶部32、圃場外周設定部33、障害物外周設定部34、作業領域設定部(走行領域設定部)35、開始終了位置設定部151、作業方向設定部(走行方向設定部)36、及び自律走行経路生成部147等を備える。なお、圃場外周設定部33、障害物外周設定部34、作業領域設定部(走行領域設定部)35、開始終了位置設定部151、及び作業方向設定部(走行方向設定部)36を合わせたものは、第1実施形態における圃場情報設定部52に対応するものである。また、自律走行経路生成部147は、第1実施形態における自律走行経路生成部47に対応するものである。
 本実施形態の無線通信端末46も、第1実施形態の場合と同様に、上記したソフトウェアとハードウェアの協働により、表示制御部31、記憶部32、圃場外周設定部33、障害物外周設定部34、作業領域設定部35、開始終了位置設定部151、作業方向設定部36、及び自律走行経路生成部147等として動作することができる。
 表示制御部31は、ディスプレイ37に表示する表示用データを作成し、表示内容を適宜に制御する。本実施形態の表示制御部31は、ユーザにより所定の操作が行われたとき、図19に示す圃場情報入力画面182をディスプレイ37に表示させる。図19は、無線通信端末46に表示される、トラクタ1が走行する圃場に関する情報を入力するための画面の一例を示す図である。
 この圃場情報入力画面182では、トラクタ1が走行する圃場に関する情報を入力することができる。具体的には、圃場情報入力画面182には、圃場の形状を図形で(グラフィカルに)示す平面表示部88が配置されている。また、圃場情報入力画面182において、「圃場外周の位置」の欄及び「障害物の外周の位置」の欄には、「記録開始」及び「リセット」のボタンがそれぞれ配置されている。また、圃場情報入力画面182において、「作業開始位置・作業終了位置」、「作業方向」のそれぞれの欄には、「指定」及び「リセット」のボタンが配置されている。
 記憶部32は、ユーザが無線通信端末46のタッチパネルを操作することにより入力した圃場に関する情報等を記憶するとともに、生成された走行経路の情報等を記憶することができる。
 圃場外周設定部33は、トラクタ1が自律走行を行う対象となる圃場の外周の位置を設定するものである。具体的には、ユーザが圃場情報入力画面182において「圃場外周の位置」の「記録開始」ボタンを操作すると、無線通信端末46が圃場外周記録モードに切り換わる。この圃場外周記録モードにおいて、トラクタ1を圃場の外周に沿って1回り周回させると、そのときの測位用アンテナ6の位置情報の推移が圃場外周設定部33で記録されて、当該圃場外周設定部33で圃場の形状が設定(取得)される。これにより圃場の位置及び形状を設定することができる。また、「リセット」ボタンを操作することで、圃場外周の位置の記録(設定)を再び行うことができる。
 障害物外周設定部34は、トラクタ1が自律走行を行う対象の圃場内に配置される障害物の外周領域を設定するものである。具体的には、ユーザが圃場情報入力画面182において「障害物の外周の位置」の「記録開始」ボタンを操作すると、無線通信端末46が障害物外周記録モードに切り換わる。この障害物外周記録モードにおいて、トラクタ1を障害物の外周領域の角部に配置させてそのときの測位用アンテナ6の位置情報を障害物外周設定部34で記録すると、当該障害物外周設定部34で障害物を多角形(例えば、長方形)で囲んだ形状が設定(取得)される。この多角形は、例えば、各角部を結ぶ線分が交わらないようにいわゆる閉路グラフにより特定した多角形として算出することができる。これにより、障害物の外周領域の位置及び形状を設定することができる。なお、障害物外周設定部34で設定される障害物の外周領域は、障害物を取り囲む中空状の多角形の領域であり、その内縁と外縁との間の距離は、トラクタ1(作業機3)の車幅と同じかそれよりも若干広くなっている。
 作業領域設定部35は、トラクタ1が自律走行を行う対象の圃場内に配置される、自律的に走行しながら農作業を行う作業領域(走行領域)の位置を設定するものである。具体的に説明すると、本実施形態の無線通信端末46においては、圃場情報入力画面182とは別の入力画面(図略)において、枕地の幅と、非耕作地の幅と、を設定可能に構成されている。そして、枕地及び非耕作地からなる非作業領域が、上記の設定内容と、圃場外周設定部33で設定された圃場の位置及び形状と、に基づいて定められるとともに、圃場の領域から非作業領域を除いた領域が作業領域として定められる。
 開始終了位置設定部151は、トラクタ1が自律走行を開始する地点である開始地点と、自律走行を終了する地点である終了地点と、を設定するものである。具体的には、ユーザが圃場情報入力画面182において「作業開始位置・作業終了位置」の「指定」ボタンを操作すると、平面表示部88に、圃場外周設定部33で設定した圃場のデータが地図データに重ね合わされて表示される。この状態で、ユーザが圃場の輪郭の近傍の任意の点を選択することで、選択した点の位置情報を開始地点及び終了地点として開始終了位置設定部151で設定(記録)することができる。なお、「リセット」のボタンの機能については、上記と同様である。
 作業方向設定部36は、トラクタ1が作業領域において農作業を行いながら走行する方向(走行路の方向)を設定するものである。具体的には、ユーザが圃場情報入力画面182において「作業方向」の「指定」ボタンを操作すると、平面表示部88に、圃場外周設定部33で設定した圃場の形状が地図データに重ね合わされて表示される。この状態で、ユーザが、例えば圃場を指定するときに指定した複数の点の中から2点を選択することで、当該2点を結んだ直線の方向を作業方向(走行方向)として作業方向設定部36で設定(記録)することができる。なお、作業方向を指定する際に選択する点は2点に限られず、3点以上の複数点であってもよい。これにより、圃場等の輪郭に沿った、より正確な作業方向を指定することが可能である。また、「リセット」ボタンの機能については、上記と同様である。
 本実施形態における自律走行経路生成部147は、圃場内においてトラクタ1が自律的に走行する走行経路を生成する。第1実施形態と同様にこの走行経路には、直線状又は折れ線状の走行路と、円弧状の旋回路と、が交互に含まれる。自律走行経路生成部147は、圃場外周設定部33で設定された圃場外周の位置、作業領域設定部35で設定された作業領域の位置、開始終了位置設定部151で設定された開始地点及び終了地点の位置、並びに作業方向設定部36で設定された作業方向の情報を取得して、これらの情報に基づいて自動的に走行経路を生成する。この走行経路は、基本的には、直線状又は折れ線状の走行路が作業領域に含まれ、旋回路が圃場内の作業領域以外の領域(非作業領域)に含まれるように生成される。ただし、圃場内に障害物が存在する場合には、自律走行経路生成部147は、障害物を回避するように走行経路を生成する。これについては、後に詳述する。自律走行経路生成部147が作成した走行経路は、記憶部32に記憶される。
 次に、自律走行経路生成部147が走行経路を生成するときの具体的な処理について、図20及び図21を参照して説明する。図20は、走行経路を生成するときに自律走行経路生成部147で行われる処理を示すフローチャートである。図21は、図20の処理の続きを示すフローチャートである。
 初めに、自律走行経路生成部147は、圃場外周設定部33で設定された圃場外周の位置、作業領域設定部35で設定された作業領域の位置、開始終了位置設定部151で設定された開始地点及び終了地点の位置、並びに作業方向設定部36で設定された作業方向の情報を取得して、これらの情報に基づいて暫定走行経路T0を生成する(図22を参照)。具体的には、自律走行経路生成部147は、圃場内に障害物がないものとみなして、作業領域内に複数の暫定走行路P0を互いに間隔を空けて並べた暫定走行経路T0を生成する(ステップS201)。それぞれの暫定走行路P0は、作業方向に沿うように配置されている。
 自律走行経路生成部147により生成される暫定走行経路T0の例を図22に示している。図22は、複数の暫定走行路P0を並べた暫定走行経路T0を生成した例を示す図である。図22において、実線の矢印で示した経路は、無人のトラクタ1が走行する走行経路である。無人のトラクタ1が走行する走行路に隣接する(矢印が付された2列の走行路間に配される)、矢印が付されていない走行路は、協調作業を行うための有人のトラクタが無人のトラクタ1に付随して走行する走行路を示している。図22の例では、有人のトラクタは、往路(図22の紙面上方に向かう方向の走行路)では無人のトラクタ1の右斜め後ろを、復路(図22の紙面下方に向かう方向の走行路)では左斜め後ろを、それぞれついて行くように走行することが想定されている。
 続いて、自律走行経路生成部147は、障害物外周設定部34から障害物外周領域を取得して、ステップS201で生成した暫定走行路P0の中に、障害物外周領域と干渉する暫定走行路があるか否かを判断する(ステップS202)。
 ステップS202の判断の結果、障害物外周領域と干渉する暫定走行路がない場合(ステップS202、No)、圃場内に障害物がないものとみなして作成した暫定走行経路T0を走行経路Tとしてそのまま使うことができるため、自律走行経路生成部147はこの暫定走行経路T0を走行経路Tとして(ステップS203)、経路の生成を終了する。
 一方、ステップS202の判断の結果、障害物外周領域と干渉する暫定走行路がある場合(ステップS202、Yes)、自律走行経路生成部147は、障害物を回避した走行経路を作成するために、ステップS204以降の処理を行う。
 ステップS204の処理において、自律走行経路生成部147は、障害物外周領域と干渉する暫定走行路P0のそれぞれについて、当該暫定走行路P0の始端である地点Fを始点とし、障害物外周領域に至る点である地点Gを終点とする第1走行路P1を取得する。図23に、1つの暫定走行路P0に関して第1走行路P1を生成している様子を示している。
 続いて、ステップS205の処理において、自律走行経路生成部147は、第1走行路P1の終点(地点G)を始点とし、障害物外周領域を通過しつつ障害物反対側に回って、当該障害物を貫くように第1走行路P1を延長した仮想延長線L上の位置であって、障害物外周領域から出る位置(地点H)に至る迂回路Qを生成する。図24に、1つの暫定走行路P0に関して迂回路Qを生成している様子を示している。図24に示すように、この迂回路Qは、当該暫定走行路P0を基準として未作業領域側(言い換えれば、第1走行路P1に至るまでの走行経路から見て遠い側)に迂回するように生成される。
 続いて、ステップS206の処理において、自律走行経路生成部147は、迂回路Qの終点(地点H)を始点とし、暫定走行路P0の終端(地点J)を終点とする第2走行路P2を取得する。この第2走行路P2は、暫定走行路P0上に配置される。なお、上記の図24に、1つの暫定走行路P0に関して第2走行路P2を生成している様子を示している。
 続いて、ステップS207の処理において、自律走行経路生成部147は、障害物外周領域と干渉する個々の暫定走行路P0に対して生成した迂回路Q1,Q2,Q3,・・・の中に、所定距離L1以上の経路長の迂回路が1つ以上あるか否かを判断する。
 ステップS207の判断の結果、所定距離L1以上の長さの迂回路Qが1つもない場合(ステップS207、No)、トラクタ1が迂回路Qを通るように走行させても走行経路が極端に長くなってしまうことはないので、この迂回路Qを走行経路として採用する。
 即ち、ステップS208において、自律走行経路生成部147は、障害物外周領域と干渉する暫定走行路P0のそれぞれを、当該暫定走行路P0に基づいて生成した第1走行路P1、迂回路Q、第2走行路P2からなる走行路に置き換える。これにより、障害物を迂回した走行経路T1が生成される。図25に、障害物を迂回することにより障害物を回避する走行経路T1を生成した例を示している。
 一方、ステップS207の判断の結果、所定距離L1以上の長さの迂回路Qが1つ以上あった場合(ステップS207、Yes)、トラクタ1を迂回路Qに沿って走行させると走行経路が過剰に長くなってしまい作業が非効率となるので、この迂回路Qは走行経路として採用されない。
 即ち、長さが所定距離L1以上になってしまう迂回路Qがある場合は、図21に示すステップS211において、自律走行経路生成部147は、生成した各迂回路Q1,Q2,Q3,・・・及び第2走行路P2を破棄する。続いて、ステップS212において、自律走行経路生成部147は、第1走行路P1の終点(地点G)を始点とし、障害物外周領域を通過しつつ未作業領域側に折り返す折返し路Dを生成する。図26に、1つの第1走行路P1に関して折返し路Dを生成している様子を示している。
 続いて、ステップS213において、自律走行経路生成部147は、折返し路Dの終点(地点K)を始点とし、第1走行路P1を生成した暫定走行路P0の未作業側に平行に配置される次の暫定走行路P0の終端(地点M)を終点とする第3走行路P3を生成する。上記の図26に、1つの第1走行路P1に関して復路としての第3走行路P3を生成している様子を示している。
 続いて、ステップS214において、自律走行経路生成部147は、障害物外周領域と干渉し、連続する往復の暫定走行路P0を(複数の往復路がある場合には、そのそれぞれを)、第1走行路P1、折返し路D、第3走行路P3からなる走行路に置き換える。これにより、障害物の手前で折り返した走行経路T2が生成される。図27に、障害物の手前で折り返すことにより障害物を回避する走行経路T2を生成した例を示している。
 なお、ステップS214の処理により障害物の手前で折り返す走行経路を生成した場合、障害物の反対側の領域においても、図27において破線で示すように、障害物の手前で折り返す走行経路T3が適宜生成される。図27では、無人トラクタ1は走行経路T2を走行しながら農作業を行って終了地点に到達した後、非作業領域を通って走行経路T3の始点に移動し、走行経路T3を走行しながら農作業を行う例が示されている。ただし、上記は一例であって、例えば、障害物で分断された一側の領域を作業した後、すぐに反対側を作業するように走行経路が生成されてもよい。
 以上に説明したように、本実施形態の自律走行経路生成システム199は、予め定められた作業領域においてトラクタ1を自律走行させるための走行経路を生成する。この自律走行経路生成システム199は、作業方向設定部36と、自律走行経路生成部147と、障害物外周設定部34と、を備える。作業方向設定部36は、作業領域内におけるトラクタ1の走行方向(作業方向)を設定する。自律走行経路生成部147は、作業領域内において作業方向設定部36により設定された作業方向に沿って設けられた複数の走行路を含む走行経路を生成可能である。障害物外周設定部34は、作業領域内の障害物に対して障害物外周領域を設定する。自律走行経路生成部147は、第1走行路P1と、迂回路Qと、第2走行路P2と、を含むように走行経路を生成することが可能である(図22から図25までを参照)。第1走行路P1は、作業方向に沿って配置される。迂回路Qは、第1走行路P1の終点(地点G)を始点とし、障害物外周領域を通過しつつ障害物の反対側に回って、当該障害物を貫くように第1走行路P1を延長した仮想延長線L上の位置に至る。第2走行路P2は、迂回路Qの終点(地点H)を始点とし、仮想延長線L上に配置される。
 これにより、第1走行路P1と、迂回路Qと、第2走行路P2とを含む走行経路が生成される。よって、この走行経路に沿ってトラクタ1を自律走行させることにより、障害物を迂回するようにトラクタ1を走行させることが可能である。しかも、迂回路Qは事前に設定された障害物外周領域を通過するように配置されるので、走行経路全体との関係等を考慮して迂回路を計画的に生成することで、無人トラクタ1による作業を円滑にすることができる。また、迂回路Q以外の部分では、走行路を作業方向に沿った経路とすることができ、自律走行経路生成のアルゴリズムをシンプルにすることができる。このように、走行路を基本的には作業方向に沿った直線状又は折れ線状の経路とすることにより、複数の走行路を1セットとして取り扱うことが容易となり、1セットごとに農作業を行っていくようなやり方も容易に実現できる。
 また、本実施形態の自律走行経路生成システム199においては、自律走行経路生成部147は、迂回路Qの経路長が所定距離L1未満である場合に、第1走行路P1、迂回路Q及び第2走行路P2を含むように走行経路を生成することが可能である(図25を参照)。一方、自律走行経路生成部147は、前記迂回路の経路が所定距離L1以上である場合に、第1走行路P1、折返し路D及び第3走行路P3を含むように前記走行経路を生成することが可能である(図27を参照)。折返し路Dは、第1走行路P1の終点(地点G)を始点とし、障害物外周領域を通過しつつ障害物の手前で折り返す(図26を参照)。第3走行路P3は、折返し路Dの終点(地点K)を始点とし、第1走行路P1と平行に配置される。
 これにより、迂回路Qの経路長が所定距離L1以上になる場合には、障害物を迂回する経路に代えて、障害物の手前で折り返す経路を走行経路として生成することができる。従って、走行経路のうち作業に寄与しない部分が過剰に長くなってしまうことを防止できる。
 また、本実施形態の自律走行経路生成システム199においては、自律走行経路生成部147は、作業領域において障害物が島状に配置されている場合、迂回路Qを、第1走行路P1に至るまでの走行経路から見て遠い側(未作業領域側)から障害物の反対側に回るように生成する。
 これにより、トラクタ1を自律走行経路生成部147で生成した走行経路T1に沿って走行させても、障害物を迂回するときに、第1走行路P1に至るまでにトラクタ1が走行してきた領域(農作業を施した領域)に再度踏み込むことがない。よって、トラクタ1に行わせた作業に影響が出ないようにしつつ、障害物を回避してトラクタ1を走行させることができる。また、無人トラクタ1に付随して有人トラクタを走行させている場合、無人トラクタ1が障害物を迂回するときに有人トラクタの側に接近することを防止することができ、衝突等が発生しない。
 <第3実施形態>
 次に、本開示の第3実施形態に係る自律走行経路生成システム199について、図24及び図28等を参照して説明する。以下では、第2実施形態と同様の構成の部材及びステップには同一の符号を付し、説明を適宜省略する場合がある。
 第3実施形態に係る自律走行経路生成システム199において、走行経路を生成するときに自律走行経路生成部147で行われる処理は、大体においては第2実施形態と同様であるが、ステップS207に代えてステップS307の処理が行われる点で異なっている。
 ステップS307の処理において、自律走行経路生成部147は、障害物外周領域と干渉する個々の暫定走行路P0に対して生成した迂回路Q1,Q2,Q3,・・・の中に、トラクタ1が障害物を回避(迂回)するために作業方向と垂直な向きに移動しなければならない距離である回避距離L10(図24を参照)が所定距離L2以上である迂回路が1つ以上あるか否かを判断する。
 ステップS307の判断の結果、回避距離L10が所定距離L2以上の迂回路Qが1つもない場合(ステップS307、No)、トラクタ1が迂回路Qを通るように走行させても、作業領域内に障害物がない場合と比べて走行経路の経路長が極端に長くなってしまうことはないので、この迂回路Qを用いて障害物を回避することとする。即ち、ステップS208の処理がされて迂回路Qを含む走行経路T1が生成される。
 一方、ステップS307の判断の結果、回避距離L10が所定距離L2以上の迂回路Qが1つ以上あった場合(ステップS307、Yes)、トラクタ1を迂回路Qに沿って走行させると走行経路の経路長が極端に長くなってしまい作業が非効率となるので、この迂回路Qは採用されない。即ち、自律走行経路生成部147は、図21に示すステップS211からステップS214までの処理により、迂回路の代わりとなる折返し路Dを生成する。
 本実施形態の処理によっても、迂回路が過剰に長くなってしまうことを防止できる。また、本実施形態では迂回路Qの経路長ではなく回避距離L10を用いて判定するので、迂回路Qが長過ぎるかどうかを自律走行経路生成部147が簡便に判断することができる。
 以上に説明したように、本実施形態の自律走行経路生成部147は、トラクタ1が障害物を回避するために作業方向と垂直な向きに移動しなければならない距離である回避距離L10が所定距離L2未満である場合に、第1走行路P1、迂回路Q及び第2走行路P2を含むように走行経路を生成することが可能である。一方、自律走行経路生成部147は、回避距離L10が所定距離L2以上である場合に、第1走行路P1、折返し路D及び第3走行路P3を含むように走行経路を生成することが可能である。折返し路Dは、第1走行路P1の終点(地点G)を始点とし、障害物外周領域を通過しつつ障害物の手前で折り返す。第3走行路P3は、折返し路の終点(地点K)を始点とし、第1走行路P1と平行に配置される(図26を参照)。
 これにより、障害物を迂回するために作業方向と垂直な向きに移動しなければならない回避距離L10が所定距離L2以上になる場合には、障害物を迂回する経路に代えて、障害物の手前で折り返す経路T2を走行経路として生成することができる。従って、走行経路T2のうち作業に寄与しない部分が過剰に長くなってしまうことを防止できる。
 <第4実施形態>
 次に、本開示の第4実施形態に係る自律走行経路生成システム199について、図29等を参照して説明する。以下では、第2実施形態と同様の構成の部材及びステップには同一の符号を付し、説明を適宜省略する場合がある。
 第4実施形態に係る自律走行経路生成システム199において、走行経路を生成するときに自律走行経路生成部147で行われる処理は、大体においては第2実施形態と同様であるが、ステップS207に代えてステップS407の処理が行われる点で異なっている。
 ステップS407の処理において、自律走行経路生成部147は、障害物外周領域と干渉する個々の暫定走行路P0に対して生成した迂回路Q1,Q2,Q3,・・・の中に、トラクタ1が障害物を回避(迂回)するために必要となる旋回回数又は旋回角度が所定以上(例えば、5回以上、又は120°以上)の迂回路が1つ以上あるか否かを判断する。
 ステップS407の判断の結果、旋回回数又は旋回角度が所定以上の迂回路Qが1つもない場合(ステップS407、No)、トラクタ1が迂回路Qを通るように走行させても、それほど複雑な経路とはならないので、この迂回路Qを用いて障害物を回避することとする。即ち、ステップS208の処理がされて迂回路Qを含む走行経路が生成される。
 一方、ステップS407の判断の結果、旋回回数又は旋回角度が所定以上の迂回路Qが1つ以上あった場合(ステップS407、Yes)、トラクタ1を迂回路Qに沿って走行させると走行経路が複雑になってしまい、作業が非効率になったりユーザが混乱したりするおそれがあるので、この迂回路Qは採用されない。即ち、自律走行経路生成部147は、図21に示すステップS211からステップS214までの処理により、迂回路の代わりとなる折返し路Dを生成する。
 以上に説明したように、本実施形態の自律走行経路生成部147においては、迂回路Qにおける旋回回数又は旋回角度が所定未満である場合に、第1走行路P1、迂回路Q及び第2走行路P2を含むように走行経路を生成することが可能である。一方、自律走行経路生成部147は、迂回路Qにおける旋回回数又は旋回角度が所定以上である場合に、第1走行路P1、折返し路D及び第3走行路P3を含むように走行経路を生成することが可能である。折返し路Dは、第1走行路P1の終点(地点G)を始点とし、障害物外周領域を通過しつつ障害物の手前で折り返す。第3走行路P3は、折返し路Dの終点(地点K)を始点とし、第1走行路P1と平行に配置される。
 これにより、障害物を迂回するために必要となる旋回回数又は旋回角度が所定以上である場合には、障害物を迂回する経路に代えて、障害物の手前で折り返す折返し路Dを含む経路を走行経路として生成することができる。従って、旋回回数又は旋回角度が多い走行経路を生成してしまうことを防止できるので、作業を円滑に行うことができる。
 このように、本実施形態の自律走行経路生成システム199では、走行路が極力直線状となるようにしつつ、かつ障害物を回避できるようにしている。また、障害物を回避するためのパスとして、障害物を迂回するパスと、障害物の手前で折り返すパスと、を適宜使い分けることとしている。このように、走行路が極力直線状に生成されることにより、自律走行経路生成のアルゴリズムをシンプルにすることができ、また、ユーザにとっても分かり易い走行経路とすることができる。
 以上に第2実施形態から第4実施形態までの好適な実施の形態を説明したが、これらの実施形態の構成は例えば以下のように変更することができる。
 上記の実施形態では、自律走行経路生成部147は、作業領域内に第1走行路P1、迂回路Q、及び第2走行路P2からなる走行路を生成するものとした。言い換えれば、障害物を回避するための走行路を、作業領域内に収まるように生成するものとした。しかしながら、必ずしもこれに限るものではなく、例えばこれに代えて、迂回路Qが非耕作地(非作業領域)にはみ出るように走行路を生成してもよい。
 上記の実施形態では、自律走行経路生成部147は、迂回路Qを、未作業領域側に迂回するように生成するものとした。しかしながら、必ずしもこれに限るものではなく、例えばこれに代えて、未作業領域側に迂回する迂回路QAと、作業領域側(既に農作業を行った側)に迂回する迂回路QBとを暫定的に生成し、これらの迂回路QA,QBの経路長を比較して、長さが短くなる方の迂回路を採用することとしてもよい。
 例えば、無人トラクタ1に付随して有人トラクタを当該無人トラクタ1の斜め後ろに位置するように走行させて、協調作業を行っているような場合において、無人トラクタ1を迂回路Qに沿って走行させると有人トラクタに接近するおそれがあるときには、その旨の警告を無線通信端末46のディスプレイ37に表示することとしてもよい。具体的には、警告を示す表示用データを表示制御部31で生成し、この表示用データに基づく警告画面をディスプレイ37に表示させることとすればよい。なお、上記のような警告画面の表示例を図30に示している。
 上記の実施形態では、障害物が作業領域内に島状にあるものとした。しかしながら、実際には、障害物が作業領域の輪郭と重なるように配置されている状況も当然に考えられる。例えば、図31には、障害物が圃場の端部から中央に向けて突出するように配置された例が示されている。本発明の自律走行経路生成システム199では、このような場合でも、障害物を回避しつつ効率のよい走行経路を生成することができる。なお、図31のように、未作業領域側に迂回する迂回路を作成することが物理的に不可能な場合には、これに代えて、作業領域側(既に農作業を行った側)に迂回する迂回路を生成することとしてもよい。
 上記の実施形態に開示した発明は、圃場の輪郭が複雑になっている場合にも適用することができる。例えば、図32のように圃場の輪郭に凹状の部分が形成されている場合、当該圃場の外周の形状が圃場外周設定部33で設定されることになる。このような場合でも、単純な矩形の圃場において障害物が内側に向かって突出状に配置されているとみなせば、図31の場合と全く同様に考えることができる。即ち、本発明は、圃場の輪郭の一部が凹状となっているために実質的に「障害物」となる場合にも適用することができる。
 図20のステップS207で、複数の迂回路の中に所定距離L1以上の経路長の迂回路が1つ以上あるか否かを判断することに代えて、複数の迂回路の経路長の合計が所定距離以上あるか否かを判断してもよい。同様に、図28のステップS307で、回避距離の合計が所定距離以上あるか否かを判断してもよい。
 無人トラクタ1が障害物を迂回し始めるときに、ウインカー等の方向指示器を機能させて、無線通信端末46のユーザや有人トラクタのオペレータ等に注意を促すこととしてもよい。これにより、例えば無人トラクタ1が有人トラクタに接近するおそれがある場合に、ユーザがこれを察知することができ、衝突等を未然に防ぐことができる。
 上記の実施形態では、迂回路Qとして、第1走行路P1の終点Gを始点とし、障害物外周領域を通過しつつ障害物の反対側に回って、当該障害物を貫くように第1走行路P1を延長した仮想延長線L上の位置に至る迂回路Qを生成することとしたが、これに限られるものではない。即ち、迂回路は、障害物を隔てて配される第1走行路の終点(障害物外周領域に至った点)と第2走行路の始点(障害物外周領域から出る点)を接続する通路であればよく、第2走行路の始点は、第1走行路を延長した仮想延長線上の点でなくてよい。第2走行路の始点が、第1走行路を延長した仮想延長線上の点でない場合とは、例えば図33に示すように、暫定走行路P0’が折れ線状の走行路であって、第1走行路P1’と第2走行路P2’とが屈折部を介して接続されることで折れ線状の暫定走行路P0’が形成されており、且つ、屈折部が障害物外周領域又は障害物が存在する領域に位置する場合が例示される。なお、図33においては、第1走行路P1’の始点をF’、終点をG’、第2走行路P2’の始点をH’、終点をJ’、迂回路をQ’として示している。
 上記の実施形態では、作業領域において障害物が島状に存在している場合、障害物外周領域において、迂回路Qを第1走行路P1に至るまでの走行経路から見て遠い側から障害物の反対側に回るように生成することとしたが、これに限られるものではない。迂回路は、障害物外周領域のうち終了地点に近い側に生成することとすればよく、言い換えれば、迂回路は障害物外周領域に至った後、障害物外周領域内において終了地点に向かって旋回させる旋回路を含むように生成することとすればよい。
 即ち、作業領域において走行路の本数は、作業領域の幅及びトラクタ1(作業機3)の車幅が考慮されて定まるが、各作業路における作業順はユーザの指定に応じて適宜設定することが可能である。ユーザの指定としては、現在走行中の走行路P10と次に走行する走行路P11との間の作業路の本数(スキップ数)を指定することが可能であり、当該本数が0である場合、走行路P10と走行路P11は隣接し、当該本数が2である場合、走行路P10と走行路P11は2本の走行路を隔てて配されていることとなる。各作業路における作業順は原則として開始地点から終了地点に向かって順次設定されるが、上記本数が0以外である場合、一部、終了地点から開始地点に向かって設定される(言い換えれば、終了地点近くの走行路を走行した後、開始地点近くの未耕の走行路を走行する)ことがある。そして、終了地点から開始地点に向かった後に走行する未耕の走行路上に障害物が存在する場合、迂回路は他の未耕の走行路側、即ち、終了地点側を通るように障害物外周領域内に生成される。
 なお、終了地点から開始地点に向かった後に走行する未耕の走行路上に障害物が存在する場合において隣接する走行路が双方ともに既耕の走行路である場合、迂回路の経路長がより短い迂回路、又は、旋回回数がより少ない迂回路を生成することとすればよい。
 <第5実施形態>
 上記の実施形態では障害物がないものとみなして複数の暫定走行路を含む暫定走行経路を生成し、各暫定走行路が障害物外周領域と干渉するか否かに応じて、適宜、修正して(置き換えて)走行経路を生成することとしたが、走行経路の生成方法はこれに限られるものではない。上記の実施形態において障害物がないものとみなして暫定走行経路を生成したのは、走行経路を生成する処理において、暫定走行路を迂回路を含む走行路に置き換えるか否かの判断処理(例えば図20のステップS207)が、暫定走行路を生成した後に行われるためであるが、事前に当該判断を行うことで暫定走行路を生成することなく走行路を生成することとしてもよい。
 具体的には、障害物外周設定部34により障害物の外周領域が設定された際に、当該障害物の外周領域において迂回路を生成するか否かが定められることにより実現可能である。例えば、上記の図20のステップS207の処理において所定距離以上の長さの迂回路が1つ以上あった場合、迂回路の経路長が過剰に長くなり、作業が非効率となることを避けるために、迂回路を走行経路として採用しないこととしているが、障害物外周設定部34により設定された障害物の外周領域において仮に迂回路が生成された場合の迂回路の経路長は、事前に算出可能である。例えば障害物の外周領域が中空の矩形状の領域である場合、迂回路の最大経路長は、原則として、当該外周領域の外縁の横辺(作業方向に垂直な方向の辺)の長さと、縦辺(作業方向に平行な方向の辺)の長さの合計の長さ(以下、最大経路長Aと称する)である。ここで「原則として」とは、迂回路の経路長が最も短くなるように生成するならばという意味であり、例えば他の要因(例えば、上述した既耕の走行路側を生成せず、未耕の走行路側を生成するという要因)により迂回路の経路長が最も短くなるように生成しない場合において、当該外周領域の外縁の横辺(作業方向に垂直な方向の辺)の長さの2倍の長さと、縦辺(作業方向に平行な方向の辺)の長さの合計の長さ(以下、最大経路長Bと称する)である。そして、自律走行経路生成部147は、少なくとも最大経路長Aが所定距離以上となる障害物の外周領域においては、迂回路を含まない走行路を生成するとともに、最大経路長A及び最大経路長Bの何れもが所定距離未満となる障害物の外周領域においては、迂回路を含む走行路を生成して各走行路を含む走行経路を生成することが可能である。
 図34のステップS501~S504には、上記の手法で走行経路を生成するときに自律走行経路生成部147で行われる処理をフローチャートで簡易的に示している。この処理を説明すると、最初に、自律走行経路生成部147は全ての障害物外周領域について予め最大経路長を計算する(ステップS501)。その後、自律走行経路生成部147は、作業領域のうち障害物外周領域(障害物)と干渉しない部分について、折返しも迂回もない走行路を生成する(ステップS502)。次に、自律走行経路生成部147は、作業領域のうち障害物外周領域と干渉する部分については、当該障害物外周領域の最大経路長が所定値以上である場合は折返し路を含む走行路を生成し(ステップS503)、所定値未満である場合は迂回路を含む走行路を生成する(ステップS504)。このように、迂回路を含む走行路を生成するか否かを、障害物の外周領域に対応付けておくことで、暫定走行路を生成することなく走行経路を生成することが可能である。
 上記の実施形態では、図略の入力画面で枕地の幅及び非耕作地の幅を設定することで非作業領域が定められ、圃場から非作業領域を除外した残りの領域として作業領域が定められている。しかしながら、作業領域を設定する方法は上記に限らず、例えば、上述の圃場情報入力画面182において平面表示部88に表示された圃場の任意の点をユーザが指定することで作業領域及び非作業領域を設定できるように構成されてもよい。
 本発明の自律走行経路生成システムは、上述の無人トラクタ1と有人トラクタとの協調作業に限定されず、無人トラクタ1のみが単独で自律走行・自律作業を行う場合にも適用することができる。
 上記の実施形態では、自律走行経路生成システム199を構成する作業方向設定部36と、自律走行経路生成部147と、障害物外周設定部34とは、無線通信端末46側に備えられているものとしたが、これに限るものではない。即ち、作業方向設定部36、自律走行経路生成部147、及び障害物外周設定部34のうちの一部又は全部がトラクタ1側に備えられているものとしてもよい。
 <第6実施形態>
 次に、本開示の第6実施形態に係る自律走行経路生成システム299について、主として図35から図44までを参照して詳細に説明する。図35は、第6実施形態に係るロボットトラクタ1及び無線通信端末46の電気系の主要な構成を示すブロック図である。
 本実施形態のトラクタ1は、カメラ(外部環境情報取得部)を備えている。カメラ247はトラクタ1の前方を撮影することで動画又は画像を検出する。図1及び図2には示していないが、カメラ247はトラクタ1のルーフ29に取り付けられている。カメラ247で撮影された動画又は画像のデータは、無線通信部40により、無線通信用アンテナ48から無線通信端末46に送信される。動画又は画像のデータを受信した無線通信端末46は、その内容をディスプレイ37に表示する。
 また、カメラ247が撮影した動画又は画像は、制御部4又は無線通信端末46で画像解析される。これにより、圃場における外部環境情報、例えば、トラクタ1の周囲に存在する特定対象(例えば、畝又は溝等の圃場表面形状、石等の障害物圃場の端部)の位置、大きさ等が検出される。また、取得した画像又は動画のうち特定対象が占める範囲(特定対象の大きさ)、特定対象が表示される位置等に基づいて、特定対象の位置(特定対象が存在する方向及び特定対象までの距離)が検出される。なお、特定対象の検出結果に応じて行われる処理については後述する。
 本実施形態の自律走行経路生成システム299の主要な構成は、無線通信端末46に備えられる。本実施形態の自律走行経路生成システム299は、上述した制御部71、通信部72、表示制御部31、記憶部32、圃場外周設定部33、障害物外周設定部34、作業領域設定部(走行領域設定部)35、開始終了位置設定部151、及び作業方向設定部(走行方向設定部)36等の他に、更に、経路生成部276、補正情報算出部277、及び補正経路生成部278等を備える。
 本実施形態の無線通信端末46も、第1実施形態の場合と同様に、上記したソフトウェアとハードウェアの協働により、経路生成部276、補正情報算出部277、及び補正経路生成部278等として動作することができる。
 本実施形態の経路生成部276も、上記の実施形態と同様に、走行経路を、基本的には、直線状又は折れ線状の走行路が作業領域に含まれ、旋回路が圃場内の作業領域以外の領域(非作業領域)に含まれるように生成する。ただし、圃場内に障害物が存在する場合には、経路生成部276は、障害物を回避するように走行経路を生成する。これについては、後に詳述する。経路生成部276が生成した走行経路は、記憶部32に記憶される。
 補正情報算出部277は、カメラ247が取得した特定対象(例えば、畝又は溝等の圃場表面形状、石等の障害物、圃場の端部)の検出結果に基づいて、走行経路を補正するための補正情報を算出する。補正経路生成部278は、補正情報算出部277が算出した補正情報に基づいて、走行経路を補正した補正経路を生成する。なお、補正情報算出部277及び補正経路生成部278が行う詳細な処理は後述する。
 次に、カメラ247が検出した外部環境情報に基づいて畝の位置を検出し、走行経路を自動補正する処理について図36から図41を参照して説明する。ここで、自動補正とは、無線通信端末46が走行経路を補正した補正経路を生成することをいい、加えて記憶部32に記憶されている走行経路を補正経路に更新することを含めてもよい。
 初めに、圃場に形成された畝に沿ってトラクタ1が作業を行う際に設定される走行経路Tについて説明する。図37に示すように、走行経路Tは、走行路P5~P8と、旋回路U5~U7と、で構成されている。走行路P5~P8は、圃場に形成された畝の中央を通るように形成された直線状の経路である。旋回路U5は、走行路P5と走行路P6を接続する円弧状の経路である。旋回路U6は、走行路P6と走行路P7を接続する円弧状の経路である。旋回路U7は、走行路P7と走行路P8を接続する円弧状の経路である。
 ここで、図38に示すように、開始地点側の畝の位置(詳細には畝の中央位置)が圃場の端部側(終了地点の反対側)にズレている場合を考える。この場合において、記憶部32には、図37に示す走行経路Tが記憶されているとする。従って、走行経路Tを補正せずに走行すると、トラクタ1が畝の中央を通過しないため、トラクタ1による作業が適切に行われなくなる可能性がある。この点、本実施形態の無線通信端末46は、図36に示すフローチャートに基づいて処理を行うことで、畝の位置ズレを考慮して走行経路Tを補正可能である。
 初めに、無線通信端末46は、カメラ247が検出した画像(動画であってもよい、以下同じ)を解析することで、畝を検出したか否かの判断を行う(ステップS601)。例えば、畝が形成されている部分は他の部分よりも高くなっているため、無線通信端末46は、カメラ247が検出した画像に基づいて、畝が形成されている部分と、畝が形成されていない部分と、を区別することができる。以上のようにして、無線通信端末46は、畝を検出する。図38に示す例では、例えばトラクタ1の自律走行及び自律作業の開始が指示されたタイミングや、トラクタ1が開始地点に到着したタイミング又はその少し前のタイミング等の適宜のタイミングにおいて、無線通信端末46が開始地点側の端部の畝を検出する。
 ステップS601にて畝を検出したと判断した場合、無線通信端末46は、カメラ247で検出した畝の中央位置(実際の畝の中央位置)を検出する(ステップS602)。畝の中央位置とは、畝の幅方向(短手方向)の中央の位置である。無線通信端末46は、カメラ247が検出した画像に基づいて、トラクタ1から畝までの距離を算出する。これにより、トラクタ1に対する畝の相対位置を検出できる。また、トラクタ1の絶対位置は、位置情報算出部49により検出可能である。無線通信端末46は、トラクタ1に対する畝の相対位置と、トラクタ1の絶対位置と、に基づいて、畝の絶対位置(即ち走行経路上における畝の位置)を検出できる。無線通信端末46は、絶対位置を求めた畝の幅方向の中央を特定することで、畝の中央位置(絶対位置)を算出する。図38に示す例では、無線通信端末46は、開始地点側の端部の畝の中央位置を検出する。
 次に、無線通信端末46は、登録した走行経路と、畝の中央位置と、が閾値以上異なるか否か判断する(ステップS603)。無線通信端末46は、記憶部32に記憶している走行経路(詳細には走行経路のうち今回検出した畝を通る走行路)と、ステップS602で検出した畝の中央位置と、を比較することで、両者のズレ量を算出する。図38に示す例では、畝は幅方向に平行にズレて形成されているため、畝の長手方向にわたってズレ量は一定である。
 また、ステップS603における閾値は任意であるが、例えば以下の条件を満たす値であることが好ましい。即ち、本実施形態ではGNSS-RTK法を利用した高精度の衛星測位システムが用いられているが、微量(2~3cm程度)の測定誤差は生じ得る。従って、閾値は、トラクタ1の位置の測定誤差より大きい値(例えば、2cm以上、3cm以上、4cm以上)であることが好ましい。また、トラクタ1の作業を阻害しないズレ量に基づいて閾値を定めてもよい。また、閾値は、オペレータが無線通信端末46を操作することで変更可能であってもよい。
 無線通信端末46は、登録した走行経路と、畝の中央位置と、のズレ量(相違)が閾値より小さいと判断した場合(ステップS603、No)、この畝については補正経路を生成せずにステップS601の処理に戻る。一方、無線通信端末46は、登録した走行経路と、畝の中央位置と、が閾値以上異なると判断した場合(ステップS603、Yes)、トラクタ1が自律走行中であれば自律走行の停止信号をトラクタ1へ送信して、トラクタ1を一時停止させる(ステップS604)。トラクタ1が自律走行中でなければステップS605に進む。
 次に、無線通信端末46は、走行経路の自動補正についてオペレータの許可があるか否か判断する(ステップS605)。無線通信端末46は、走行経路の自動補正を許可する旨の設定が事前に行われていた場合、オペレータの許可があると判断する。走行経路の自動補正の許可が事前に設定されていない場合、無線通信端末46は、ディスプレイ37に所定の内容を表示して、オペレータに自動補正の許可を求める。
 無線通信端末46は、例えば、「走行経路の自動補正を許可する」及び「走行経路の自動補正を許可しない」をディスプレイ37に表示する。「走行経路の自動補正を許可する」がオペレータに選択された場合、例えば、「1つの走行路を自動補正」及び「全ての走行路を自動補正」が表示される。「1つの走行路を自動補正」がオペレータにより選択された場合、無線通信端末46は、1本の走行路(図38における走行路P5)を自動補正し、他の走行路(図38における走行路P6~P8)は自動補正しない。また、「全ての走行路を自動補正」がオペレータにより選択された場合、無線通信端末46は、全ての走行路(図38における走行路P5~P8)を自動補正する。
 なお、「走行経路の自動補正を許可しない」がオペレータにより選択された場合、無線通信端末46には、「走行経路を手動補正する」、「走行経路を補正せずに作業を続行する」、「作業を中止する」等の選択肢が表示される。
 無線通信端末46(詳細には補正情報算出部277)は、走行経路の自動補正についてオペレータの許可があると判断した場合(ステップS605、Yes)、トラクタ1の位置情報及び畝の中央位置等に基づいて補正情報を算出する(ステップS606)。上述したように、無線通信端末46は、位置情報算出部49が検出したトラクタ1の絶対位置と、トラクタ1に対する畝の相対位置と、に基づいて、実際の畝の絶対位置(即ち走行経路上の実際の畝の位置)を検出できる。
 補正情報とは、走行経路を補正するための情報であり、具体的には、走行経路のオフセット量、オフセット方向、走行経路の角度変更量等である。図38に示す例では、畝は幅方向に平行にズレて形成されているため、走行経路のオフセット量及びオフセット方向が補正情報に相当する。なお、複数本の経路を補正する場合、経路毎に補正情報が算出される。無線通信端末46は、ステップS603で求めた、走行経路と、畝の中央位置と、のズレ量をオフセット量とする。また、無線通信端末46は、畝の実際の中央位置に対して走行経路がズレている方向をズレ方向とする。
 次に、無線通信端末46(詳細には補正経路生成部278)は、ステップS606で算出した補正情報に基づいて補正経路を生成し、記憶部32に記憶されている走行経路を更新する(ステップS607)。図38に示すように実際の畝の位置がズレている場合、図39に示すように補正経路が生成される。なお、図39では、1本の走行路を自動補正する旨が選択された場合に生成される補正経路が示されている。図39に示す例では、無線通信端末46は、走行路P5を補正した補正経路である走行路P51を生成する。また、無線通信端末46は、旋回路U5を補正した補正経路である旋回路U51を生成する。図39に示す走行路P51の生成方法としては例えば走行路P5の始点及び終点の位置を上記補正情報に基づいてオフセットさせ、オフセット後の始点及び終点を接続する経路を走行路P51として生成する。つまり、補正経路生成部278は、予め生成された走行路P5の位置(走行路P5として幅情報が含まれる場合には中央位置)及び検出した畝の中央位置に基づいて算出される補正情報に基づいて、当該走行路P5の始点及び終点をオフセットさせ、オフセット後の始点及び終点に基づいて走行路P5とは異なる新たな走行路P51を補正経路として生成することが可能である。
 次に、無線通信端末46は、トラクタ1の走行を再開し、ステップS607で更新した走行経路に沿ってトラクタ1を走行させる(ステップS608)。その後も無線通信端末46は、畝を検出したか否かの判断を行い(ステップS601)、畝を検出した場合は、ステップS602以降の処理を行う。このように連続して上記の処理を行うことで、走行路P6~P8と実際の畝の中央位置がズレている場合であっても、当該走行路P6~P8を補正できる。
 次に、複数本の畝が傾斜するようにズレている場合について、図36、図40及び図41を参照して説明する。
 図40では、予め生成した走行経路に対して実際の畝(カメラ247で検出した畝)が傾斜している。ここで、カメラ247は、トラクタ1の直近の畝の画像だけでなく、更に前方の畝の画像も撮影する。従って、無線通信端末46は、この画像を解析することで、直近だけでなく更に前方の畝の位置を算出可能である。従って、ステップS603において、無線通信端末46は、トラクタ1の直近だけでなく更に前方において、登録した走行経路と、カメラ247で検出した畝の中央位置と、のズレ量を算出可能である。なお、ステップS603では、走行経路と畝の中央位置との位置ズレに基づいて判断を行っているが、これに代えて、走行経路の方向と、畝が形成される方向と、のズレ角に基づいて判断を行ってもよい。
 図40に示す例では、走行経路に対して畝が傾斜しているため、ステップS606において、無線通信端末46(補正情報算出部277)は、補正情報として、走行経路の角度変更量を算出する。上述したように、無線通信端末46は、カメラ247が検出した画像に基づいて畝が形成される方向を検出できる。従って、走行経路の方向と、畝が形成される方向と、を比較することで、走行経路の角度変更量を算出する。
 また、図40に示す例では、全ての畝が走行経路に対して傾斜しているため、オペレータがステップS605において「走行経路の自動補正を許可する」を選択し、更に「全ての走行路を自動補正」を選択したとする。従って、無線通信端末60(詳細には補正経路生成部278)は、ステップS608において、走行路P5~P8について、ステップS606で求めた角度変更量に基づいて、補正経路としての、走行路P51、走行路P61、走行路P71、走行路P81、旋回路U51、旋回路U71(図41を参照)を生成して記憶部32に記憶されている走行経路を更新する。
 以下、走行路P51を例に補正経路の生成方法について説明するが、他の補正経路についても同様に生成可能である。図41に示すように、走行路P5の始点と畝の中央位置とが一致しているものの、畝が形成されている方向がズレている場合における走行路P51の生成方法としては例えば走行路P5の始点は維持したまま、終点の位置を上記補正情報(角度変更量)及び走行路P5の経路長に基づいて算出される値(例えば、経路長×tan(角度変更量))だけオフセットさせ、上記始点及びオフセット後の終点を接続する経路を走行路P51として生成する。つまり、補正経路生成部278は、畝の形成方向に基づいて算出される補正情報に基づいて、当該走行路P5の終点をオフセットさせ、始点及びオフセット後終点に基づいて走行路P5とは異なる新たな走行路P51を補正経路として生成することが可能である。
 なお、図39及び図41を組み合わせて補正経路を生成することも可能であることはいうまでもない。即ち、畝の中心位置が走行経路の位置に対してズレており、且つ、畝の形成方向がズレている場合、前者のズレに基づいて算出される補正情報に基づいて走行路の始点をオフセットするとともに、前者及び後者のズレに基づいて算出される補正情報に基づいて走行路の終点をオフセットして、オフセット後の始点及び終点を接続する経路を走行路P51として生成することが可能である。
 次に、カメラ247が検出した外部環境情報に基づいて障害物の位置及び大きさを検出し、走行経路を自動補正する処理について図42から図44を参照して説明する。以下の説明においても、図37に示す走行経路Tが予め記憶部32に記憶されているものとする。以下、図42のフローチャートを参照して、障害物を検出した場合に走行経路を補正する処理について説明する。
 初めに、無線通信端末46は、カメラ247が検出した画像を解析することで、障害物を検出したか否かの判断を行う(ステップS701)。例えば、障害物(石、ゴミ、別の作業車両)が形成されている部分は他の部分と色及び大きさが異なるため、無線通信端末46は、カメラ247が検出した画像に基づいて、障害物を検出可能である。図43に示す例では、トラクタ1が走行路P5に沿って走行している間に、障害物を検出する。
 ステップS701にて障害物を検出したと判断した場合、無線通信端末46は、畝の場合と同様に、カメラ247で検出した障害物の位置及び大きさを検出する(ステップS702)。障害物の大きさとは、障害物の幅、高さ、奥行きの少なくとも1つである。例えば、障害物の高さによっては、障害物の奥行きが検出できない。この場合、無線通信端末46は、障害物の幅と高さを検出する。また、障害物の高さは走行経路と関連が低いので、障害物の高さの検出を省略してもよい。
 次に、無線通信端末46は、検出した障害物が登録済みか否かを判断する(ステップS703)。ステップS703の判断は、記憶部32に登録(記憶)されている障害物の情報と、ステップS702で検出した障害物の位置及び大きさと、を比較することで行われる。より詳説すれば検出した障害物が登録済みであるか否かは、検出した障害物が存在する領域が登録済みの障害物の領域の少なくとも一部と重複している場合、登録済みであると判断し、登録済みの障害物の領域に重複していない場合、登録済みでないと判断する。
 無線通信端末46は、検出した障害物が登録されている場合(ステップS703、Yes)、登録済みの障害物と検出した障害物の位置又は大きさが閾値以上異なるか否か判断する(ステップS704)。この閾値は、ステップS603と同様に、衛星測位システムの誤差、又は、トラクタ1の作業を阻害するか否かに基づいて決定することが好ましい。
 無線通信端末46は、検出した障害物の位置及び/又は大きさが登録済みの障害物と閾値以上異なる場合(ステップS704、Yes)、自律走行の停止信号をトラクタ1へ送信して、トラクタ1を一時停止させる(ステップS705)。なお、無線通信端末46は、登録済みの障害物と検出した障害物の位置及び/又は大きさのズレ量が閾値より小さい場合(ステップS704、No)、この障害物については補正経路を生成せずにステップS701の処理に戻る。より詳説すれば、検出した障害物が存在する領域が登録済みの障害物の領域と一致し、或いは、内包される場合、並びに、検出した障害物が存在する領域が登録済みの障害物の領域の一部と重複する場合であって、例えば、重複しない領域の大きさが閾値以上である場合には、ステップS705に進む。
 また、無線通信端末46は、検出した障害物が登録されていない場合(ステップS703、No)、自律走行の停止信号をトラクタ1へ送信して、トラクタ1を一時停止させる(ステップS705)。図43に示す例では、登録されていない障害物が検出されたとする。なお、未登録の障害物を検出した場合であっても、当該障害物が閾値以上(例えばトラクタ1の作業を阻害しない程度に)小さい場合は、ステップS701の処理に戻ってもよい。
 次に、無線通信端末46は、走行経路の自動補正についてオペレータの許可があるか否か判断する(ステップS706)。この判断は、基本的には、図36のステップS605と同様である。ただし、障害物はオペレータが手作業で除去できる可能性がある。従って、オペレータは、障害物を除去した後に、「走行経路を補正せずに作業を続行する」を選択することで、登録した走行経路に沿って作業を継続できる。また、障害物の形状によっては、走行路がオーバーラップする(又は予め設定された許容オーバーラップ量を超える)補正経路が生成される場合も考えられる。この場合、無線通信端末46は、オーバーラップに関する許可をオペレータに求める。
 無線通信端末46(詳細には補正情報算出部277)は、走行経路の自動補正についてオペレータの許可があると判断した場合(ステップS706、Yes)、トラクタ1の位置情報、障害物の位置及び大きさ等に基づいて補正情報を算出する(ステップS707)。上述したように、無線通信端末46は、位置情報算出部49が検出したトラクタ1の絶対位置と、トラクタ1に対する障害物の相対位置と、に基づいて、実際の障害物の絶対位置(即ち走行経路上の実際の障害物の位置)を検出できる。ここで補正情報は、検出した障害物が登録済みの障害物である場合、登録済みの障害物の領域を補正した補正後の領域が、登録済みの障害物の領域及び検出した障害物の存在する領域を内包する領域となるように補正するための情報である。これに対して、検出した障害物が登録済みの障害物でない場合、新たに登録すべき障害物の領域として当該領域が、検出した障害物の存在する領域を内包する領域となるように補正する(新たに登録する)ための情報である。
 次に、無線通信端末46(詳細には補正経路生成部278)は、ステップS707で算出した補正情報に基づいて補正経路を生成し、記憶部32に記憶されている走行経路を更新する(ステップS708)。図43及び図44に示す例では、無線通信端末46は、走行路P5、走行路P6、旋回路U5を補正し、手前で旋回する補正経路である、走行路P51、走行路P61、旋回路U51を生成する。
 以下、補正経路の生成方法について説明する。検出した障害物が登録済みの障害物であった場合、補正情報に基づいて前記補正情報が自律走行・自律作業に影響を与える走行路を特定する。例えば、走行路P5を走行中に検出した障害物が登録済みの障害物よりもトラクタ1の走行方向に対してズレている場合、当該ズレに基づく補正情報は走行路P5に影響を与えるものであると特定され、トラクタ1の走行方向に対して垂直方向にズレている場合、当該ズレに基づく補正情報は走行路P5に隣接する走行路P6に影響を与えるものであると特定される。そして、特定された走行路の始点及び終点のうち、障害物の周囲に設けられている終点を、補正情報に基づいてオフセットすることで始点及びオフセット後の終点に基づいて新たな走行路を補正経路として生成する。
 一方、検出した障害物が登録済みの障害物でない場合、上記と同様に、補正情報に基づいて前記補正情報が自律走行・自律作業に影響を与える走行路を特定する。そして、特定された走行路の始点及び終点のうち、終点を、補正情報に基づいて圃場端から障害物の周囲に変更し、始点及び変更後の終点に基づいて新たな走行路を補正経路として生成する。
 次に、無線通信端末46は、トラクタ1の走行を再開し、ステップS708で更新した走行経路に沿ってトラクタ1を走行させる(ステップS709)。その後も無線通信端末46は、障害物を検出したか否かの判断を行い(ステップS701)、障害物を検出した場合は、ステップS702以降の処理を行う。このように連続して上記の処理を行うことで、圃場に未登録の障害物が複数ある場合であっても、走行経路を補正できる。
 なお、無線通信端末46はステップS708において、検出された障害物が登録済みの障害物である場合、補正経路を生成することに加えて、ユーザに対して障害物外周設定部34による障害物の再登録又は補正情報に基づく障害物の登録変更を提案することが望ましく、かつ、検出された障害物が登録済みの障害物でない場合、補正経路を生成することに加えて、ユーザに対して障害物外周設定部34による障害物の新規登録又は補正情報に基づく障害物の新規登録を提案することが望ましい。
 以上に説明したように、本実施形態の自律走行経路生成システム299は、経路生成部276と、記憶部32と、カメラ247と、補正情報算出部277と、補正経路生成部278と、を備える。経路生成部276は、走行経路を生成する。記憶部32は、経路生成部276が生成した走行経路を記憶する。カメラ247は、トラクタ1に設けられ、作業領域内における外部環境情報(特定対象(畝又は障害物等)の位置及び大きさ等)を取得する。補正情報算出部277は、カメラ247が取得した外部環境情報に基づいて、走行経路を補正するための補正情報を算出する。補正経路生成部278は、補正情報算出部277が算出した補正情報に基づいて走行経路を補正した補正経路を生成し、記憶部32に記憶する。
 これにより、トラクタ1に設けられたカメラ247で取得された外部環境情報に基づいて走行経路が補正される。従って、予め生成された走行経路を現在の環境等に基づいて補正できる。また、補正経路を記憶部32に記憶することで、次回以降に走行経路を補正する手間をなくすことができる。
 以上に本発明の好適な実施の形態を説明したが、上記の構成は例えば以下のように変更することができる。
 上記の第6実施形態では、外部環境情報により特定される特定対象として、畝及び障害物を挙げて説明したが、他の特定対象(溝又は圃場の端部)であってもよい。例えば、圃場の外周の位置を設定する場合、上述のように、トラクタ1を圃場の外周に沿って1回り周回させる。このとき、無線通信端末46は、カメラ247に基づいて、圃場の端部を検出可能である。無線通信端末46は、登録された圃場の端部と、検出した圃場の端部と、のズレ量が閾値以上である場合に、圃場外周の設定を補正し、当該圃場外周の影響を受ける場合は、走行経路も補正する。
 上記の実施形態では、外部環境情報取得部としてカメラ247を例に挙げて説明したが、外部環境情報取得部はレーダ装置であってもよい。また、上記の実施形態において記憶部32が記憶する情報の少なくとも一部を記憶部55に記憶してもよい。同様に、記憶部55が記憶する情報の少なくとも一部を記憶部32に記憶してもよい。
 上記の実施形態では、自律走行経路生成システム299を構成する経路生成部276と、記憶部32と、補正情報算出部277と、補正経路生成部278とは、無線通信端末46側に備えられているものとしたが、これに限るものではない。即ち、これらの一部又は全部がトラクタ1側又は別の機器に備えられていてもよい。
 上記実施形態では、補正情報算出部277が外部環境情報取得部(例えばカメラ247)が取得した情報に基づいて補正情報を算出し、補正情報算出部277により算出された補正情報に基づいて補正経路生成部278が補正経路を生成することとしたが、補正情報は補正情報算出部277により算出されたものでなくてもよく、ユーザが外部入力装置(例えばディスプレイ37)を操作することによって入力した補正値であってもよい。ユーザがトラクタ1の自律走行・自律作業を開始させようとするときや、カメラ247により走行経路と畝の中央位置の位置ズレが検出されたときにおいて、ディスプレイ37を操作して補正値を入力可能とすることで、ユーザの望む態様で位置ズレを補正した補正経路を生成することが可能である。なお、ユーザが適切な補正値を入力可能とすべく、表示制御部31は、補正情報算出部277は算出した補正情報に基づいて推奨される補正値をディスプレイ37に表示することとすればよい。また、無線通信端末46は、ユーザにより入力された補正値が、上記推奨される補正値を逸脱している場合には、警告を行って補正値の修正を求めることとしてもよい。
 また、複数列の走行路のうち、特定の走行路について補正経路が生成された場合、当該特定の走行路を含み、トラクタ1により自律走行・自律作業が行われていない走行路(以下、走行予定走行路と称する)を、上記補正経路の生成に伴って補正することとしてもよいし、当該特定の走行路のみ補正し、他の経路を補正しないこととしてもよい。前者の場合、例えば特定の走行路をNcmだけ開始位置側にオフセットした補正経路が生成された場合、走行予定走行路も同様にNcmだけ開始位置側にオフセットした補正経路が生成される。一方、後者の場合、例えば特定の走行路をNcmだけ開始位置側にオフセットした補正経路が生成されても、走行予定走行路は補正されずに維持される。この場合、特定の走行路の次にトラクタ1により自律走行・自律作業が行われる次の走行路の始点は変更されないため、特定の走行路の終点と次の走行路の始点を接続する旋回路が別途生成される。
 上記実施形態では、検出した障害物が登録済みの障害物であるか否かを判断することとしたが、登録済みでない障害物とは、作業領域内に存在する静的な(自らの意思又は風等の自然現象で移動しない)障害物のみならず、動的な(自らの意思又は風等の自然現象で移動する)障害物であってもよい。動的な障害物としては人間や動物が挙げられる。図42のステップS707において補正情報算出部277は、トラクタ1の位置情報、障害物の位置及び大きさ等に基づいて補正情報を算出することとしたが、特に、登録済みでない障害物が動的な障害物である場合、補正情報には更に、当該障害物の経時的な位置変化を特定可能な情報が含まれる。経時的な位置変化を特定可能な情報は、動的な障害物の移動方向及び移動速度を示す情報が含まれていてもよく、また、トラクタ1と動的な障害物の位置(離間距離)及び移動速度に基づいて算出されるトラクタ1が動的な障害物と接触するまでの時間(以下、時間TM1)が経過した際における動的な障害物の位置情報が含まれていてもよい。なお、障害物が動的であるか静的であるかは、カメラ247が検出した動画又は複数の画像に基づいて、例えば障害物の位置変化を捕捉することによって特定可能である。
 障害物が動的な障害物である場合、無線通信端末46は、上記時間TM1が経過した時点においてトラクタ1と動的な障害物が接触するか否かを判断し、接触しないと判断した場合、補正情報に基づく補正経路を生成しない。一方、上記時間TM1が経過した時点においてトラクタ1と動的な障害物が接触すると判断した場合、補正情報に基づく補正経路を生成する。補正経路としては、上記時間TM1が経過した時点においてトラクタ1と動的な障害物が接触しない経路とされる。従って、登録済みでない障害物が静的な障害物である場合、特定された走行路の始点及び終点のうち、終点を変更して補正経路を生成することとしたが、動的な障害物である場合、始点及び終点を変更せず、時間TM1経過後に動的な障害物を回避する迂回路を含む補正経路が生成される。動的な障害物を迂回する場合、当該迂回路には動的な障害物との接触を回避するための旋回路が含まれるが、その旋回方向は、動的な障害物の移動方向とは反対の方向であることが望ましい。
 なお、動的な障害物は常に一定の動きをするとは限らず、経時的に異なる動きとなることがある。その場合適宜、動的な障害物との接触を回避する補正経路を生成することとすればよいが、トラクタ1がそのまま移動を続行した場合に、動的な障害物との接触が避けられない、或いは、動的な障害物の移動方向が短時間で連続して変更されるなど接触の回避が困難であると判断した場合、トラクタ1を停止させることとしてもよい。その場合、トラクタ1が停止した位置から終点までの補正経路を生成することとすればよい。
 <第7実施形態>
 次に、本開示の第7実施形態に係る自律走行経路生成システム399について、主として図45から図57までを参照して詳細に説明する。図45は、本開示の第7実施形態に係る自律走行経路生成システム399が生成した自律走行経路93に沿って走行するロボットトラクタ1の全体的な構成を示す側面図である。
 本実施形態のロボットトラクタ1は、第1実施形態における作業機3に代えて作業機300を備えている。本開示では、作業機300として、図略の回転刃により草刈作業を行う草刈作業部(作業部)3Aを備える草刈機が用いられている。この草刈機は、草刈作業部3Aを走行機体2に対して機体左右方向にオフセットさせた状態で草刈作業を行うことが可能なオフセット型草刈機(オフセット型作業機)として構成されている。図46には、草刈作業部3Aが走行機体2に対して進行方向右側にオフセットした状態が示されている。ただし、詳細は図示しないが、作業機300は油圧シリンダ(後述のオフセットアクチュエータ345)を備えており、この油圧シリンダを駆動することにより、草刈作業部3Aを、図46とは反対側に(進行方向左側に)オフセットさせたり、走行機体2の真後ろに位置させたりすることもできる。
 作業機300は、草刈作業部3A等を制御するための作業機制御部350を備える。作業機制御部350は、図示しないCPU、ROM、RAM、I/O等を備えて構成されており、CPUは、各種プログラム等をROMから読み出して実行することができる。作業機制御部350は、走行機体2の制御部4と電気的に接続されており、制御部4からの指令に基づいて作業機300を制御することができる。作業機制御部350には、オフセットコントローラ365が電気的に接続されている。
 オフセットコントローラ365は、作業機300の草刈作業部3Aのオフセット量を制御するものである。具体的には、作業機300は、オフセットアクチュエータ345を備えている。オフセットアクチュエータ345としては、例えば油圧シリンダ、電動モータ等が考えられるが、これらに限定されない。この構成で、オフセットコントローラ365は、作業機制御部350から入力された制御信号に基づいてオフセットアクチュエータ345を駆動する。この制御により、作業機300の草刈作業部3Aを機体左右方向に変位させることができる。
 オフセットアクチュエータ345を制御部4(作業機制御部350)により制御し、作業機300の草刈作業部3Aを走行機体2から適宜にオフセットさせた状態でトラクタ1を走行させることで、草刈作業部3Aが通る経路の中心と走行機体2が通る経路の中心とが機体左右方向にズレた状態で草刈作業部3Aによる作業を行うことができる。
 作業機300のオフセットコントローラ365を含む、複数の前記コントローラ(例えば、エンジンコントローラ61等)は、トラクタ1の制御部4から入力される信号に基づいて作業機300等の各部を制御している。従って、制御部4が実質的に各部を制御していると把握することができる。
 次に、自律走行経路生成システム399について、主として図47及び図48を参照してより詳細に説明する。
 本実施形態の自律走行経路生成システム399の主たる構成は、無線通信端末46に備えられる。図48に示すように、本実施形態の無線通信端末46は、上述した制御部71と、ディスプレイ(表示部)37、及び通信部72等の他に、作業車両情報設定部(オフセット設定部)51、圃場情報設定部(開始終了位置設定部)52、作業情報設定部53、及び自律走行経路生成部354等を備える。
 本実施形態の無線通信端末46も、第1実施形態の場合と同様に、上記したソフトウェアとハードウェアの協働により、作業車両情報設定部(オフセット設定部)51、圃場情報設定部(開始終了位置設定部)52、作業情報設定部53、及び自律走行経路生成部354等として動作することができる。
 作業車両情報設定部51は、トラクタ1に関する情報(以下、作業車両情報と呼ぶことがある。)を設定するためのものである。作業車両情報設定部51は、トラクタ1の機種、トラクタ1において測位用アンテナ6が取り付けられている位置、作業機300の種類、作業機300のサイズ及び形状、作業機300の走行機体2に対する位置、トラクタ1の作業中の車速及びエンジン回転数、トラクタ1の旋回中の車速及びエンジン回転数等について、オペレータが無線通信端末46を適宜操作することにより指定した内容を記憶することができる。
 作業車両情報設定部51は、上記の作業機300のサイズとして、草刈作業部3Aによって作業が行われる左右方向の有効幅(図46に示す幅E2。以下、作業幅と呼ぶことがある。)を設定することができる。また、作業車両情報設定部51は、作業機300がオフセット型作業機である場合に、上記の作業機300の走行機体2に対する位置として、草刈作業部3Aを走行機体2に対してオフセットさせる方向(機体左方向か、機体右方向か、又は両方か)と、オフセット作業を行う場合の機体左右方向のオフセット距離E1と、を設定することができる。
 オフセット距離E1は、図46及び図49に示すように、走行機体2に適宜設定された基準点2Cと、作業機300(草刈作業部3A)に適宜設定された基準点3Cと、の間の機体左右方向での距離として定義することができる。走行機体2の基準点2Cは、走行機体2の位置を代表する点として任意に定めることができるが、当該基準点2Cは走行機体2の左右方向中央に位置するように設定することが好ましい。作業機300(草刈作業部3A)の基準点3Cについても、当該作業機300(草刈作業部3A)の位置を代表する点として任意に定めることができるが、当該基準点3Cは草刈作業部3Aの左右方向中央に位置するように設定することが好ましい。なお、走行機体2に対する作業機300の連結位置が走行機体2の左右方向中央でない場合、上記基準点2Cの代わりに当該連結位置(複数位置で連結されている場合は連結位置中心)を基準点として、当該基準点と上記基準点3Cとの間の機体左右方向での距離をオフセット距離E1として定義することとしてもよい。また、測位用アンテナ6の取付位置は、図45に示すように走行機体2の基準点2Cと一致していてもよいし、一致しなくてもよい。
 圃場情報設定部52は、圃場情報を設定するためのものである。圃場情報設定部52は、圃場90の位置及び形状、自律走行させたい開始位置及び終了位置、作業方向等について、オペレータが無線通信端末46を操作することにより設定した内容を記憶することができる。
 作業情報設定部53は、作業を具体的にどのように行うかに関する情報(以下、作業情報と呼ぶことがある。)を設定するためのものである。作業情報設定部53は、作業情報として、ロボットトラクタ1と有人のトラクタの協調作業の有無、トラクタ1が枕地において旋回する場合にスキップする作業経路383Aの数であるスキップ数、枕地の幅、及び非耕作地の幅等を設定可能に構成されている。
 自律走行経路生成部354は、トラクタ1を自律走行させる経路である自律走行経路383を生成するためのものである。自律走行経路生成部354は、作業車両情報設定部51、圃場情報設定部52及び作業情報設定部53で設定された情報に基づいて、トラクタ1の自律走行経路383を生成して記憶することができる。
 次に、主として図50から図53までを参照して、自律走行経路383を生成するための無線通信端末46における設定について説明する。図50は、無線通信端末46のディスプレイ37における作業車両情報入力画面391の表示例を示す図である。図6は、無線通信端末46のディスプレイ37における圃場情報入力画面392の表示例を示す図である。図51は、無線通信端末46のディスプレイ37における圃場情報入力画面392の別の表示例を示す図である。図52は、無線通信端末46のディスプレイ37における作業情報入力画面393の表示例を示す図である。
 無線通信端末46においてオペレータが所定の操作を行うと、制御部71は、図50に示す作業車両情報入力画面391をディスプレイ37に表示するように制御する。
 作業車両情報入力画面391には、第1実施形態に係る作業車両情報入力画面81と同様の情報であるトラクタ1の機種、トラクタ1の大きさ、測位用アンテナ6の走行機体2に対する取付位置、作業機300の種類、作業機300の作業幅E2を入力する欄のほか、3点リンク機構の後端(ロアリンクの後端)から作業機300の後端までの距離、走行機体2に対して作業機300(草刈作業部3A)をオフセットすることが可能な方向、作業機300をオフセットした場合の機体左右方向のオフセット距離(具体的には、走行機体2の基準点2Cと草刈作業部3Aの基準点3Cとの間の機体左右方向の距離)E1等を入力する欄がそれぞれ配置されている。
 オペレータは、無線通信端末46を操作して、作業車両情報入力画面391の各欄に配置されているテキストボックスに数値を入力したりドロップダウンボックスの一覧から選択したりすることにより、設定を行う。これにより、作業機300が有する草刈作業部3Aの作業幅E2、草刈作業部3Aを走行機体2に対してオフセットさせることが可能な左右オフセット方向(右か、左か、両方か)及びオフセット距離E1等を含む各種の情報を設定することができる。
 作業車両情報入力画面391においてオペレータが指定した作業車両情報は、作業車両情報設定部51に記憶される。作業車両情報の入力が完了すると、制御部71は、第1実施形態の図7に示したのと概ね同様の、圃場情報入力画面392を表示するようにディスプレイ37を制御する(図51)。
 圃場情報入力画面392には、第1実施形態に示したのと概ね同様の内容の圃場情報が入力され、設定が行われるが、以下では、本実施形態に特有の設定内容について詳細に説明する。
 図6には、圃場90の位置及び形状、作業の開始位置並びに終了位置を設定した例が示されている。図6の例においては、矩形状の圃場90の隅の1つに開始位置が設定され、当該隅と対角位置にある隅に終了位置が設定されている。このように、本実施形態の自律走行経路生成システム399では、第1実施形態に示したのと同様に、開始位置及び終了位置の両方が圃場90の端部に設定されることを原則としている。
 一方、本実施形態においては、作業機300(草刈作業部3A)が走行機体2に対して機体左右方向何れかにオフセットしながら作業可能である旨の設定が作業車両情報設定部51に設定されている場合、自律走行の開始位置及び終了位置のうち一方(だけ)について、作業領域381の中央付近の点を指定することができる。図51に、このような場合の例を示している。図51の例では、開始位置が圃場90の隅に設定される一方、終了位置が圃場90の中央部に設定されている。なお、このような設定はオフセット型作業機を用いる場合に特有のものであり、オフセット型でない作業機を用いる場合は、図51のような指定を行うことができない。
 圃場情報入力画面392においてオペレータが指定した圃場情報は、圃場情報設定部52に記憶される。圃場情報の入力が完了すると、制御部71は、図52に示すような作業情報入力画面393を表示するようにディスプレイ37を制御する。
 作業情報入力画面393では、具体的な作業の情報(前記作業情報)を入力することができる。具体的には、作業情報入力画面393には、ロボットトラクタ1と有人トラクタの協調作業の有無、有人のトラクタが協調作業する場合のパターン、有人のトラクタが協調作業する場合の当該有人のトラクタの作業幅、有人のトラクタが協調作業する場合のロボットトラクタ1のスキップ数(作業経路を何列飛ばして走行するか)、隣接する作業経路における作業幅のオーバーラップ許容量、作業機300の初期オフセット方向、枕地の幅、及び非耕作地の幅等を入力する欄がそれぞれ設けられている。
 このうち、「有人トラクタの協調作業の有無」、「協調作業パターン」、「ロボットトラクタのスキップ数」、「作業幅のオーバーラップ量」、「枕地の幅」、及び「非耕作地の幅」の各欄には、前述の第1実施形態と同様の方法で設定値が入力される。
 「作業機の初期オフセット方向」の欄では、トラクタ1にオフセット型作業機を装着している場合に、自律走行の開始時点において作業機300(草刈作業部3A)が左右どちらにオフセットしているか、又はオフセットしていないか、を指定することができる。
 なお、本実施形態のようにオフセット型作業機を用いる場合の「枕地の幅」及び「非耕作地の幅」については、オフセットなしの作業機を用いる場合と比較して広くなるように、設定値が制限されてもよい。これにより、オフセット型作業機を装着した場合でも、作業機300の端部(草刈作業部3Aの端部)が圃場90からハミ出ないように考慮しながら、当該枕地等での自律走行経路を容易に形成することができる。
 ただし、本実施形態においては、作業機300としてオフセット型作業機を装着して作業する旨が作業車両情報として設定されている場合、自律走行経路383の生成ロジックの複雑化を避けるため、「有人トラクタの協調作業の有無」の欄は入力できない(即ち、協調作業なしが強制される)ようになっている。また、同様の事情により、作業機300としてオフセット型作業機を用いる場合、「ロボットトラクタのスキップ数」の欄は入力できない(即ち、スキップ数が強制的にゼロにされる)ようになっている。従って、本実施形態においては、オフセット型作業機を用いてトラクタ1に自律走行・自律作業させる場合、有人トラクタの存在を考慮した経路を生成して自律走行・自律作業させることはできず、作業経路383Aを1列以上飛ばして作業することもできない。
 次に、図53を参照しながら、自律走行経路生成部354が自律走行経路383を生成する処理について説明する。図53は、自律走行経路383を生成する処理を示すフローチャートである。
 図52に示す作業情報入力画面393において「自律走行経路を生成」ボタンが操作されると、最初に、圃場情報入力画面392において設定された圃場90の形状と、作業情報入力画面393において設定された枕地の幅及び非耕作地の幅に基づいて、作業領域381及び非作業領域382が定められる。その後に図53の処理が開始され、最初に自律走行経路生成部354は、作業領域381において草刈作業部3Aが通る経路384を、図54の破線矢印のように生成する(ステップS801)。このときの経路の計算は、走行機体2の基準点2Cではなく、作業機300の基準点(草刈作業部3Aの基準点)3Cを基準にして行われる。なお、以下では、作業領域381において作業機300の基準点3Cが通る経路384を、「作業機作業経路」と呼ぶことがある。
 次に、自律走行経路生成部354は、ステップS801の処理で生成された作業機作業経路(前記経路384)と、作業車両情報設定部51により設定されたオフセット方向及びオフセット距離と、に基づいて(言い換えれば走行機体2の基準点2Cに基づいて)、作業領域381における走行機体2が通る経路(作業経路383A)を、図55の太線矢印のように生成する(ステップS802)。この計算は、簡単な幾何学的関係に基づいて行うことができる。なお、以下では、作業領域381において走行機体2の基準点2Cが通る経路を、「走行機体作業経路」と呼ぶことがある。
 その後、自律走行経路生成部354は、ステップS802の処理で生成された走行機体作業経路(作業経路383A)の端点を繋ぐように、非作業領域382において走行機体2の基準点2Cが通る経路(非作業経路383B)を、図56の太線矢印のように生成する(ステップS803)。このとき、自律走行の開始位置と走行機体作業経路の端点とを繋ぐ経路、及び、走行機体作業経路の端点と自律走行の終了位置とを繋ぐ経路も、同様に生成される。非作業領域382において走行機体2が通る経路は、作業機300の端部が圃場90から外部にハミ出すことを防止する観点から、必要に応じて所定のマージン内において適宜修正される。以上により、圃場90(作業領域381及び非作業領域382)における走行機体2の自律走行経路383を生成することができる。
 なお、本実施形態において自律走行経路生成システム399が生成することができる自律走行経路383は2種類あり、そのうちの1つが、図56の太線矢印で示す折返し走行経路である。この折返し走行経路は、図6の例のように圃場情報設定部52で設定された自律走行の開始位置及び終了位置が何れも圃場90の端部である場合に適用されるものであり、圃場90の縁部と縁部の間で折返しを反復しながら作業を行うように生成される。
 この折返し走行経路の特徴は、図54に示す作業機作業経路が、予め指定された作業方向と平行な直線路を、当該作業方向と垂直な方向に往路、復路、往路、・・・と交互に並べることで形成されることである。この作業機作業経路を配置するにあたっては、作業領域381に対する作業機300の作業漏れが生じないように、かつ、作業効率が良好となるように、当該作業機300の作業幅E2等が考慮される。また、作業機作業経路の配置は、指定された開始位置(又は開始位置の近傍)から上記の作業方向に従って最初の作業が行われ、可能な限り終了位置(又は終了位置の近傍)において作業が終了するように、適宜考慮される。
 なお、作業領域381又は圃場90の形状が複雑である場合は、上記の往路及び復路を、直線路に代えて折れ線路等としてもよい。
 ところで、本実施形態においては、作業機300が、草刈作業部3Aのオフセット方向を変更可能に構成されている。この場合、自律走行経路生成部354は、必要に応じて、草刈作業部3Aのオフセット方向を、作業経路383Aと作業経路383Aとを繋ぐ非作業経路383Bにおいて変更することができる。例えば、図55の例では、左から1本目及び2本目の作業経路383Aにおける草刈作業部3Aのオフセット方向は右であるが、3本目ではオフセット方向が左に切り換えられており、その後も更に交互に切り換えられている。このように経路を生成することで、非耕作地の幅(サイドマージンSM1)の大きさ等の様々な事情に応じて自律走行・自律作業を柔軟に行うことができる。また、草刈作業部3Aのオフセット方向を非作業経路383Bにおいて切り換えることで、自律走行経路383を単純な処理で生成することができる。
 次に、もう1つの自律走行経路である周回走行経路について、図57を参照して説明する。
 図57に示す周回走行経路は、図51の例のように圃場情報設定部52で設定された自律走行の開始位置及び終了位置の一方が圃場90の中央である場合に生成されるものである。図51の例では自律走行の終了位置が圃場90の中央に設定されているので、周回走行経路は図57の太線矢印のように、圃場90内を外側から内側へ角渦巻き状に周回するように生成される。ただし、自律走行の開始位置を圃場90の中央に、終了位置を圃場90の端部に、それぞれ設定することもでき、この場合、周回走行経路は、圃場90内を内側から外側へ角渦巻き状に周回するように生成される。
 この周回走行経路も、図53で示す処理により生成される。具体的には、作業領域381において作業機作業経路(図57の破線矢印の経路384)が作業機300の基準点3Cを基準にして渦巻き状に生成され、この作業機作業経路がオフセットされることで(走行機体2の基準点2Cに基づいて)走行機体作業経路(作業経路383A)が生成される。更に、自律走行の開始位置近傍の部分は非作業領域382となっているので、この非作業領域382において走行機体2の基準点2Cが通る経路(非作業経路383B)を、自律走行の開始位置と走行機体作業経路の端点とを繋ぐように生成する。以上により、図57に太線矢印で示す周回走行経路を生成することができる。
 図57に示す周回走行経路の例においては、作業機300のオフセット方向が自律走行経路383の途中で変更されない。言い換えれば、当該周回走行経路では、圃場90の外側から内側に向かって作業をしていく経路の全行程において、作業機300が走行機体2よりも圃場90の中央側へオフセットした状態が維持されている。従って、走行機体2は作業機300による作業を終えた部分を走行するため、例えば、草刈作業において常に見通しのよい状態で作業を行わせることができる。なお、周回走行経路においても、折返し走行経路と同様に、作業内容に応じて自律走行経路383の途中で作業機300のオフセット方向を変更してもよい。
 本実施形態では圃場(走行領域)80に作業領域381及び非作業領域382が含まれることとしたが、作業領域381と非作業領域382とは一部が重複する領域であってもよい。作業領域381と非作業領域382の一部が重複するとは、その重複領域をトラクタ1がN回(Nは2以上の整数)走行する場合において、X回(XはN未満の整数)は作業機300による作業を行わずに走行し、N-X回は作業機300による作業を行いながら走行することを意味する。従って、本実施形態において作業領域381とは、作業機300による作業を伴ってトラクタ1が走行する領域であるといえ、非作業領域382とは、作業機300による作業を伴わずにトラクタ1が走行する領域であるともいえる。
 図57に示すように、作業機作業経路が圃場90の中心部に向かって渦巻き状に生成される場合、圃場90の中心部ではトラクタ1の旋回半径よりも狭い残存領域について作業機300により作業を行うために、切り返し(トラクタ1を一旦後進させて残存領域から一定距離離れた上で、残存領域に移動する動作)が必要となりうる。この一連の切返し動作は、作業機300により作業が行われないため、一連の切り返し動作が行われる領域は非作業領域382であるといえる。自律走行経路生成部354はそのような切り返し動作を行うための経路を生成するにあたっては作業機300の基準点3Cではなく、走行機体2の基準点2Cに基づいて経路を生成する。つまり本実施形態において自律走行経路生成部354は、作業機300による作業を伴ってトラクタ1が走行する領域については作業機300の基準点3Cに基づいて経路(作業機作業経路)を生成し、作業機300による作業を伴わずにトラクタ1が走行する領域については走行機体2の基準点2Cに基づいて経路(走行機体作業経路)を生成することが可能である。
 以上に説明したように、本実施形態の自律走行経路生成システム399は、予め定められた圃場90において、走行機体2と走行機体2に装着される作業機300を備えるトラクタ1を自律走行させるための自律走行経路383を生成する。自律走行経路生成システム399は、作業車両情報設定部51と、自律走行経路生成部354と、を備える。作業車両情報設定部51は、走行機体2の基準点2Cに対する作業機300の基準点3Cのオフセット方向及びオフセット距離を設定可能である。自律走行経路生成部354は、作業機300の基準点3Cに基づいて圃場90内における自律走行経路383を生成可能である。
 これにより、作業機300の基準点3Cが通る経路384と走行機体2の基準点2Cが通る経路(作業経路383A)とをズラした自律走行経路383を生成することができる。その結果、トラクタ1の自律走行を、例えば圃場端を除草しながら走行する場合等、様々な作業形態に適用することができる。
 また、本実施形態の自律走行経路生成システム399において、圃場90は、作業機300により作業が行われる作業領域381と、作業領域381の周囲に設定される非作業領域382と、を含む。自律走行経路生成部354は、作業機300の基準点3Cに基づいて作業領域381内における作業経路383Aを生成し、走行機体2の基準点2Cに基づいて非作業領域382内における非作業経路383Bを生成する。
 これにより、自律走行経路383を生成するときの位置の基準を作業領域381と非作業領域382との間で異ならせることで、作業領域381において作業機300(草刈作業部3A)をオフセットさせて作業する場合でも、作業領域381及び非作業領域382の両方において、自律走行経路383の生成処理を単純化することができる。
 また、本実施形態の自律走行経路生成システムは、圃場90におけるトラクタ1による作業の開始位置及び終了位置を設定する圃場情報設定部52を備える。図6に示すように、圃場情報設定部52により開始位置及び終了位置の両方が圃場90の端部に設定された場合、自律走行経路生成部354は、自律走行経路383として、圃場90の縁部と縁部の間で折返しを反復しながら開始位置から終了位置に向かう折返し走行経路(図56)を生成する。図51に示すように、圃場情報設定部52により開始位置及び終了位置の一方が圃場90の端部に設定され、他方が圃場90の中央部に設定された場合、自律走行経路生成部354は、自律走行経路383として、開始位置から終了位置に向かう渦巻き状の周回走行経路(図57)を生成する。
 これにより、2種類の自律走行経路383を作業内容等に応じて適宜選択することができるので、作業効率を向上させることができる。
 以上に本発明の好適な実施の形態を説明したが、上記の構成は例えば以下のように変更することができる。
 上記の実施形態において、自律走行の開始位置と終了位置の両方が圃場90の端部に指定された場合に、折返し走行経路が生成される。しかしながら、例えば、生成された折返し走行経路を確認のためにディスプレイ37に表示するときに、メッセージの表示等の適宜の方法で、自律走行経路生成システム399側からオペレータに周回走行経路の生成を提案してもよい。
 オフセット型作業機としては、上記の草刈作業機に限定されず、例えばオフセット型のプラウを用いることができる。
 上記の実施形態においては、走行機体2に対して作業機300をオフセットすることが可能な旨が作業車両情報設定部51で設定された場合にのみ、自律走行の開始位置又は終了位置として圃場90の中央部を選択可能に構成されている。しかしながら、非オフセット型の作業機300を用いる場合においても、圃場90の中央部を自律走行の開始位置又は終了位置として選択できるようにしてもよい。
 上記の実施形態においては、作業機300を走行機体2に対して、機体左方向及び機体右方向にオフセットさせることができるとしたが、左右一側方向にしかオフセットできないようにしてもよい。この場合、(オフセットしないときは、オフセット距離E1が0であるので)作業車両情報設定部51においてオフセット距離E1のみを設定するよう構成して、自律走行経路生成システム399によって自律走行経路383の生成を行うこととすることができる。
 上記の実施形態では、往復走行経路においては、トラクタ1が作業の進行方向に対して交互に逆方向を向き、周回走行経路においては、トラクタ1が作業の進行方向に対して常に同じ方向を向いている。即ち、往復走行経路ではオフセット方向を反転する必要性が高く、周回走行経路ではオフセット方向を反転する必要性が低いと言える。従って、生成される経路が往復走行経路である場合はオフセット方向が必要に応じて反転され、生成される経路が周回走行経路である場合はオフセット方向が途中で変更(反転)されないようにしてもよい。
 また、作業機300として、左右一側にだけオフセット可能なものは走行機体2に装着できず、左右両側にオフセット可能なものだけを走行機体2に装着できるようにしてもよい。この場合、左右一側にだけオフセット可能な場合を考慮しなくてよいので、図50の設定画面において、「作業機が左右オフセット可能な方向」の「左だけ」及び「右だけ」の項目を省略することができる。
 上記の実施形態では、作業情報入力画面393で設定された枕地の幅及び非耕作地の幅に基づいて非作業領域382が定められ、圃場380から非作業領域382を除外した残りの領域として作業領域381が定められている。しかしながら、作業領域381を設定する方法は上記に限らず、例えば、上述の圃場情報入力画面392において平面表示部88に表示された圃場380の任意の点をオペレータが指定することで作業領域381及び非作業領域382を設定できるように構成されてもよい。
 上記の実施形態では、自律走行経路生成システム399を構成する作業車両情報設定部51と、自律走行経路生成部354とは、無線通信端末46側に備えられている。しかしながら、作業車両情報設定部51及び自律走行経路生成部354のうちの一部又は全部がトラクタ1側に備えられているものとしてもよい。
 1 トラクタ(作業車両)
 47 自律走行経路生成部(経路生成部)
 54 作業領域分割部(領域分割部)
 91 作業領域(走行領域)
 93 自律走行経路(走行経路)
 93A 作業経路(走行路)
 99 自律走行経路生成システム
 BP 基本単位経路数(所定値)
 S 区画
 SE 例外の区画
 SN スキップ数(基準値)

Claims (8)

  1.  予め定められた走行領域内の作業領域に対して作業を行うために作業車両を自律走行させる走行経路を生成する自律走行経路生成システムであって、
     前記作業領域を複数の区画に分割する領域分割部と、
     前記領域分割部により分割された各区画のそれぞれに配置された複数の走行路を含むように前記走行経路を生成する経路生成部と、
    を備え、
     前記領域分割部は、前記各区画に含まれる前記走行路の数が互いに等しい所定値となるように前記作業領域を分割可能であることを特徴とする自律走行経路生成システム。
  2.  請求項1に記載の自律走行経路生成システムであって、
     前記経路生成部は、前記複数の走行路に対して基準値に基づいて作業順序を設定し、
     含まれる前記走行路の数が前記所定値と等しい前記区画が複数ある場合に、前記経路生成部は、当該区画の間で、互いに対応する各々の前記走行路に対して同一の作業順序を設定することを特徴とする自律走行経路生成システム。
  3.  請求項1又は2に記載の自律走行経路生成システムであって、
     前記領域分割部は、前記作業領域に含まれる前記走行路の数が前記所定値の整数倍でない場合に、
     含まれる前記走行路の数が前記所定値と等しい第1区画と、
     含まれる前記走行路の数が前記所定値より大きい第2区画と、
    を形成するように前記作業領域を複数の区画に分割することを特徴とする自律走行経路生成システム。
  4.  請求項1から3までの何れか一項に記載の自律走行経路生成システムであって、
     前記走行領域内における前記作業車両の走行方向を設定する走行方向設定部と、
     前記走行領域内の障害物に対して障害物外周領域を設定する障害物外周設定部と、
    を備え、
     前記経路生成部は、前記走行領域内において前記走行方向設定部により設定された前記走行方向に沿って設けられた複数の前記走行路を含む前記走行経路を生成可能であり、
     前記経路生成部は、
     前記走行方向に沿って配置される第1走行路と、
     前記第1走行路の終点を始点とし、前記障害物外周領域を通過しつつ前記障害物の反対側に回って、当該障害物を貫くように前記第1走行路を延長した仮想延長線上の位置に至る迂回路と、
     前記迂回路の終点を始点とし、前記仮想延長線上に配置される第2走行路と、
    を含むように前記走行経路を生成することが可能であることを特徴とする自律走行経路生成システム。
  5.  請求項4に記載の自律走行経路生成システムであって、
     前記経路生成部は、
     前記迂回路の経路長が所定距離未満である場合に、前記第1走行路、前記迂回路及び前記第2走行路を含むように前記走行経路を生成し、
     前記迂回路の経路長が所定距離以上である場合に、
     前記第1走行路と、
     前記第1走行路の終点を始点とし、前記障害物外周領域を通過しつつ前記障害物の手前で折り返す折返し路と、
     前記折返し路の終点を始点とし、前記第1走行路と平行に配置される第3走行路と、
    を含むように前記走行経路を生成することが可能であることを特徴とする自律走行経路生成システム。
  6.  請求項4に記載の自律走行経路生成システムであって、
     前記経路生成部は、
     前記作業車両が前記障害物を回避するために前記走行方向と垂直な向きに移動しなければならない距離である回避距離が所定距離未満である場合に、前記第1走行路、前記迂回路及び前記第2走行路を含むように前記走行経路を生成し、
     前記回避距離が所定距離以上である場合に、
     前記第1走行路と、
     前記第1走行路の終点を始点とし、前記障害物外周領域を通過しつつ前記障害物の手前で折り返す折返し路と、
     前記折返し路の終点を始点とし、前記第1走行路と平行に配置される第3走行路と、
    を含むように前記走行経路を生成することが可能であることを特徴とする自律走行経路生成システム。
  7.  請求項4に記載の自律走行経路生成システムであって、
     前記経路生成部は、
     前記迂回路における旋回回数又は旋回角度が所定未満である場合に、前記第1走行路、前記迂回路及び前記第2走行路を含むように前記走行経路を生成し、
     前記迂回路における前記旋回回数又は前記旋回角度が所定以上である場合に、
     前記第1走行路と、
     前記第1走行路の終点を始点とし、前記障害物外周領域を通過しつつ前記障害物の手前で折り返す折返し路と、
     前記折返し路の終点を始点とし、前記第1走行路と平行に配置される第3走行路と、
    を含むように前記走行経路を生成することが可能であることを特徴とする自律走行経路生成システム。
  8. 請求項4から7までの何れか一項に記載の自律走行経路生成システムであって、
     前記経路生成部は、前記走行領域において前記障害物が島状に配置されている場合、前記迂回路を、前記第1走行路に至るまでの前記走行経路から見て遠い側から前記障害物の反対側に回るように生成することを特徴とする自律走行経路生成システム。
PCT/JP2017/014436 2016-05-10 2017-04-07 自律走行経路生成システム WO2017195510A1 (ja)

Priority Applications (6)

Application Number Priority Date Filing Date Title
KR1020207017172A KR20200075029A (ko) 2016-05-10 2017-04-07 자율 주행 경로 생성 시스템
KR1020187026558A KR102079890B1 (ko) 2016-05-10 2017-04-07 자율 주행 경로 생성 시스템
KR1020217003434A KR102283928B1 (ko) 2016-05-10 2017-04-07 자율 주행 경로 생성 시스템
CN202210633017.5A CN114995427A (zh) 2016-05-10 2017-04-07 自主行驶路径生成系统
KR1020207004115A KR102126168B1 (ko) 2016-05-10 2017-04-07 자율 주행 경로 생성 시스템
CN201780027984.4A CN109074081A (zh) 2016-05-10 2017-04-07 自主行驶路径生成系统

Applications Claiming Priority (8)

Application Number Priority Date Filing Date Title
JP2016-094513 2016-05-10
JP2016094515A JP6739228B2 (ja) 2016-05-10 2016-05-10 自律走行経路生成システム
JP2016-094515 2016-05-10
JP2016094513A JP6739227B2 (ja) 2016-05-10 2016-05-10 自律走行経路生成システム
JP2016102980A JP6682354B2 (ja) 2016-05-24 2016-05-24 自律走行経路生成システム
JP2016102978A JP6692692B2 (ja) 2016-05-24 2016-05-24 自律走行経路生成システム
JP2016-102978 2016-05-24
JP2016-102980 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) KR102126168B1 (ja)
CN (2) CN114995427A (ja)
WO (1) WO2017195510A1 (ja)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109857096A (zh) * 2017-11-30 2019-06-07 井关农机株式会社 作业车辆
CN115290095A (zh) * 2022-09-28 2022-11-04 陕西耕辰科技有限公司 一种农机作业路径自动规划方法、系统、农机及存储介质
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 (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2020171229A1 (ja) * 2019-02-22 2020-08-27 株式会社ナイルワークス ドローン操縦機、および、操縦用プログラム
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 대한민국 영상 기반 경로 인식 및 조향각 산출 기술을 지원하는 자율 주행 농기계 장치 및 그 동작 방법
CN112868366A (zh) * 2019-11-29 2021-06-01 株式会社久保田 自动行驶控制系统、自动行驶路径生成系统、联合收割机
KR20210067924A (ko) * 2019-11-29 2021-06-08 가부시끼 가이샤 구보다 자동 주행 제어 시스템, 콤바인 및 수확기
CN110825091A (zh) * 2019-11-29 2020-02-21 洛阳中科龙网创新科技有限公司 一种基于无人机的智能拖拉机智能选路方法及装置
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 宇通客车股份有限公司 一种车辆、车辆调头方法及装置
CN115016451A (zh) * 2021-03-05 2022-09-06 广东博智林机器人有限公司 机器人作业轨迹规划方法、装置、计算机设备和存储介质
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 上海联适导航技术股份有限公司 一种耙地作业的路径规划方法及装置
KR20230049792A (ko) 2021-10-06 2023-04-14 대한민국(농촌진흥청장) 농기계 제어를 위한 자율 주행 장치, 이를 포함하는 농기계 및 자율 주행 방법
KR102592085B1 (ko) * 2023-02-02 2023-10-20 주식회사 긴트 농업용 차량의 정밀한 자율주행을 위한 ab주행 기준선 이동 가이드 시스템 및 이의 운용방법
CN116149337B (zh) * 2023-04-14 2023-07-07 未岚大陆(北京)科技有限公司 割草控制方法、设置方法、割草机、设置装置和电子设备

Citations (4)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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 ヤンマー株式会社 併走作業システムの制御装置
CN104781633A (zh) * 2014-03-06 2015-07-15 日本集奥瑟甫有限公司 农田导航系统和农田导航方法及其软件和软件的存储设备
JP6189779B2 (ja) * 2014-03-27 2017-08-30 株式会社クボタ 作業車協調システム
JP6339427B2 (ja) 2014-03-31 2018-06-06 ヤンマー株式会社 併走作業システム

Patent Citations (4)

* Cited by examiner, † Cited by third party
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 (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109857096A (zh) * 2017-11-30 2019-06-07 井关农机株式会社 作业车辆
JP2019097454A (ja) * 2017-11-30 2019-06-24 井関農機株式会社 作業車両
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
CN115290095A (zh) * 2022-09-28 2022-11-04 陕西耕辰科技有限公司 一种农机作业路径自动规划方法、系统、农机及存储介质

Also Published As

Publication number Publication date
CN114995427A (zh) 2022-09-02
KR20210016086A (ko) 2021-02-10
KR20200018732A (ko) 2020-02-19
KR102079890B1 (ko) 2020-02-20
KR102126168B1 (ko) 2020-06-24
KR20200075029A (ko) 2020-06-25
KR102283928B1 (ko) 2021-07-29
KR20180116319A (ko) 2018-10-24
CN109074081A (zh) 2018-12-21

Similar Documents

Publication Publication Date Title
WO2017195510A1 (ja) 自律走行経路生成システム
JP6682354B2 (ja) 自律走行経路生成システム
JP6663366B2 (ja) 経路生成システム、及びそれによって生成された経路に沿って作業車両を走行させる自律走行システム
JP6692692B2 (ja) 自律走行経路生成システム
KR102144244B1 (ko) 경로 생성 장치
JP6832660B2 (ja) 経路生成システム
JP6739228B2 (ja) 自律走行経路生成システム
JP6440647B2 (ja) 自律走行システム
JP6947872B2 (ja) 自律走行システム
JP6854312B2 (ja) 走行領域特定装置
JP2021112203A (ja) 作業車両
JP6708724B2 (ja) 自律走行システム
JP7492043B2 (ja) 自律走行システム及び作業経路の生成方法
JP6739227B2 (ja) 自律走行経路生成システム
JP7022161B2 (ja) 自律走行システム
JP6997889B2 (ja) 経路生成システム
JP2020109693A (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