WO2022065091A1 - 自動走行システム、自動走行方法、及び自動走行プログラム - Google Patents
自動走行システム、自動走行方法、及び自動走行プログラム Download PDFInfo
- Publication number
- WO2022065091A1 WO2022065091A1 PCT/JP2021/033448 JP2021033448W WO2022065091A1 WO 2022065091 A1 WO2022065091 A1 WO 2022065091A1 JP 2021033448 W JP2021033448 W JP 2021033448W WO 2022065091 A1 WO2022065091 A1 WO 2022065091A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- tractor
- work vehicle
- work
- path
- traveling
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims description 116
- 238000012545 processing Methods 0.000 claims abstract description 32
- 230000008859 change Effects 0.000 claims description 152
- 230000008569 process Effects 0.000 claims description 93
- 230000005540 biological transmission Effects 0.000 description 66
- 238000001514 detection method Methods 0.000 description 29
- 238000004891 communication Methods 0.000 description 19
- 238000013459 approach Methods 0.000 description 13
- 238000010295 mobile communication Methods 0.000 description 12
- 238000010586 diagram Methods 0.000 description 11
- 238000005259 measurement Methods 0.000 description 10
- 230000002093 peripheral effect Effects 0.000 description 10
- 238000000926 separation method Methods 0.000 description 10
- 238000003860 storage Methods 0.000 description 10
- 230000003028 elevating effect Effects 0.000 description 7
- 230000009191 jumping Effects 0.000 description 6
- 230000004044 response Effects 0.000 description 5
- 238000009434 installation Methods 0.000 description 4
- 238000005096 rolling process Methods 0.000 description 4
- 238000006243 chemical reaction Methods 0.000 description 3
- 210000000078 claw Anatomy 0.000 description 3
- 230000002706 hydrostatic effect Effects 0.000 description 3
- 238000003971 tillage Methods 0.000 description 3
- 238000011946 reduction process Methods 0.000 description 2
- 244000025254 Cannabis sativa Species 0.000 description 1
- 240000007594 Oryza sativa Species 0.000 description 1
- 235000007164 Oryza sativa Nutrition 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 125000001475 halogen functional group Chemical group 0.000 description 1
- 238000003306 harvesting Methods 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 230000009347 mechanical transmission Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 235000009566 rice Nutrition 0.000 description 1
- 238000009331 sowing Methods 0.000 description 1
- 238000005507 spraying Methods 0.000 description 1
- 230000007306 turnover Effects 0.000 description 1
Images
Classifications
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01B—SOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
- A01B69/00—Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track
- A01B69/007—Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow
- A01B69/008—Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow automatic
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01B—SOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
- A01B76/00—Parts, details or accessories of agricultural machines or implements, not provided for in groups A01B51/00 - A01B75/00
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60T—VEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
- B60T8/00—Arrangements for adjusting wheel-braking force to meet varying vehicular or ground-surface conditions, e.g. limiting or varying distribution of braking force
- B60T8/32—Arrangements for adjusting wheel-braking force to meet varying vehicular or ground-surface conditions, e.g. limiting or varying distribution of braking force responsive to a speed condition, e.g. acceleration or deceleration
- B60T8/321—Arrangements for adjusting wheel-braking force to meet varying vehicular or ground-surface conditions, e.g. limiting or varying distribution of braking force responsive to a speed condition, e.g. acceleration or deceleration deceleration
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0219—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
Definitions
- the present invention relates to an automatic driving system, an automatic driving method, and an automatic driving program capable of automatically driving a work vehicle.
- a process of inputting the work width of the work device provided at the rear of the work vehicle, a process of setting a work area in the field, a process of setting a work start position and a work stop position, and a reference run By performing the process of setting the start direction, the process of setting the headland at both ends of the work area, and the process of setting the travel route in the field, the target route that enables the automatic travel of the work vehicle is set.
- a target route generation unit to be generated see, for example, Patent Document 1).
- the work vehicle when switching from forward to reverse in order to change the direction of the work vehicle, the work vehicle may be decelerated before the target position so as to temporarily stop at the target position where forward / backward movement is switched. ..
- deceleration control When such deceleration control is performed, there arises a problem that it takes time to change the direction and the work efficiency is lowered.
- the deceleration control is not performed, the time required for turning can be shortened, but the work vehicle cannot be stopped at the target position. For example, the work vehicle jumps out of the field and automatically runs. As a result, there is a problem that the work efficiency is lowered due to the stoppage.
- An object of the present invention is to provide an automatic traveling system, an automatic traveling method, and an automatic traveling program capable of improving the work efficiency of a work vehicle by appropriately changing the direction of the work vehicle.
- the automatic traveling system includes a route generation processing unit, a positioning processing unit, and a traveling processing unit.
- the route generation processing unit generates a target route including a work route for advancing the work vehicle in the field and a direction change route for turning the work vehicle.
- the positioning processing unit measures the position of the work vehicle.
- the travel processing unit automatically drives the work vehicle according to the target route based on the positioning information of the positioning processing unit. Further, in the traveling processing unit, when the work vehicle changes direction in the direction change path, the direction change position for switching the front-rear direction of the work vehicle is just before the work vehicle reaches the direction change position. When the distance is less than a predetermined distance from the predetermined area on the traveling direction side of the work vehicle, a deceleration process for decelerating the target speed of the work vehicle toward the turning position is executed.
- the automatic traveling method is to generate a target route including a work route for advancing the work vehicle in the field and a direction change route for turning the work vehicle, and to measure the position of the work vehicle.
- the work vehicle is automatically driven according to the target route based on the position of the work vehicle, and the direction change position for switching the front-rear direction of the work vehicle when the work vehicle changes direction on the direction change route.
- the target speed of the work vehicle is decelerated toward the direction change position. It is a method of executing the deceleration process of causing the vehicle to be decelerated, and the method of executing the deceleration process by one or more processors.
- the automatic traveling program generates a target route including a work route for advancing the work vehicle in the field and a direction change route for turning the work vehicle, and measures the position of the work vehicle.
- the work vehicle is automatically driven according to the target route based on the position of the work vehicle, and the direction change position for switching the front-rear direction of the work vehicle when the work vehicle changes direction on the direction change route.
- the target speed of the work vehicle is decelerated toward the direction change position. It is a program for executing a deceleration process for causing one or a plurality of processors to execute the deceleration process.
- an automatic traveling system an automatic traveling method, and an automatic traveling program capable of improving the work efficiency of the work vehicle by appropriately changing the direction of the work vehicle.
- FIG. 1 is a diagram showing a schematic configuration of an automatic traveling system according to an embodiment of the present invention.
- FIG. 2 is a schematic view showing a transmission configuration of a tractor according to an embodiment of the present invention.
- FIG. 3 is a block diagram showing a schematic configuration of an automatic traveling system according to an embodiment of the present invention.
- FIG. 4 is a block diagram showing a schematic configuration of an obstacle detection unit or the like according to an embodiment of the present invention.
- FIG. 5 is a plan view showing an example of a target route according to an embodiment of the present invention.
- FIG. 6 is an enlarged view of a target route showing a state in which the work vehicle according to the embodiment of the present invention is moving forward on the work route in the work traveling state.
- FIG. 1 is a diagram showing a schematic configuration of an automatic traveling system according to an embodiment of the present invention.
- FIG. 2 is a schematic view showing a transmission configuration of a tractor according to an embodiment of the present invention.
- FIG. 3 is a block diagram showing
- FIG. 7 is an enlarged view of a target route showing a state in which the work vehicle according to the embodiment of the present invention advances the work route in the work traveling state and reaches the terminal position of the work route.
- FIG. 8 is an enlarged view of a target route showing a state in which the work vehicle according to the embodiment of the present invention travels backward in the first reverse path in a non-working state and reaches the start position of the start side turning path.
- FIG. 9 is an enlarged view of a target route showing a state in which the work vehicle according to the embodiment of the present invention advances the start side turning path and reaches the end position of the starting side turning path in a non-working traveling state.
- FIG. 10 is an enlarged view of a target route showing a state in which the work vehicle according to the embodiment of the present invention has advanced the right forward path in a non-working state and has reached the end position of the right forward path.
- FIG. 11 is an enlarged view of a target route showing a state in which the work vehicle according to the embodiment of the present invention travels backward on the left reverse route in a non-working state and reaches the terminal position of the left reverse route.
- FIG. 12 is an enlarged view of a target route showing a state in which the work vehicle according to the embodiment of the present invention advances the terminal turning path in a non-working state and reaches the terminal position of the terminal turning path.
- FIG. 13 is an enlarged view of a target route showing a state in which the work vehicle according to the embodiment of the present invention advances on the non-working route and reaches the terminal position of the non-working route in the non-working traveling state.
- FIG. 14 is an enlarged view of a target route showing a state in which the work vehicle according to the embodiment of the present invention travels backward in the second reverse route in a non-working state and reaches the terminal position of the second reverse route.
- FIG. 15 is an enlarged view of a target route showing a state in which the work vehicle according to the embodiment of the present invention advances the work route in the work traveling state.
- FIG. 16 is a flowchart showing a control operation of the target route generation unit in the target route generation control according to the embodiment of the present invention.
- FIG. 17 is a flowchart showing a control operation of the target route generation unit in the parallel route generation process according to the embodiment of the present invention.
- FIG. 18 is a flowchart showing a control operation of the target route generation unit in the direction change route generation process according to the embodiment of the present invention.
- FIG. 19A is a diagram showing a running state when the work vehicle according to the embodiment of the present invention changes direction at the left end of the field.
- FIG. 19B is a diagram showing a running state when the work vehicle according to the embodiment of the present invention changes direction at the left end of the field.
- FIG. 19C is a diagram showing a traveling state when the work vehicle according to the embodiment of the present invention changes direction at the left end of the field.
- FIG. 19A is a diagram showing a running state when the work vehicle according to the embodiment of the present invention changes direction at the left end of the field.
- FIG. 19B is a diagram showing a running state when the work vehicle according to the embodiment of the present invention changes direction at the left end
- FIG. 20A is a diagram showing a traveling state when the work vehicle according to the embodiment of the present invention changes direction at the right end of the field.
- FIG. 20B is a diagram showing a traveling state when the work vehicle according to the embodiment of the present invention changes direction at the right end of the field.
- FIG. 20C is a diagram showing a traveling state when the work vehicle according to the embodiment of the present invention changes direction at the right end of the field.
- FIG. 21 is a diagram showing a traveling state in another direction change path of the work vehicle according to the embodiment of the present invention.
- FIG. 22 is a diagram showing a traveling state of the work vehicle according to the embodiment of the present invention in another direction change path.
- FIG. 23 is an enlarged view of a target route showing another embodiment in which the switching position is set at a position in front of the terminal position in the work route according to the embodiment of the present invention.
- the automatic traveling system for a work vehicle includes, for example, a passenger work vehicle capable of automatically traveling such as a passenger management machine, a passenger grass mower, a passenger rice planting machine, and a passenger seeder. It can be applied to unmanned work vehicles such as unmanned tillers and unmanned mowers.
- a rotary tiller device 3 which is an example of a working device is connected to a rear portion via a link mechanism 2 so as to be able to move up and down and roll. ..
- the tractor 1 is configured to have rotary tillage specifications.
- a plow for example, a plow, a disc halo, a cultivator, a subsoiler, a sowing device, a spraying device, a mowing device, and a working device such as a harvesting device shall be connected to the rear part of the tractor 1. Can be done.
- the tractor 1 can be automatically driven in a field A (see FIG. 5), which is an example of a work site, by using an automatic traveling system for a work vehicle.
- the automatic traveling system for a work vehicle includes an automatic traveling unit 4 mounted on the tractor 1 and a wireless communication device set to enable wireless communication with the automatic traveling unit 4.
- An example of a mobile communication terminal 5 is included.
- the mobile communication terminal 5 is provided with a multi-touch display device 50 and the like that enable various information displays and input operations related to automatic driving.
- a tablet-type personal computer, a smartphone, or the like can be adopted as the mobile communication terminal 5. Further, for wireless communication, wireless LAN (Local Area Network) such as Wi-Fi (registered trademark) and short-range wireless communication such as Bluetooth (registered trademark) can be adopted.
- wireless LAN Local Area Network
- Wi-Fi registered trademark
- Bluetooth registered trademark
- the tractor 1 is provided with driveable and steerable left and right front wheels 10 and driveable left and right rear wheels 11 as traveling devices.
- the tractor 1 includes a cabin 13 forming a boarding-type driving unit 12, an electronically controlled diesel engine (hereinafter referred to as an engine) 14 having a common rail system, an engine 14, and the like.
- an engine 14 having a common rail system, an engine 14, and the like.
- a bonnet 15 that covers the engine, a speed change unit 16 that shifts power from the engine 14, and the like are provided.
- An electronically controlled gasoline engine or the like having an electronic governor may be adopted as the engine 14.
- the tractor 1 interrupts transmission to a fully hydraulic power steering unit 17 that steers the left and right front wheels 10, a brake unit 18 that brakes the left and right rear wheels 11, and a rotary tiller 3.
- An electro-hydraulic control type work clutch unit 19 an electro-hydraulic control type elevating drive unit 20 that elevates and drives the rotary tiller device 3, and an electro-hydraulic control type rolling unit 21 that enables the rotary tiller device 3 to be driven in the roll direction.
- the vehicle state detection device 22 including various sensors and switches for detecting various setting states and operating states of the tractor 1 and an in-vehicle control unit 23 having various control units are provided.
- the power steering unit 17 may be of an electric type having an electric motor for steering.
- the driver unit 12 is provided with a steering wheel 25 for manual steering, a seat 26 for passengers, and an operation terminal 27 that enables various information displays and input operations. ..
- the driving unit 12 is provided with operating levers such as an accelerator lever and a speed change lever, and operating pedals such as an accelerator pedal and a clutch pedal.
- the operation terminal 27 a multi-touch type liquid crystal monitor, an ISOBUS (isobus) compatible virtual terminal, or the like can be adopted.
- the transmission unit 16 is provided with a traveling transmission system 16A for shifting the power from the engine 14 for traveling and a work transmission system 16B for shifting the power for work. Then, the power after shifting by the traveling transmission system 16A is transmitted to the left and right front wheels 10 via the transmission shaft 28 for driving the front wheels, the front wheel differential device 30 built in the front axle case 29, and the like. Further, the power after shifting by the work transmission system 16B is transmitted to the rotary tiller 3.
- the speed change unit 16 is provided with left and right brakes 31 for individually braking the left and right rear wheels 11.
- the traveling transmission system 16A includes an electronically controlled main transmission 32 that shifts the power from the engine 14, and an electrohydraulic control type forward / backward switching device 33 that switches the power from the main transmission 32 between forward and reverse.
- a gear-type auxiliary transmission 34 that shifts the forward or reverse power from the forward / backward switching device 33 to two high / low stages, and the forward / reverse power from the forward / backward switching device 33 is changed to an ultra-low speed stage.
- the power from the gear type creep transmission 35, the auxiliary transmission 34 or the creep transmission 35 is distributed to the left and right rear wheels 11, and the power from the rear wheel differential 36 and the rear wheel differential 36 is decelerated.
- the left and right speed reducing devices 37 that transmit the power to the left and right rear wheels 11 and an electro-hydraulic control type power transmission switching device 38 that switches the transmission from the auxiliary transmission 34 or the creep transmission 35 to the left and right front wheels 10 are included. There is.
- the work transmission system 16B includes a hydraulic work clutch 39 that interrupts and interrupts the power from the engine 14, a work transmission 40 that switches the power via the work clutch 39 into three stages of forward rotation and one stage of reverse rotation, and work. It includes a PTO shaft 41 and the like that output power from the transmission 40 for work. The power taken out from the PTO shaft 41 is transmitted to the rotary tiller 3 via an external transmission shaft (not shown) or the like.
- the work clutch 39 is included in the work clutch unit 19 together with an electromagnetic control valve (not shown) that controls the flow of oil with respect to the work clutch 39.
- the main transmission 32 includes an I-HMT (Integrated Hydro-static Continuously Variable Transmission), which is an example of a hydraulic mechanical continuously variable transmission having higher transmission efficiency than a hydrostatic continuously variable transmission (HST). It has been adopted.
- I-HMT Integrated Hydro-static Continuously Variable Transmission
- the main transmission 32 includes an HMT (Hydraulic Mechanical Transmission), which is an example of a hydraulic mechanical continuously variable transmission, a hydrostatic continuously variable transmission, or a belt-type continuously variable transmission.
- HMT Hydro Mechanical Transmission
- a continuously variable transmission such as the above may be adopted.
- an electro-hydraulic controlled stepped transmission equipped with multiple hydraulic speed change clutches and multiple electromagnetic speed change valves for controlling the flow of oil with respect to them is adopted. You may.
- the transmission switching device 38 sets the transmission state to the left and right front wheels 10 to the transmission cutoff state in which transmission to the left and right front wheels 10 is cut off, and the peripheral speed of the left and right front wheels 10 to be the same as the peripheral speed of the left and right rear wheels 11.
- Switch to the transmission state As a result, the drive state of the tractor 1 can be switched between a two-wheel drive state, a four-wheel drive state, and a front wheel double speed state.
- the brake unit 18 includes the left and right brakes 31 described above, a foot brake system for operating the left and right brakes 31 in conjunction with the depression operation of the left and right brake pedals provided in the driver unit 12, and a driver unit.
- a parking brake system that operates the left and right brakes 31 in conjunction with the operation of the parking lever provided in 12, and a turning brake that operates the brake 31 inside the turning in conjunction with steering of the left and right front wheels 10 at a set angle or more.
- the turning brake system includes an electro-hydraulic control type brake operating device 18A capable of independently operating the left and right brakes 31.
- the vehicle state detection device 22 is a general term for various sensors and switches provided in each part of the tractor 1. As shown in FIG. 4, the vehicle state detection device 22 includes an accelerator sensor 22A for detecting the operation position of the accelerator lever, a shift sensor 22B for detecting the operation position of the shift lever, and an operation position of the reverser lever for forward / backward switching.
- the reverser sensor 22C to detect, the first rotation sensor 22D to detect the output rotation speed of the engine 14, the vehicle speed sensor 22E to detect the vehicle speed of the tractor 1, the steering angle sensor 22F to detect the steering angle of the front wheels 10, and the rotary tiller 3. It includes a height sensor 22G for detecting the height position, a second rotation sensor 22H for detecting the rotation speed of the PTO shaft 41 as the drive rotation speed of the rotary tiller 3.
- the vehicle speed sensor 22E employs a rotation sensor that detects the rotation speed and rotation direction of the transmission shaft 49 transmitted from the auxiliary transmission 34 or the creep transmission 35 to the rear wheel differential 36. ing.
- the vehicle-mounted control unit 23 includes an engine control unit 23A that controls the engine 14, and a speed change unit control unit that controls the speed change unit 16 such as switching the vehicle speed and forward / backward movement of the tractor 1.
- 23B steering control unit 23C that controls steering
- work device control unit 23D that controls work devices such as rotary tillage device 3
- display control unit 23E that controls display and notification to operation terminals 27, etc., related to automatic driving.
- It includes an automatic driving control unit 23F for controlling, a non-volatile vehicle-mounted storage unit 23G for storing a target route P (see FIG. 5) for automatic driving generated according to the field A, and the like.
- Each control unit 23A to 23F is constructed by an electronic control unit in which a microcomputer or the like is integrated, various control programs, or the like.
- the control units 23A to 23F are connected to each other so as to be able to communicate with each other via CAN (Control Area Area Network).
- CAN Control Area Area Network
- communication standards other than CAN and next-generation communication standards such as in-vehicle Ethernet and CAN-FD (CAN with FLexible Data rate), may be adopted.
- the engine control unit 23A maintains the engine speed at the speed according to the operation position of the accelerator lever based on the detection information from the accelerator sensor and the detection information from the first rotation sensor 22D. To execute.
- the speed change unit control unit 23B calculates the actual vehicle speed of the tractor 1 and determines the traveling direction of the tractor 1 based on the detection information of the vehicle speed sensor 22E.
- the speed change unit control unit 23B of the main transmission unit 32 changes the vehicle speed of the tractor 1 to a speed according to the operation position of the speed change lever based on the detection information of the speed change sensor 22B and the detection information of the vehicle speed sensor 22E.
- Vehicle speed control for controlling the operation, forward / backward switching control for switching the transmission state of the forward / backward switching device 33 based on the detection information of the reverser sensor 22C, and the like are executed.
- the vehicle speed control includes a deceleration stop process of decelerating the main transmission 32 to the zero speed state and stopping the traveling of the tractor 1 when the speed change lever is operated to the zero speed position.
- the speed change unit control unit 23B sets the traveling drive mode of the tractor 1 to the two-wheel drive mode and the four-wheel drive mode based on the operation of the first selection switch (not shown) that enables the selection of the traveling drive mode in the tractor 1. To switch between front wheel speed-up mode, turning brake mode, and front-wheel speed-up turning brake mode.
- the first selection switch is provided in the driving unit 12 and is included in the vehicle state detecting device 22.
- the speed change unit control unit 23B switches the transmission switching device 38 to the transmission cutoff state to cut off the transmission of the tractor 1 to the left and right front wheels 10 and drive only the left and right rear wheels 11. Run in a two-wheel drive state.
- the speed change unit control unit 23B transmits the tractor 1 to the left and right front wheels 10 by switching the transmission switching device 38 to the constant speed drive state, and the left and right front wheels 10 and the left and right rear wheels 11 It is driven in a four-wheel drive state in which and is driven at a constant speed.
- the speed change unit control unit 23B executes front wheel speed change control for switching the transmission switching device 38 between the constant speed transmission state and the double speed transmission state based on the detection information of the steering angle sensor 22F.
- front wheel shift control when the steering angle of the front wheels 10 reaches a set angle or more, it is determined that the tractor 1 has started turning, and the transmission switching device 38 is switched from the constant speed transmission state to the double speed transmission state.
- Speed processing and front wheel deceleration processing that determines that the tractor 1 has finished turning when the steering angle of the front wheels 10 is less than the set angle, and switches the transmission switching device 38 from the double speed transmission state to the constant speed transmission state. It is included.
- the tractor 1 in the front wheel speed-increasing mode, the tractor 1 can be driven in the front wheel speed-increasing state when the tractor 1 is turning, and the turning radius of the tractor 1 can be reduced.
- the speed change unit control unit 23B controls the operation of the brake operating device 18A based on the detection information of the steering angle sensor 22F to switch the left and right brakes 31 between the braking release state and the turning inner braking state.
- the turning brake control when the steering angle of the front wheel 10 reaches the set angle or more, it is determined that the tractor 1 has started turning, and the steering direction of the front wheel 10 is determined from the increasing / decreasing direction of the steering angle at that time. Then, the turning inner braking process for switching the turning inner brake 31 from the braking release state to the braking state, and when the steering angle of the front wheel 10 reaches less than the set angle, it is determined that the tractor 1 has finished turning, and braking is performed.
- It includes a braking release process for switching the brake 31 in the state (inside the turn) to the braking release state.
- the tractor 1 in the turning brake mode, the tractor 1 can be driven in the turning inner braking state when the tractor 1 is turning, and the turning radius of the tractor 1 can be reduced.
- the speed change unit control unit 23B executes the above-mentioned front wheel speed change control and turn brake control based on the detection information of the steering angle sensor 22F.
- the tractor 1 in the front wheel speed-increasing turning brake mode, the tractor 1 can be driven in the front wheel speed-increasing turning inside braking state when the tractor 1 is turning, and the turning radius of the tractor 1 can be further reduced.
- the work device control unit 23D is a work clutch control that controls the operation of the work clutch unit 19 based on an operation of the PTO switch 22K (see FIG. 4) provided in the operation unit 12, and an elevating switch provided in the operation unit 12.
- the PTO switch 22K, the elevating switch 22L, the height setting dial, and the roll angle setting dial are included in the vehicle state detection device 22.
- the tractor 1 is provided with a positioning unit 42 that measures the position, orientation, and the like of the tractor 1.
- the positioning unit 42 includes a satellite navigation device 43 that measures the position and orientation of the tractor 1 using GNSS (Global Navigation Satellite System), which is an example of a satellite positioning system, and a three-axis gyroscope and three directions. It includes an inertial measurement unit (IMU: Inertial Measurement Unit) 44 that has an acceleration sensor and measures the posture and orientation of the tractor 1.
- Positioning methods using GNSS include DGNSS (Differential GNSS: relative positioning method) and RTK-GNSS (Real Time Kinetic GNSS: interference positioning method).
- RTK-GNSS suitable for positioning of a moving body is adopted. Therefore, as shown in FIG. 1, a base station 6 that enables positioning by RTK-GNSS is installed at a known position around the field.
- the positioning unit 42 is an example of the positioning processing unit of the present invention.
- the tractor 1 and the base station 6 each have GNSS antennas 45 and 60 that receive radio waves transmitted from the positioning satellite 7 (see FIG. 1), and the tractor 1 and the base.
- Communication modules 46, 61 and the like that enable wireless communication of each information including positioning information with the station 6 are provided.
- the satellite navigation device 43 of the positioning unit 42 receives the positioning information obtained by the GNSS antenna 45 of the tractor 1 receiving the radio wave from the positioning satellite 7, and the GNSS antenna 60 of the base station 6 receives the radio wave from the positioning satellite 7.
- the position and orientation of the tractor 1 can be measured with high accuracy based on the positioning information obtained by receiving the radio wave.
- the positioning unit 42 has the satellite navigation device 43 and the inertial measurement unit 44, the position, direction, and attitude angle (yaw angle, roll angle, pitch angle) of the tractor 1 can be measured with high accuracy. ..
- the inertial measurement unit 44 of the positioning unit 42, the GNSS antenna 45, and the communication module 46 are included in the antenna unit 47 shown in FIG.
- the antenna unit 47 is arranged at the center of the upper left and right on the front side of the cabin 13.
- the position of the tractor 1 (positioning reference position) measured by the positioning unit 42 is set to the installation position of the GNSS antenna 45 in the tractor 1.
- the GNSS antenna 45 is installed on the left and right centers of the tractor 1 in the upper part of the cabin 13 on the front side.
- the position of the tractor 1 measured by the positioning unit 42 may be set to the center position of the rear wheel axle in the tractor 1 instead of the installation position of the GNSS antenna 45.
- the position of the tractor 1 can be obtained from the positioning information of the positioning unit 42 and the vehicle body information including the positional relationship between the mounting position of the GNSS antenna 45 in the tractor 1 and the center position of the rear wheel axle.
- the mobile communication terminal 5 is provided with an electronic control unit in which a microcontroller or the like is integrated, a terminal control unit 51 having various control programs, and the like.
- the terminal control unit 51 includes a display control unit 51A that controls display and notification to the display device 50 and the like, a target route generation unit 51B that generates a target route P that enables automatic traveling of the tractor 1, and a target route generation.
- a non-volatile terminal storage unit 51C or the like that stores the target path P or the like generated by the unit 51B is included.
- the terminal storage unit 51C includes vehicle body information including the turning radius of the tractor 1, the working width of the rotary tiller 3, and the position and shape of the field A as various information used to generate the target path P. Field information etc. are stored.
- the target route P is stored in the terminal storage unit 51C in a state associated with vehicle body information, field information, and the like, and can be displayed on the display device 50 of the mobile communication terminal 5.
- the target route P includes various information related to automatic traveling such as the traveling direction of the tractor 1, the target vehicle speed, the front wheel steering angle, the automatic traveling start position pa, and the automatic traveling end position pb.
- the tractor 1 and the mobile communication terminal 5 have communication modules 48 and 52 that enable wireless communication of each information including positioning information between the vehicle-mounted control unit 23 and the terminal control unit 51. It is prepared.
- the communication module 48 of the tractor 1 functions as a converter that converts communication information into both directions of CAN and Wi-Fi.
- the terminal control unit 51 can acquire various information about the tractor 1 including the position and orientation of the tractor 1 by wireless communication with the vehicle-mounted control unit 23.
- the display device 50 of the mobile communication terminal 5 can display various information including the position and direction of the tractor 1 with respect to the target path P.
- the terminal control unit 51 transmits field information, a target route P, etc. stored in the terminal storage unit 51C to the vehicle-mounted control unit 23 in response to a transmission request command from the vehicle-mounted control unit 23.
- the vehicle-mounted control unit 23 stores the received field information, the target route P, and the like in the vehicle-mounted storage unit 23G.
- the terminal control unit 51 transmits all of the target route P from the terminal storage unit 51C to the vehicle-mounted control unit 23 at once before the tractor 1 starts automatic traveling. You may do it.
- the terminal control unit 51 divides the target route P into a plurality of divided route information for each predetermined distance, and each time the traveling distance of the tractor 1 reaches the predetermined distance from the stage before the tractor 1 starts automatic traveling. , A predetermined number of division route information according to the traveling order of the tractor 1 may be sequentially transmitted from the terminal storage unit 51C to the vehicle-mounted control unit 23.
- Detection information from various sensors, switches, etc. included in the vehicle state detection device 22 is input to the automatic driving control unit 23F.
- the automatic traveling control unit 23F can monitor various setting states in the tractor 1 and operating states of each unit.
- the automatic driving control unit 23F is subjected to various manual setting operations for enabling automatic driving of the tractor 1 by a user such as a passenger or an administrator, and the driving mode of the tractor 1 is automatically changed from the manual driving mode.
- the display device 50 of the mobile communication terminal 5 is operated to instruct the start of automatic driving in the state of being switched to the mode, the target route P is acquired by the positioning unit 42 while acquiring the position and orientation of the tractor 1. According to this, the automatic traveling control for automatically traveling the tractor 1 is started.
- the automatic driving control unit 23F is on board the driving unit 12, for example, when the user operates the display device 50 of the mobile communication terminal 5 to instruct the end of the automatic driving while the automatic driving control is being executed.
- the automatic driving control is terminated and the driving mode is switched from the automatic driving mode to the manual driving mode.
- automatic driving control by the automatic driving control unit 23F automatic control processing for the engine that transmits a control command for automatic driving related to the engine 14 to the engine control unit 23A, automatic driving related to switching the vehicle speed and forward / backward movement of the tractor 1 and the like are performed.
- the automatic driving control unit 23F transmits an engine rotation speed change command or the like instructing the engine rotation speed change based on the set rotation speed or the like included in the target path P to the engine control unit 23A. do.
- the engine control unit 23A executes engine speed change control or the like that automatically changes the engine speed in response to various control commands regarding the engine 14 transmitted from the automatic travel control unit 23F.
- the automatic driving control unit 23F is included in the shift operation command for instructing the shift operation of the main transmission 32 based on the target vehicle speed included in the target path P, and the target path P.
- a forward / backward switching command or the like instructing a forward / backward switching operation of the forward / backward switching device based on the traveling direction of the tractor 1 is transmitted to the speed change unit control unit 23B.
- the speed change unit control unit 23B automatically controls the operation of the main speed change device 32 in response to various control commands related to the main speed change device 32, the forward / backward changeover device, etc. transmitted from the automatic travel control unit 23F.
- automatic forward / backward switching control that automatically controls the operation of the forward / backward switching device is executed.
- the vehicle speed control includes, for example, an automatic deceleration stop process in which the main transmission 32 is decelerated to a zero speed state to stop the running of the tractor 1 when the target vehicle speed included in the target path P is zero speed. It is included.
- the automatic driving control unit 23F transmits a steering command or the like instructing steering of the left and right front wheels 10 to the steering control unit 23C based on the front wheel steering angle or the like included in the target path P.
- the steering control unit 23C controls the operation of the power steering unit 17 to steer the left and right front wheels 10 in response to the steering command transmitted from the automatic driving control unit 23F, and the left and right front wheels 10 are set.
- the brake unit 18 is operated to execute the automatic turning brake control for operating the brake inside the turning.
- the automatic travel control unit 23F starts work instructing the rotary tiller 3 to switch to the work state based on the arrival of the tractor 1 at each work start position included in the target path P.
- a command and a work end command for instructing the switching of the rotary tiller 3 to the non-working state based on the arrival of the tractor 1 at each work stop position included in the target path P are transmitted to the work device control unit 23D. do.
- the working device control unit 23D controls the operation of the work clutch unit 19 and the elevating drive unit 20 in response to various control commands regarding the rotary tilling device 3 transmitted from the automatic traveling control unit 23F, and controls the rotary tilling device 3.
- Automatic work start control for driving and lowering to the work height, automatic work end control for raising the rotary tiller 3 to the non-work height and driving and stopping, and the like are executed.
- the traveling state of the tractor 1 that automatically travels according to the target route P is changed to the working traveling state in which the tractor 1 automatically travels in the working state of the rotary tilling device 3 (the state in which the rotary tilling device 3 is driven and lowered to the working height).
- the tractor 1 can be switched to the non-working state in which the tractor 1 automatically travels in the non-working state of the rotary tilling device 3 (the state in which the rotary tilling device 3 rises to the non-working height and is driven and stopped).
- the above-mentioned automatic traveling unit 4 includes a power steering unit 17, a brake unit 18, a work clutch unit 19, an elevating drive unit 20, a rolling unit 21, a vehicle state detection device 22, an in-vehicle control unit 23, a positioning unit 42, and the like. , Communication modules 46, 48 and the like are included. Then, when these operate properly, the tractor 1 can be automatically driven with high accuracy according to the target route P, and the cultivating work by the rotary cultivating device 3 can be properly performed.
- the tractor 1 is provided with a peripheral condition acquisition system 8 for acquiring the peripheral condition of the tractor 1.
- the peripheral situation acquisition system 8 includes an image pickup unit 80 that images the surroundings of the tractor 1 to acquire image information, and an obstacle detection unit that detects obstacles existing around the tractor 1. 85 is included. Obstacles detected by the obstacle detection unit 85 include a person such as a worker working in the field A, another work vehicle, and an existing utility pole or tree in the field A.
- the image pickup unit 80 includes a front camera 81 in which a predetermined range in front of the cabin 13 is set in the image pickup range, and a rear camera 81 in which a predetermined range behind the cabin 13 is set in the image pickup range. It includes a camera 82 and an image processing device 83 (see FIG. 4) that processes image information from the front and rear cameras 81 and 82.
- the image processing device 83 is constructed by an electronic control unit in which a microcontroller and the like are integrated, various control programs, and the like.
- the image processing device 83 is connected to an in-vehicle control unit 23 or the like so as to be able to communicate with each other via a CAN.
- the image processing device 83 generates an image that generates a front image and a rear image of the tractor 1 corresponding to the imaging range of each camera 81, 82 with respect to the image information sequentially transmitted from the front and rear cameras 81, 82. Perform processing etc. Then, an image transmission process is performed in which each generated image is transmitted to the display control unit 23E of the vehicle-mounted control unit 23.
- the display control unit 23E transmits each image from the image processing device 83 to the operation terminal 27 via the CAN, and also transmits each image to the display control unit 5A of the mobile communication terminal 5 via the communication modules 48 and 52.
- the front side image and the rear side image of the tractor 1 generated by the image processing device 83 can be displayed on the operation terminal 27 of the tractor 1, the display device 50 of the mobile communication terminal 5, and the like. Then, from this display, the user can easily grasp the situation on the front side and the rear side of the tractor 1.
- the front side of the tractor 1 is set to the obstacle detection range
- the rear side of the tractor 1 is set to the obstacle detection range.
- a rear obstacle sensor 87 that has been set, and a lateral obstacle sensor 88 whose left and right lateral sides of the tractor 1 are set to the obstacle detection range are included.
- the front obstacle sensor 86 and the rear obstacle sensor 87 employ a lidar sensor that uses a pulsed near-infrared laser beam to detect an obstacle.
- the lateral obstacle sensor 88 employs a sonar that uses ultrasonic waves to detect obstacles.
- the front obstacle sensor 86 and the rear obstacle sensor 87 use near-infrared laser light to measure the distance to each range-finding point (measurement target) existing in the measurement range. It has units 86A and 87A, and control units 86B and 87B that generate a distance image based on the measurement information of the measurement units 86A and 87A.
- the lateral obstacle sensor 88 is a measurement target existing in the measurement range based on the transmission and reception of ultrasonic waves by the right ultrasonic sensor 88A and the left ultrasonic sensor 88B for transmitting and receiving ultrasonic waves, and the ultrasonic sensors 88A and 88B. It has a single control unit 88C that measures the distance to an object.
- the control units 86B, 87B, 88C of each obstacle sensor 86 to 88 are constructed by an electronic control unit in which a microcontroller or the like is integrated, various control programs, and the like.
- the control units 86B, 87B, 88C are connected to the vehicle-mounted control unit 23 and the like via CAN so as to be mutually communicable.
- the automatic driving control unit 23F controls the traveling of the tractor 1 based on the positioning information of the positioning unit 42 and the detection information of the obstacle sensors 86 to 88 transmitted to the vehicle-mounted control unit 23 to be regarded as an obstacle. Executes collision avoidance control to avoid collisions. In the collision avoidance control, the automatic driving control unit 23F instructs the speed change unit control unit 23B to execute the driving control for each collision avoidance according to the detection information of the obstacle sensors 86 to 88, whereby the tractor 1 Control the running of the vehicle to avoid collision with obstacles.
- the automatic traveling control unit 23F is an example of the traveling processing unit of the present invention.
- the target route generation unit 51B provides vehicle body information including the turning radius of the tractor 1 and the working width of the rotary tiller 3, field information including the position and shape of the field A to work with the tractor 1, and the user.
- the target route generation control for generating the target route P is executed based on various optional setting information and the like set in the above.
- the target route generation unit 51B is an example of the route generation processing unit of the present invention.
- the vehicle body information includes the first separation distance L1 (see FIGS. 5 to 8) from the installation position of the GNSS antenna 45 in the tractor 1 to the rotary tiller 3 measured by the positioning unit 42, and the rear wheel 11 of the tractor 1.
- the second separation distance L2 (see FIGS. 5 to 8) from the to the rotary tiller 3 to the rotary tiller 3 is included.
- the first separation distance L1 is set to the distance from the installation position of the GNSS antenna 45 in the tractor 1 to the rotation center position X1 of the tiller claw 3A in the rotary tiller 3.
- the second separation distance L2 is set to the distance from the axle center X2 of the rear wheel 11 of the tractor 1 to the rotation center position X1 of the tilling claw 3A.
- shape-specific coordinates Cp1 to Cp4 (see FIG. 5)
- a shape-specific line SL (see FIG. 5) that connects these shape-specific points to specify the shape and size of the field A are included. ..
- the start position pa and the end position pb of the automatic running, the working running direction of the tractor 1, and the like are manually input by the user as various optional setting information. Will be explained on the premise of.
- the start position pa and the end position pb of the automatic running are set at the positions shown in FIG.
- the field A is based on the above-mentioned four corner points Cp1 to Cp4 and the rectangular shape specifying line SL.
- the first division process for dividing the margin area A1 adjacent to the outer peripheral edge of the field A and the workable area A2 located inside the margin area A1 is performed (step # 1).
- the margin area A1 is for preventing the rotary tiller 3 and the like from coming into contact with other objects such as ridges and fences adjacent to the field A when the tractor 1 automatically travels on the end of the workable area A2.
- it is an area secured between the outer peripheral edge of the field A and the workable area A2.
- the target route generation unit 51B sets the workable area A2 at the end of each long side of the workable area A2 based on the turning radius of the tractor 1 and the work width of the rotary tiller 3.
- the second division process for dividing into the conversion region A2a and the reciprocating traveling region A2b set between the pair of direction conversion regions A2a is performed (step # 2).
- a boundary line BL indicating a boundary between the direction change area A2a and the reciprocating travel area A2b is described. ..
- the target route generation unit 51B performs a parallel route generation process for generating a plurality of parallel routes P1 arranged in parallel in the reciprocating travel area A2b at predetermined intervals according to the working width in the direction along the long side of the field A. Do (step # 3).
- the target route generation unit 51B performs a direction change route generation process in each direction change region A2a to generate a plurality of direction change paths P2 in which the rotary tiller 3 changes the direction of the tractor 1 switched to the working state (step #). 4).
- the various optional setting information described above includes the type of the direction change path P2, and in the present embodiment, as shown in FIGS. 5 to 15, a switchback is used as the direction change path P2.
- a switchback is used as the direction change path P2.
- the case where the switchback type turning path for turning the tractor 1 in the shape of a fishtail is selected is illustrated.
- a U-shaped turn path for causing the tractor 1 to change direction in a U shape can be selected.
- the target route generation unit 51B separates the first predetermined distance L3 from the start position p1 of each parallel path P1 in the forward direction of the tractor 1 in the parallel path P1.
- the first route generation process for generating the first forward path P1a over the first relay position p2 is performed (step # 31).
- the target route generation unit 51B performs a second route generation process for generating a reverse route P1b extending from the first relay position p2 to the second relay position p3 separated by a predetermined length L4 in the reverse direction of the tractor 1 in the parallel route P1. (Step # 32).
- the target route generation unit 51B performs a third route generation process for generating a second forward path P1c extending from the second relay position p3 to the terminal position p4 of the parallel path P1 (step # 33).
- the target route generation unit 51B extends the start end side of the second forward path P1c with a predetermined length L4 extending from the first relay position p2 to the second relay position p3, and is the second.
- the terminal side of the forward path P1c is extended by a predetermined length L4 from the boundary between the direction change area A2a and the reciprocating travel area A2b, and the total length of the second forward path P1c is extended from the second relay position p3 to the direction change area A2a.
- the length is set so that the end side of the second forward path P1c has a predetermined length L4 and a second predetermined distance L5 that enters the direction change region A2a beyond the boundary between the reciprocating travel region A2b and the reciprocating travel region A2b.
- the target route generation unit 51B first switches the path on which the tractor 1 travels from the first forward path P1a to the reverse path P1b when the tractor 1 arrives at the first relay position p2.
- the first switching position setting process for setting the switching position is performed (step # 34).
- the target route generation unit 51B switches the second relay position p3 from the reverse route P1b to the second forward route P1c as the tractor 1 arrives at the second relay position p3.
- the second switching position setting process for setting the switching position is performed (step # 35).
- the target route generation unit 51B turns the tractor 1 90 degrees forward from the start position p5 of each direction change path P2 to the right.
- a fourth route generation process for generating P2a is performed (step # 41).
- the target route generation unit 51B performs a fifth route generation process for generating a right forward path P2b that advances the tractor 1 to the right from the end position p6 of the start end side turning path P2a (step # 42).
- the target route generation unit 51B performs a sixth route generation process for generating a left reverse route P2c that reverses the tractor 1 to the left from the terminal position p7 of the right forward route P2b (step # 43).
- the target route generation unit 51B performs a seventh route generation process for generating a terminal turning path P2d that turns the tractor 1 90 degrees forward to the right from the terminal position p8 of the left reverse path P2c (step # 44).
- the target route generation unit 51B sets the end position p6 of the start end side turning path P2a from the start end side turning path P2a to the right forward path P2b along with the arrival of the tractor 1 at the end position p6.
- the third switching position setting process for setting the third switching position to be switched is performed (step # 45).
- the target route generation unit 51B switches the end position p7 of the right forward path P2b from the right forward path P2b to the left reverse path P2c as the tractor 1 arrives at the terminal position p7. 4 Perform the fourth switching position setting process for setting the switching position (step # 46).
- the target route generation unit 51B switches the end position p8 of the left reverse path P2c from the left reverse path P2c to the end side turning path P2d as the tractor 1 arrives at the end position p8.
- the fifth switching position setting process for setting the fifth switching position is performed (step # 47).
- the target route generation unit 51B sets the terminal position p9 of the terminal swivel path P2d to the parallel path P1 from the terminal swivel path P2d along the path on which the tractor 1 travels with the arrival of the tractor 1 at the terminal position p9. 1 Perform the sixth switching position setting process for setting to the sixth switching position for switching to the forward path P1a (step # 48).
- the target route generation unit 51B performs the parallel route generation process and the direction change route generation process, and then the tractor extends from the end position p4 of the parallel path P1 to the start position p5 of the direction change path P2.
- a reverse route generation process for generating a relay reverse route P3 that reverses 1 is performed (step # 5).
- the target route generation unit 51B generates the target route P suitable for the tractor 1 to perform the tilling work by automatic traveling in the field A.
- the automatic driving control unit 23F is positioned at the starting position of the target route P (starting position p1 of the parallel route P1) where the tractor 1 is the starting position pa of the automatic traveling, in an appropriate posture capable of automatic traveling according to the target route P.
- start of automatic running is instructed, first, the tractor 1 is moved forward according to the first forward path P1a of the parallel path P1 in the non-working state in which the rotary tiller 3 is switched to the non-working state. (See FIGS. 12 and 13).
- the automatic travel control unit 23F switches the travel path from the first forward path P1a to the reverse path P1b with this arrival.
- the tractor 1 is switched from the forward state to the reverse state via the speed change unit control unit 23B.
- the tractor 1 is moved backward according to the reverse path P1b in a non-working state (see FIGS. 13 and 14).
- the automatic travel control unit 23F is based on the fact that when the tractor 1 reaches the second relay position p3, which is the terminal position of the reverse route P1b, the travel route is switched from the reverse route P1b to the second forward route P1c with this arrival.
- the tractor 1 is switched from the reverse state to the forward state via the speed change unit control unit 23B, and the rotary tiller 3 is switched from the non-working state to the working state.
- the tractor 1 is advanced according to the second forward path P1c in the working running state in which the rotary tilling device 3 is switched to the working state (see FIGS. 14, 15, and 6).
- the automatic travel control unit 23F changes the travel path from the second forward path P1c to the relay reverse path P3. Based on the switching, the tractor 1 is switched from the forward state to the reverse state via the speed change unit control unit 23B, and the rotary tiller 3 is switched from the working state to the non-working state. As a result, the tractor 1 is moved backward according to the relay reverse route P3 in the non-working state (see FIGS. 7 and 8).
- the automatic travel control unit 23F causes the travel path to change from the relay reverse path P3 to the start end of the direction change path P2.
- the tractor 1 is switched from the reverse state to the forward state via the speed change unit control unit 23B.
- the tractor 1 is advanced along the starting end side turning path P2a in a non-working traveling state (see FIGS. 8 and 9).
- the automatic traveling control unit 23F is based on the fact that when the tractor 1 reaches the end position p6 of the start end side turning path P2a, the traveling path is switched from the starting end side turning path P2a to the right forward path P2b with this arrival. 1 is advanced according to the right forward path P2b in a non-working state (see FIGS. 9 and 10).
- the automatic travel control unit 23F controls the speed change unit based on the fact that the travel path is switched from the right forward path P2b to the left reverse path P2c with this arrival.
- the tractor 1 is switched from the forward state to the reverse state via the portion 23B.
- the tractor 1 is moved backward according to the left reverse path P2c in a non-working state (see FIGS. 10 and 11).
- the automatic traveling control unit 23F is based on the fact that when the tractor 1 reaches the terminal position p8 of the left reverse path P2c, the traveling path is switched from the left reverse path P2c to the terminal turning path P2d with this arrival.
- the tractor 1 is switched from the reverse state to the forward state via the control unit 23B.
- the tractor 1 is advanced according to the terminal turning path P2d in the non-working state (see FIGS. 11 and 12).
- the automatic traveling control unit 23F switches the traveling path from the terminal turning path P2d to the first forward path P1a of the parallel path P1. Based on the above, the tractor 1 is advanced according to the first forward path P1a in a non-working state (see FIGS. 12 and 13).
- the second forward path P1c of each parallel path P1 functions as a work path for advancing the tractor 1 whose rotary tilling device 3 has been switched to the working state.
- the target path P is a second forward path (work path) P1c of a plurality of parallel paths P1 arranged in parallel at predetermined intervals according to a work width, a plurality of relay reverse paths P3, and a plurality of directions. It is generated by a route setting in which the tractor 1 is connected in the traveling order via the conversion route P2 and the first forward route P1a and the reverse route P1b in the plurality of parallel routes P1.
- the second forward path P1c is generated so that its terminal side is extended by a predetermined length L4 and enters the direction change path P2 side at the predetermined length L4. Then, a relay reverse path P3 for moving the tractor 1 backward from the end position p4 of the extended second forward path P1c to the start position p5 of the turning path is generated.
- the tractor 1 when the tractor 1 is automatically driven according to the target route P, the tractor 1 exceeds the start position p5 of the turning path P2 and reaches the end position p4 of the second forward path P1c after extension.
- the rotary tiller 3 can be maintained in a working state.
- the working end position pd which is the grounding position of the above, can be brought closer to the start position p5 of the direction change path P2.
- the unworked path existing between the work end position pd by the tractor 1 and the start end position p5 of the direction change path P2 is extended to the second forward path P1c with a predetermined length L4. Can be shortened by the amount of. As a result, the work area for working with the automatic running of the tractor 1 can be widened, and the work efficiency when working with the automatic running of the tractor 1 can be improved.
- the position of the rotary tiller 3 when the tractor 1 reaches the start position p5 of the turning path P2 is indicated by the reference numeral px, and the tractor 1 is the second forward path P1c.
- the ground contact position pd of the rotary tiller 3 when reaching the end position p4 and ending the work run is higher than the position px of the rotary tiller 3 when the tractor 1 reaches the start position p5 of the turning path P2. It is shown to be close to the starting position p5 of the turning path P2.
- the tractor 1 follows the relay reverse path P3 and is in a non-working state. Since the vehicle moves backward from the end position p4 of the forward path P1c to the start position p5 of the direction change path P2, the position and width of the direction change region for changing the direction of the tractor 1 are set before extending the end side of the second forward path P1c.
- the tractor 1 can be appropriately turned toward the start position p1 of the next parallel path P1 according to the turning path P2.
- the above-mentioned unworked route can be shortened without changing the position and width of the turning region A2a for turning the tractor 1, and the work efficiency when working with the automatic traveling of the tractor 1 is improved. be able to.
- a predetermined length L4 extending the terminal side of the second forward path P1c is set to a length based on the second separation distance L2 from the rear wheel 11 of the tractor 1 to the rotary tiller 3.
- the predetermined length L4 is set to a length shorter than the second separation distance L2 from the axle center X2 of the rear wheel 11 in the tractor 1 to the rotation center position X1 of the tiller claw 3A in the rotary tiller 3. ing.
- the above-mentioned unworked route can be shortened while avoiding the possibility that the rear wheel 11 of the tractor 1 enters the existing work area, and the work efficiency when working by the automatic traveling of the tractor 1 can be improved. ..
- the work start position pc which is the ground contact position of the rotary tiller 3 when the tractor 1 after the direction change reaches the second relay position p3, which is the start position of the second forward path P1c, is the tractor.
- the start position of the second forward path P1c (second relay) so as to coincide with the working end position pd which is the grounding position of the rotary tiller 3 when 1 reaches the terminal position p4 of the second forward path P1c after extension.
- the position p3) is set to a position closer to the start position p1 of the parallel path P1 by a predetermined length L4 than the first relay position p2 separated from the start position p1 of each parallel path P1 by a first predetermined distance L3. ..
- the tractor 1 sets the ground contact position (work start position) pc of the rotary tiller 3 when the tractor 1 reaches the start position p3 of the second forward path P1c and starts the work run, and the tractor 1 sets the second forward path P1c. It can be aligned with the ground contact position (work end position) pd of the rotary tiller 3 when the end position p6 is reached and the work run is completed.
- the ground contact position (work start position) pc of the rotary tiller 3 when the tractor 1 reaches the start position p3 of the second forward path P1c is set to the direction change path P2. It is possible to approach the terminal position p9 of.
- the unworked path existing between the end position p9 of each direction change path P2 and the work start position pc by the tractor 1 can be shortened, and the work efficiency when working by the automatic traveling of the tractor 1 is improved. In addition to this, it is possible to improve the work accuracy when the work is performed by the automatic traveling of the tractor 1.
- the target path P includes a first forward path P1a extending from the terminal position p9 of the direction change path P2 beyond the start position p3 of the second forward path P1c, and a first relay position which is the terminal position of the first forward path P1a. It includes a reverse path P1b that reverses the tractor 1 from p2 over the start position p3 of the second forward path P1c.
- the position and orientation of the tractor 1 exceeds the allowable range with respect to the second forward path P1c.
- the position and orientation of the tractor 1 with respect to the start position p3 of the second forward path P1c are within the permissible range by the forward movement of the tractor 1 on the first forward path P1a and the reverse movement of the tractor 1 on the reverse path P1b. The trajectory can be corrected.
- the position and direction of the tractor 1 with respect to the second forward path P1c when the tractor 1 reaches the start position p3 of the second forward path P1c and starts the work running can be made appropriate, and the tractor 1 can automatically run. It is possible to improve the work accuracy when working in.
- the various optional setting information described above includes the traveling drive mode of the tractor 1 selected by the operation of the first selection switch described above. Therefore, in the above-mentioned direction change route generation process, the target route generation unit 51B determines the turning radius of the start side turning path P2a and the ending side turning path P2d according to the traveling drive mode of the tractor 1 arbitrarily set. .. In the automatic traveling control unit 23F, when any one of the front wheel speed-increasing mode, the turning brake mode, and the front wheel speed-increasing turning braking mode is arbitrarily set as the traveling drive mode of the tractor 1, the tractor 1 is a relay reverse path.
- the travel drive mode of the tractor 1 is switched to the travel drive mode arbitrarily set.
- the automatic traveling control unit 23F returns to the original traveling drive mode before switching the traveling drive mode of the tractor 1 to the arbitrarily set traveling drive mode.
- the automatic traveling control unit 23F switches the traveling drive mode of the tractor 1 to an arbitrarily set travel drive mode.
- the automatic traveling control unit 23F returns to the original traveling drive mode before switching the traveling drive mode of the tractor 1 to the arbitrarily set traveling drive mode.
- the target route generation unit 51B generates the target path P based on various arbitrary setting information including the set traveling drive mode of the tractor 1, the start end side turning path P2a or the ending side turning path P2d of the target path P is generated.
- the tractor 1 When the tractor 1 makes a turning run according to the above, the tractor 1 runs in either the front wheel speed-increasing state, the turning inside braking state, or the front wheel speed-increasing turning inside braking state according to the traveling drive mode of the tractor 1 arbitrarily set.
- the turning radius of the tractor 1 can be reduced.
- the target route is generated.
- the unit 51B can narrow the pair of direction change regions A2a in which the direction change path P2 is generated and widen the reciprocating travel area A2b in which the parallel path P1 is generated. Then, the work area Aw can be widened accordingly, and the work efficiency when working by the automatic traveling of the tractor 1 can be improved.
- the travel drive mode of the tractor 1 is not arbitrarily set by the user as described above, but is optimal for the target route generation unit 51B to widen the work area Aw and improve the work efficiency. May be configured to be set automatically.
- the target route P shown in FIG. 5 is merely an example, and the target route generation unit 51B has different vehicle body information depending on the model of the tractor 1 and the type of the working device, and different field A according to the field A. Based on field information such as shape and size, various target paths P suitable for them can be generated.
- the target route generation unit 51B generates a target route P including a work route P1 for advancing the tractor 1 in the field A and a direction change route P2 for turning the tractor 1.
- the target route generation unit 51B is an example of the route generation processing unit of the present invention.
- the target path P includes a plurality of parallel work paths P1 and a turnover path P2 for the tractor 1 to turn from one work path P1 to an adjacent work path P1.
- the turning path P2 includes a turning path P2a on the starting end side connecting the starting position p5 to the ending position p6 of the turning path P2, a right forward path P2b connecting the ending position p6 to the ending position p7, and a ending position p8 from the ending position p7. It includes a left reverse path P2c to be connected and a terminal turning path P2d connecting the terminal position p8 to the start position p1 of the work path P1.
- the automatic driving control unit 23F automatically drives the tractor 1 according to the target route P based on the positioning information of the positioning unit 42. Further, in the automatic traveling control unit 23F, when the tractor 1 changes direction on the direction change path P2, the direction change position for switching the front-rear direction of the tractor 1 is the tractor 1 immediately before the tractor 1 reaches the direction change position. When the distance is less than the predetermined distance from the predetermined area on the traveling direction side, the deceleration process for decelerating the target speed of the tractor 1 toward the turning position is executed.
- the direction change position is a position for switching the front-rear direction in which the tractor 1 travels, for example, a position for switching from forward to reverse, or a position for switching from reverse to forward.
- the automatic traveling control unit 23F may be used.
- the deceleration process is not executed.
- the automatic traveling control unit 23F is an example of the traveling processing unit of the present invention.
- the predetermined region of the present invention is, for example, a region outside the field A (outside the field region A1).
- the predetermined area is not limited to the out-of-field area A1, and may be, for example, a work area that prohibits overlapping running of the tractor 1, or an obstacle area where an obstacle, an entrance slope, or the like exists. There may be.
- the automatic traveling control unit 23F executes deceleration control so that the tractor 1 does not enter the predetermined area when the tractor 1 changes direction.
- the tractor 1 turns 90 degrees to the right from the start position p5 of the direction change path P2, advances the start end side turn path P2a to the end position p6, and when it reaches the end position p6, turns to the right to the end position p7.
- Move forward on the right forward path P2b (see FIG. 19A).
- the tractor 1 reaches the terminal position p7, it reverses the left reverse path P2c to the left to the terminal position p8 (see FIG. 19B).
- the tractor 1 reaches the end position p8, it turns 90 degrees forward to the right and advances the end side turn path P2d to the start position p1 of the work path P1 (see FIG. 19C).
- FIGS. 20A to 20C exemplify the work path P1 and the direction change path P2 on the right side of the field A. is doing.
- the automatic travel control unit 23F reverses the left reverse route P2c in which the tractor 1 approaches the out-of-field region A1 (the left end portion of the field A).
- the end position p8 direction change position
- the deceleration process for decelerating the target speed of the tractor 1 toward the terminal position p8 is executed.
- the automatic traveling control unit 23F executes the deceleration process so that the tractor 1 traveling backward on the left reverse path P2c is in the zero speed state (stop state) at the terminal position p8 (see FIG. 19C). This makes it possible to prevent the tractor 1 from jumping out to the out-of-field area A1.
- the predetermined distance Lth is set in advance based on the length of the direction change path P2 (for example, the left reverse path P2c) and the target vehicle speed of the tractor 1.
- the automatic travel control unit 23F is a terminal position for switching the front-rear direction of the tractor 1 when the tractor 1 travels backward on the left reverse path P2c approaching the out-of-field region A1 (left end of the field A) (see FIG. 19B).
- the distance Lp between p8 (direction change position) and the out-of-field area A1 (left end of field A) on the traveling direction side (left side) of the tractor 1 immediately before the tractor 1 reaches the terminal position p8 is the predetermined distance Lth. In the above cases, the deceleration process is not executed.
- the automatic traveling control unit 23F does not execute the deceleration process when the tractor 1 travels forward on the right forward path P2b where the tractor 1 does not approach the out-of-field region A1 (the left end portion of the field A).
- the automatic traveling control unit 23F changes the direction of the tractor 1 at a predetermined speed, and outputs a switching instruction for switching forward / backward at a predetermined position of the direction change path P2 to the tractor 1.
- the time required for changing the direction of the tractor 1 can be shortened. Further, for example, even if the tractor 1 reverses on the left reverse path P2c and jumps out to the left of the target terminal position p8, it can be prevented from entering the out-of-field region A1.
- the automatic travel control unit 23F travels forward.
- the terminal position p7 (direction change position) for switching the front-rear direction of the tractor 1 and the out-of-field area A1 (right end portion of the field A) on the traveling direction side (right side) of the tractor 1 immediately before the tractor 1 reaches the terminal position p7.
- the distance Lp between the two is less than the predetermined distance Lth, a deceleration process for decelerating the target speed of the tractor 1 toward the terminal position p7 is executed (see FIG. 20B).
- the automatic traveling control unit 23F executes the deceleration process so that the tractor 1 traveling forward on the right forward path P2b is in the zero speed state (stop state) at the terminal position p7. This makes it possible to prevent the tractor 1 from jumping out to the out-of-field area A1.
- the predetermined distance Lth is set in advance based on the length of the direction change path P2 (for example, the right forward path P2b) and the target vehicle speed of the tractor 1.
- the predetermined distance Lth when the tractor 1 changes direction due to reverse travel see FIGS. 19A to 19C
- the predetermined distance Lth when the tractor 1 changes direction due to forward travel see FIGS. 20A to 20C.
- the predetermined distance Lth is set to a different value depending on the length of the left reverse path P2c and the length of the right forward path P2b.
- the automatic travel control unit 23F is a terminal position for switching the front-rear direction of the tractor 1 when the tractor 1 travels forward on the right forward path P2b approaching the out-of-field region A1 (the right end of the field A) (see FIG. 20A).
- the distance Lp between p7 (direction change position) and the out-of-field area A1 (right end of field A) on the traveling direction side (right side) of the tractor 1 immediately before the tractor 1 reaches the terminal position p7 is the predetermined distance Lth. In the above cases, the deceleration process is not executed.
- the automatic traveling control unit 23F does not execute the deceleration process when the tractor 1 travels backward on the left reverse path P2c where the tractor 1 does not approach the out-of-field region A1 (the right end portion of the field A).
- the automatic traveling control unit 23F changes the direction of the tractor 1 at a predetermined speed, and outputs a switching instruction for switching forward / backward at a predetermined position of the direction change path P2 to the tractor 1.
- the time required for changing the direction of the tractor 1 can be shortened. Further, for example, even if the tractor 1 advances on the right forward path P2b and jumps out to the right of the target end position p7, it can be prevented from entering the out-of-field region A1.
- the automatic traveling control unit 23F performs the deceleration process based on the distance Lp between the end position p7 and the right end portion of the field A. Determine the necessity of. That is, in this case, the automatic traveling control unit 23F does not determine the necessity of the deceleration process based on the distance between the terminal position p7 and the upper end portion of the field A.
- the automatic traveling control unit 23F is located between the terminal position p7 and the upper end portion of the field A. Whether or not the deceleration process is necessary is determined based on the distance.
- the turning path P2 is not limited to the fishtail-shaped turning path.
- the turning path P2 may be, for example, the turning path shown in FIG. 21 or FIG. 22.
- the tractor 1 travels to the left on the work path P1 and stops the work when it reaches the position p11, advances from the position 11 to the position 12, and moves forward and backward when it reaches the position 12. To move backward from position p12 to position p13. When the tractor 1 reaches the position p13, it switches forward and backward, turns 90 degrees to the left from the position p13, and advances to the position p14. When the tractor 1 reaches the position p14, it switches forward and backward to move backward to the position p15, and when it reaches the position p15, it switches forward and backward to move forward to the position p11. When the tractor 1 reaches the position p11, it advances the work path P1 and resumes the work.
- the automatic travel control unit 23F travels forward on the left forward route (the route from the position p11 to the position p12) in which the tractor 1 approaches the out-of-field region A1 (the left end of the field A).
- the position p12 (direction change position) for switching the front-rear direction of the tractor 1, and the out-of-field area A1 (left end of the field A) on the traveling direction side (left side) of the tractor 1 immediately before the tractor 1 reaches the position p12.
- the distance Lp between the two is less than the predetermined distance Lth, the deceleration process for decelerating the target speed of the tractor 1 toward the position p12 is executed.
- the automatic traveling control unit 23F executes the deceleration process so that the tractor 1 moving forward to the left is in the zero speed state (stop state) at the position p12. Further, the automatic travel control unit 23F reverses the forward / backward direction of the tractor 1 when the tractor 1 travels backward on the upward / reverse route (the route from the position p14 to the position p15) approaching the out-of-field region A1 (the upper end of the field A).
- the distance Lp between the switching position p15 (direction change position) and the out-of-field area A1 (upper end of the field A) on the traveling direction side (upper side) of the tractor 1 immediately before the tractor 1 reaches the position p15 is a predetermined distance.
- a deceleration process for decelerating the target speed of the tractor 1 toward the position p15 is executed.
- the automatic traveling control unit 23F executes the deceleration process so that the tractor 1 traveling upward and backward is in the zero speed state (stop state) at the position p15. This makes it possible to prevent the tractor 1 from jumping out to the out-of-field area A1.
- the tractor 1 approaches the out-of-field region A1 (the left end or the upper end of the field A) on the left forward route (route from position p11 to position p12) or upward / reverse route (position p14 to position p15).
- the distance Lp between the position p12 or the position p15 of the tractor 1 and the out-of-field region A1 is equal to or greater than the predetermined distance Lth (for example, in the case of the work path P12), the deceleration process is performed. Do not execute.
- the automatic traveling control unit 23F has a right reverse path (route from position p12 to position p13) or a left turn path (position from position p13) in which the tractor 1 does not approach the out-of-field region A1 (left end or upper end of field A).
- the automatic traveling control unit 23F changes the direction of the tractor 1 at a predetermined speed, and outputs a switching instruction for switching forward / backward at a predetermined position of the direction change path P2 to the tractor 1.
- the time required for changing the direction of the tractor 1 can be shortened.
- the tractor 1 travels to the left on the work path P1 and stops the work when it reaches the position p21, advances from the position 21 to the position 22, and moves forward and backward when it reaches the position 22. Is switched and turns 90 degrees backward from the position p22 to the right and moves backward to the position p23. When the tractor 1 reaches the position p23, it switches forward and backward and advances to the position p21. When the tractor 1 reaches the position p21, it advances the work path P1 and resumes the work.
- the automatic travel control unit 23F travels forward on the left forward route (the route from the position p21 to the position p22) in which the tractor 1 approaches the out-of-field region A1 (the left end of the field A).
- the position p22 (direction change position) for switching the front-rear direction of the tractor 1, and the out-of-field area A1 (left end of the field A) on the traveling direction side (left side) of the tractor 1 immediately before the tractor 1 reaches the position p22.
- the distance Lp between the two is less than the predetermined distance Lth, the deceleration process for decelerating the target speed of the tractor 1 toward the position p22 is executed.
- the automatic traveling control unit 23F executes the deceleration process so that the tractor 1 moving forward to the left is in the zero speed state (stop state) at the position p22. Further, the automatic traveling control unit 23F reverses the upper turning path (turning path from position p22 to position p23) in which the tractor 1 approaches the out-of-field region A1 (the upper end of the field A) in the front-rear direction of the tractor 1.
- the distance Lp between the position p23 (direction change position) at which the tractor 1 is switched and the out-of-field area A1 (upper end portion of the field A) on the traveling direction side (upper side) of the tractor 1 immediately before the tractor 1 reaches the position p23 is predetermined.
- a deceleration process for decelerating the target speed of the tractor 1 toward the position p23 is executed.
- the automatic traveling control unit 23F executes the deceleration process so that the upward turning tractor 1 is in the zero speed state (stop state) at the position p23. This makes it possible to prevent the tractor 1 from jumping out to the out-of-field area A1.
- the automatic traveling control unit 23F has a left forward path (route from position p21 to position p22) or an upper turn path (route from position p22 to position p23) in which the tractor 1 approaches the out-of-field region A1 (left end or upper end of field A).
- the distance Lp between the position p22 or the position p23 of the tractor 1 and the out-of-field region A1 is equal to or greater than the predetermined distance Lth (for example, in the case of the work path P12), the deceleration process is performed. Do not execute.
- the automatic traveling control unit 23F changes the direction of the tractor 1 at a predetermined speed, and outputs a switching instruction for switching forward / backward at a predetermined position of the direction change path P2 to the tractor 1.
- the time required for changing the direction of the tractor 1 can be shortened.
- the tractor 1 advances to the left forward path (the path from the position p21 to the position p22) on the work path P12 and jumps out to the left of the target position p22, it is possible to prevent the tractor 1 from entering the out-of-field area A1. can.
- the direction change path P2 of the tractor 1 is not particularly limited.
- the "traveling direction" in the "predetermined area on the traveling direction side of the working vehicle immediately before the working vehicle reaches the turning position" of the present invention is the forward direction when the working vehicle (tractor 1) advances.
- the reverse direction when the work vehicle moves backward, the forward direction when the work vehicle turns while moving forward (forward turn), and the reverse direction when the work vehicle turns while moving backward (reverse turn) are included.
- the "predetermined area” is an area to enter when the work vehicle travels (runs) in the traveling direction. In the fishtail-shaped turning path (see FIG.
- the second forward path P1c for extending the tractor 1 to the terminal position p4 and the tractor 1 extending from the terminal position p4 to the starting position p5 of the turning path are provided.
- the relay reverse path P3 to be reverse may be omitted. That is, the tractor 1 may advance the work path P1 to reach the start position position p5, and then turn around the start end side turning path P2a.
- the present invention can be applied to these fishtail-shaped turning paths, turning paths different from the fishtail, and the like.
- the automatic traveling control unit 23F executes the deceleration process when the tractor 1 enters the out-of-field region A1 when the tractor 1 is turned at the target speed in the direction change path R2. On the other hand, the automatic traveling control unit 23F does not execute the deceleration process if the tractor 1 does not enter the out-of-field region A1 even if the tractor 1 is turned at the target speed in the direction change path R2. Therefore, according to the automatic traveling system according to the present embodiment, it is possible to improve the work efficiency of the tractor 1 by appropriately changing the direction of the tractor 1.
- the automatic traveling control unit 23F outputs a switching instruction for switching the traveling direction to the tractor 1 when the tractor 1 reaches a predetermined position. Further, the automatic traveling control unit 23F outputs the switching instruction to the tractor 1 to stop the work on the tractor 1 and causes the tractor 1 to travel the braking distance to the target position.
- the braking distance is the traveling distance from the position of the tractor 1 when the work is stopped until the tractor 1 stops.
- the predetermined position may be a position where the stop position where the tractor 1 acquires the switching instruction and stops the work (braking operation) to bring the vehicle speed to the zero speed state matches the target position. It may be a position extended in the traveling direction side of the tractor 1 from the target position.
- a non-work area may occur at the end of the work area.
- the tractor 1 reaches the end of the work area so that the tractor 1 stops at the end position p4 when the vehicle speed reaches the zero speed state after acquiring the forward / backward switching instruction.
- the switching instruction is output before.
- the tractor 1 stops the work when the switching instruction is acquired, so that the area from the position of the tractor 1 at the time when the switching instruction is acquired to the end of the working area becomes an unworked area.
- the automatic traveling control unit 23F performs work while the tractor 1 travels forward in the work area, and when the tractor 1 changes direction in the non-work area, the tractor 1 travels forward in the work area.
- the switching instruction may not be output to the tractor 1 during the operation.
- the automatic traveling control unit 23F may output the switching instruction when the rotary tilling device 3 exceeds the working area, or the deceleration process when the rotary tilling device 3 exceeds the working area. May be executed.
- the automatic traveling control unit 23F may be configured not to output the switching instruction to the tractor 1 while the tractor 1 is traveling backward in the work area. In this case, the automatic traveling control unit 23F may output the switching instruction when the rotary tilling device 3 exceeds the working area, or the deceleration process when the rotary tilling device 3 exceeds the working area. May be executed.
- the non-work area can be reduced and the entire work area can be reliably worked. Further, when the vehicle speed of the tractor 1 is not decelerated in the work area, the work speed is improved, so that the work efficiency can be improved.
- the automatic traveling control unit 23F has a braking distance calculated based on the vehicle speed of the tractor 1 and a front obstacle while the tractor 1 is automatically traveling according to the second forward path (working path) P1c of the parallel path P1.
- a pop-out determination process for determining whether or not the tractor 1 may jump out to the out-of-field region A1 may be performed by comparing the linear distance from the tractor 1 to the field edge included in the detection information of the sensor 86. Then, when the automatic traveling control unit 23F determines in the pop-out determination process that the tractor 1 may jump out to the out-of-field area A1, the tractor 1 shifts in order to prevent the tractor 1 from jumping out to the out-of-field area A1.
- Deceleration processing of the tractor 1 is performed on the unit control unit 23B and the like. Further, when the automatic traveling control unit 23F determines that the tractor 1 may jump out to the out-of-field area A1 and determines that the tractor 1 cannot turn safely, an emergency stop process is performed. May be good.
- the automatic traveling control unit 23F sets the calculated braking distance from the straight line distance to prevent jumping out.
- Vehicle speed limiting control that limits the vehicle speed of the tractor 1 may be executed via the speed change unit control unit 23B so that the state of being shorter than the subtracted distance is maintained.
- the tractor 1 is used in the pop-out determination process while extending the second forward path (working path) P1c of the parallel path P1 in which the target vehicle speed is set to be higher than the direction change path P2 or the like toward the field end side. It is determined that there is a possibility that the tractor 1 may jump out to the out-of-field area A1, and it is possible to prevent a decrease in work efficiency due to an emergency stop of the tractor 1.
- the present invention is an invention of a method (automatic traveling method) for executing a part or all of the deceleration process by the vehicle-mounted control unit 23, or for causing the vehicle-mounted control unit 23 to execute a part or all of the method. It may be regarded as an invention of a program (automatic driving program). Further, the deceleration process may be executed by one or more processors.
- the automatic traveling method generates a target route P including a work path P1 for advancing the tractor 1 in the field A and a direction change path P2 for changing the direction of the tractor 1, and measures the position of the tractor 1. That is, the tractor 1 is automatically driven according to the target route P based on the position of the tractor 1, and when the tractor 1 changes direction on the direction change path R2, the direction change position for switching the front-rear direction of the tractor 1 is the tractor.
- the deceleration process for decelerating the target speed of the tractor 1 toward the turning position is executed. It is a method of executing this with one or more processors.
- the automatic traveling program generates a target route P including a work path P1 for advancing the tractor 1 in the field A and a direction change path P2 for changing the direction of the tractor 1, and measures the position of the tractor 1.
- the tractor 1 is automatically driven according to the target route P based on the position of the tractor 1, and when the tractor 1 changes direction on the direction change path P2, the direction change position for switching the front-rear direction of the tractor 1 is determined.
- a deceleration process for decelerating the target speed of the tractor 1 toward the turning position is executed. It is a program for causing one or more processors to execute.
- the automatic traveling program is non-temporarily recorded on a computer-readable recording medium such as a CD or DVD, and is read by a reading device (not shown) such as a CD drive or a DVD drive included in the tractor 1 and mounted on a vehicle. It is stored in the storage unit 23G.
- the automatic traveling program may be downloaded from the server (not shown) to the tractor 1 via the communication network N1 and stored in the vehicle-mounted storage unit 23G.
- the in-vehicle control unit 23 functions as the various processing units by executing various processing according to the automatic traveling program.
- the automatic traveling system may include a positioning unit, a target route generation unit, and a control unit.
- the positioning unit measures the position of a work vehicle provided with a work device at the rear which can be switched between a working state and a non-working state.
- the target route generation unit generates a target route that enables the automatic traveling of the work vehicle.
- the control unit automatically drives the work vehicle according to the target route based on the positioning information of the positioning unit.
- the target route includes a work path in which the work device advances the work vehicle switched to the work state, and a direction change path in which the work device turns the work vehicle switched to the non-work state. , Is included.
- the target route generation unit generates the target route by setting a route that connects a plurality of the work routes arranged in parallel at predetermined intervals in the order of travel of the work vehicle via the plurality of the direction change routes. .. Further, the target route generation unit extends the end side of the work path by a predetermined length, and generates the work path so that the end side enters the direction change path side with the predetermined length. In addition, a first reverse path for moving the work vehicle backward is generated from the end position of the extended work path to the start position of the direction change path. Further, the control unit switches the working device from the working state to the non-working state based on the switching from the working path of the path on which the working vehicle travels to the first reverse path.
- the predetermined length may be set to a length based on the separation distance from the traveling device provided in the work vehicle to the work device.
- the position of the work device when the work vehicle after the direction change reaches the start position of the work path becomes the end position of the work path after the work vehicle is extended.
- the start position of the work path may be set so as to match the position of the work device when it is reached.
- the target route generation unit has a non-working path extending from the end position of the turning path beyond the start position of the work path, and the target route generation unit from the rear end position of the non-work path to the start position of the work path.
- a second reverse path for moving the work vehicle backward may be generated.
- the target route generation unit is moved to a position in front of the terminal position in the work path by a braking distance corresponding to the target vehicle speed of the work vehicle in the work path, as the work vehicle arrives.
- a switching position may be set to switch the route on which the work vehicle travels from the work route to the first reverse route.
- the control unit may reduce the target vehicle speed as the work vehicle approaches the end position of the work path.
- the tractor 1 may be configured as a traveling device in a semi-crawler specification provided with left and right front wheels 10 and left and right crawlers in place of the left and right rear wheels 11.
- the tractor 1 may be configured as a traveling device with a full crawler specification in which left and right crawlers are provided instead of the left and right front wheels 10 and the left and right rear wheels 11.
- the tractor 1 may be configured as an electric specification in which an electric motor is provided instead of the engine as a driving unit.
- the tractor 1 may be configured as a hybrid specification in which an engine and an electric motor are provided as a driving unit.
- the predetermined length L4 extending each second forward path (work path) P1c may be set to the same length as the second separation distance L2.
- a switching position p10 for switching the path on which the tractor 1 travels from the second forward path P1c to the relay reverse path P3 may be set at a position in front of the braking distance La according to the above.
- the above-mentioned switching position p10 is set at a position just before the above-mentioned braking distance from the end position p4 of the second forward path P1c. Therefore, it is possible to prevent the tractor 1 from unnecessarily overrunning from the terminal position p4 of the second forward path P1c, and it is possible to avoid a decrease in work efficiency due to unnecessary overrunning. ..
- the first forward path P1a and the reverse path of each parallel path P1 related to the forward / backward switching of the tractor 1 may be applied to P1b, each relay reverse route P3, right forward route P2b of each direction change route P2, and left reverse route P2c.
- the automatic traveling control unit 23F has the second forward path P1c of the path on which the tractor 1 travels. Since the rotary tillage device 3 is switched from the working state to the non-working state based on the switching from the relay to the reverse reverse path P3, the faster the target vehicle speed in the second forward path P1c, the more the tractor 1 in the second forward path P1c. The distance to work in automatic driving is shortened.
- the automatic traveling control unit 23F targets the target in the work path. It is configured to perform the target vehicle speed reduction process to reduce the vehicle speed.
- the work area Aw when working in the automatic traveling of the tractor 1 can be expanded without causing a decrease in work efficiency due to overrun from the second forward path P1c of the tractor 1, and the work efficiency is improved. be able to.
- the automatic driving control unit 23F performs the target vehicle speed reduction process is exemplified, but instead of this. Based on the detection of the vehicle speed sensor 22E when the tractor 1 reaches the switching position p10, the automatic traveling control unit 23F determines the braking time required from when the tractor 1 reaches the switching position p10 to when the tractor 1 switches to the reverse state. Calculated, the traveling state of the tractor 1 is switched from the working traveling state to the non-working traveling state at the timing when the braking time elapses after the tractor 1 reaches the switching position p10 or at the timing shortly before the braking time elapses. It may be configured as follows.
- the tractor 1 can be maintained in the working running state until the braking time elapses or shortly before the braking time elapses. It is possible to improve work efficiency by expanding the work area Aw.
- the traveling state of the tractor 1 is based on the detection of the vehicle speed sensor 22E.
- the running state switching control for switching from the working running state to the non-working running state is started, and in this running state switching control, the tractor 1 is switched from the forward state to the reverse state based on the detection of the vehicle speed sensor 22E.
- the traveling state of the tractor 1 may be switched from the working traveling state to the non-working traveling state at the detected timing.
- the tractor 1 can be maintained in the working running state until the tractor 1 actually starts moving backward, and the work by expanding the work area Aw can be performed. Efficiency can be improved.
Landscapes
- Engineering & Computer Science (AREA)
- Life Sciences & Earth Sciences (AREA)
- Mechanical Engineering (AREA)
- Soil Sciences (AREA)
- Environmental Sciences (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Guiding Agricultural Machines (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
測位ユニット(42)は、トラクタ(1)の位置を測定する。自動走行制御部(23F)は、測位ユニット(42)の測位情報に基づいてトラクタ(1)を目標経路(P)に従って自動走行させる。自動走行制御部(23F)は、トラクタ(1)が方向転換経路(R2)で方向転換する場合において、トラクタ(1)の前後方向を切り替える終端位置(p8)が圃場(Aから所定距離(Lth)未満となる場合にトラクタ(1)の目標速度を終端位置(p8)に向かって減速させる減速処理を実行する。
Description
本発明は、作業車両の自動走行させることが可能な自動走行システム、自動走行方法、及び自動走行プログラムに関する。
自動走行システムにおいては、作業車両の後部に備えられた作業装置の作業幅を入力する工程、圃場内での作業領域を設定する工程、作業開始位置と作業停止位置とを設定する工程、基準走行開始方向を設定する工程、作業領域の両端に枕地を設定する工程、及び、圃場内での走行経路を設定する工程などが行われることで、作業車両の自動走行を可能にする目標経路を生成する目標経路生成部を備えたものがある(例えば特許文献1参照)。
前記自動走行システムでは、例えば作業車両を方向転換させるために前進から後進に切り替える場合に、前後進が切り替わる目標位置で一旦停止するように当該目標位置の手前で作業車両を減速走行させることがある。このような減速制御が行われると、方向転換に時間がかかり作業効率が低下する問題が生じる。一方で、前記減速制御を行わない場合には方向転換にかかる時間を短縮することはできるが、作業車両を目標位置で停止させることができず、例えば作業車両が圃場外に飛び出して自動走行が停止したりして、結果的に作業効率が低下する問題が生じる。
本発明の目的は、作業車両を適切に方向転換させることにより作業車両の作業効率を向上させることが可能な自動走行システム、自動走行方法、及び自動走行プログラムを提供することにある。
本発明に係る自動走行システムは、経路生成処理部と、測位処理部と、走行処理部とを備える。前記経路生成処理部は、圃場において作業車両を前進させる作業経路と、前記作業車両を方向転換させる方向転換経路とを含む目標経路を生成する。前記測位処理部は、前記作業車両の位置を測定する。前記走行処理部は、前記測位処理部の測位情報に基づいて前記作業車両を前記目標経路に従って自動走行させる。また、前記走行処理部は、前記作業車両が前記方向転換経路で方向転換する場合において、前記作業車両の前後方向を切り替える方向転換位置が、前記作業車両が前記方向転換位置に到達する直前の前記作業車両の進行方向側の前記所定領域から所定距離未満となる場合に、前記作業車両の目標速度を前記方向転換位置に向かって減速させる減速処理を実行する。
本発明に係る自動走行方法は、圃場において作業車両を前進させる作業経路と、前記作業車両を方向転換させる方向転換経路とを含む目標経路を生成することと、前記作業車両の位置を測定することと、前記作業車両の位置に基づいて前記作業車両を前記目標経路に従って自動走行させることと、前記作業車両が前記方向転換経路で方向転換する場合において、前記作業車両の前後方向を切り替える方向転換位置が、前記作業車両が前記方向転換位置に到達する直前の前記作業車両の進行方向側の前記所定領域から所定距離未満となる場合、に前記作業車両の目標速度を前記方向転換位置に向かって減速させる減速処理を実行することと、を一又は複数のプロセッサーにより実行する方法である。
本発明に係る自動走行プログラムは、圃場において作業車両を前進させる作業経路と、前記作業車両を方向転換させる方向転換経路とを含む目標経路を生成することと、前記作業車両の位置を測定することと、前記作業車両の位置に基づいて前記作業車両を前記目標経路に従って自動走行させることと、前記作業車両が前記方向転換経路で方向転換する場合において、前記作業車両の前後方向を切り替える方向転換位置が、前記作業車両が前記方向転換位置に到達する直前の前記作業車両の進行方向側の前記所定領域から所定距離未満となる場合に、前記作業車両の目標速度を前記方向転換位置に向かって減速させる減速処理を実行することと、を一又は複数のプロセッサーに実行させるためのプログラムである。
本発明によれば、作業車両を適切に方向転換させることにより作業車両の作業効率を向上させることが可能な自動走行システム、自動走行方法、及び自動走行プログラムを提供することができる。
以下、本発明を実施するための形態の一例として、本発明に係る作業車両用の自動走行システムを、作業車両の一例であるトラクタに適用した実施形態を図面に基づいて説明する。
尚、本発明に係る作業車両用の自動走行システムは、トラクタ以外に、例えば、乗用管理機、乗用草刈機、乗用田植機、及び、乗用播種機などの自動走行可能な乗用作業車両、並びに、無人耕耘機や無人草刈機などの無人作業車両に適用することができる。
図1に示すように、本実施形態に例示されたトラクタ1は、その後部に、リンク機構2を介して、作業装置の一例であるロータリ耕耘装置3が昇降可能かつローリング可能に連結されている。これにより、トラクタ1は、ロータリ耕耘仕様に構成されている。
尚、トラクタ1の後部には、ロータリ耕耘装置3に代えて、例えば、プラウ、ディスクハロー、カルチベータ、サブソイラ、播種装置、散布装置、草刈装置、及び、収穫装置などの作業装置を連結することができる。
トラクタ1は、作業車両用の自動走行システムを使用することにより、作業地の一例である圃場A(図5参照)などにおいて自動走行させることができる。図1、図3に示すように、作業車両用の自動走行システムには、トラクタ1に搭載された自動走行ユニット4、及び、自動走行ユニット4と無線通信可能に通信設定された無線通信機器の一例である携帯通信端末5などが含まれている。携帯通信端末5には、自動走行に関する各種の情報表示や入力操作などを可能にするマルチタッチ式の表示デバイス50などが備えられている。
尚、携帯通信端末5には、タブレット型のパーソナルコンピュータやスマートフォンなどを採用することができる。また、無線通信には、Wi-Fi(登録商標)などの無線LAN(Local Area Network)やBluetooth(登録商標)などの近距離無線通信などを採用することができる。
図1及び図2に示すように、トラクタ1には、走行装置として、駆動可能で操舵可能な左右の前輪10と、駆動可能な左右の後輪11とが備えられている。図1~図3に示すように、トラクタ1には、搭乗式の運転部12を形成するキャビン13、コモンレールシステムを有する電子制御式のディーゼルエンジン(以下、エンジンと称する)14、エンジン14などを覆うボンネット15、及び、エンジン14からの動力を変速する変速ユニット16などが備えられている。尚、エンジン14には、電子ガバナを有する電子制御式のガソリンエンジンなどを採用してもよい。
図3に示すように、トラクタ1には、左右の前輪10を操舵する全油圧式のパワーステアリングユニット17、左右の後輪11を制動するブレーキユニット18、ロータリ耕耘装置3への伝動を断続する電子油圧制御式の作業クラッチユニット19、ロータリ耕耘装置3を昇降駆動する電子油圧制御式の昇降駆動ユニット20、ロータリ耕耘装置3のロール方向への駆動を可能にする電子油圧制御式のローリングユニット21、トラクタ1における各種の設定状態や各部の動作状態などを検出する各種のセンサやスイッチなどを含む車両状態検出機器22、及び、各種の制御部を有する車載制御ユニット23などが備えられている。尚、パワーステアリングユニット17には、操舵用の電動モータを有する電動式を採用してもよい。
図1に示すように、運転部12には、手動操舵用のステアリングホイール25、搭乗者用の座席26、及び、各種の情報表示や入力操作などを可能にする操作端末27が備えられている。図示は省略するが、運転部12には、アクセルレバーや変速レバーなどの操作レバー類、及び、アクセルペダルやクラッチペダルなどの操作ペダル類などが備えられている。操作端末27には、マルチタッチ式の液晶モニタやISOBUS(イソバス)対応のバーチャルターミナルなどを採用することができる。
図2に示すように、変速ユニット16には、エンジン14からの動力を走行用に変速する走行伝動系16Aと作業用に変速する作業伝動系16Bとが備えられている。そして、走行伝動系16Aによる変速後の動力が、前輪駆動用の伝動軸28、及び、前車軸ケース29に内蔵された前輪用差動装置30などを介して左右の前輪10に伝えられる。また、作業伝動系16Bによる変速後の動力がロータリ耕耘装置3に伝えられる。変速ユニット16には、左右の後輪11を個別に制動する左右のブレーキ31が備えられている。
走行伝動系16Aには、エンジン14からの動力を変速する電子制御式の主変速装置32、主変速装置32からの動力を前進用と後進用とに切り換える電子油圧制御式の前後進切換装置33、前後進切換装置33からの前進用又は後進用の動力を高低2段に変速するギア式の副変速装置34、前後進切換装置33からの前進用又は後進用の動力を超低速段に変速するギア式のクリープ変速装置35、副変速装置34又はクリープ変速装置35からの動力を左右の後輪11に分配する後輪用差動装置36、後輪用差動装置36からの動力を減速して左右の後輪11に伝える左右の減速装置37、及び、副変速装置34又はクリープ変速装置35から左右の前輪10への伝動を切り換える電子油圧制御式の伝動切換装置38などが含まれている。
作業伝動系16Bには、エンジン14からの動力を断続する油圧式の作業クラッチ39、作業クラッチ39を経由した動力を正転3段と逆転1段とに切り換える作業用変速装置40、及び、作業用変速装置40からの動力を作業用として出力するPTO軸41などが含まれている。PTO軸41から取り出された動力は、外部伝動軸(図示せず)などを介してロータリ耕耘装置3に伝えられる。作業クラッチ39は、作業クラッチ39に対するオイルの流れを制御する電磁制御弁(図示せず)などとともに作業クラッチユニット19に含まれている。
主変速装置32には、静油圧式無段変速装置(HST:Hydro Static Transmission)よりも伝動効率が高い油圧機械式無段変速装置の一例であるI-HMT(Integrated Hydro-static Mechanical Transmission)が採用されている。
尚、主変速装置32には、I-HMTの代わりに、油圧機械式無段変速装置の一例であるHMT(Hydraulic Mechanical Transmission)、静油圧式無段変速装置、又は、ベルト式無段変速装置などの無段変速装置を採用してもよい。また、無段変速装置の代わりに、複数の油圧式の変速クラッチ、及び、それらに対するオイルの流れを制御する複数の電磁式の変速バルブなどを有する電子油圧制御式の有段変速装置を採用してもよい。
伝動切換装置38は、左右の前輪10への伝動状態を、左右の前輪10への伝動を遮断する伝動遮断状態と、左右の前輪10の周速が左右の後輪11の周速と同じになるように左右の前輪10に伝動する等速伝動状態と、左右の後輪11の周速に対して左右の前輪10の周速が約2倍になるように左右の前輪10に伝動する倍速伝動状態とに切り換える。これにより、このトラクタ1の駆動状態を、2輪駆動状態と4輪駆動状態と前輪倍速状態とに切り換えることができる。
図示は省略するが、ブレーキユニット18には、前述した左右のブレーキ31、運転部12に備えられた左右のブレーキペダルの踏み込み操作に連動して左右のブレーキ31を作動させるフットブレーキ系、運転部12に備えられたパーキングレバーの操作に連動して左右のブレーキ31を作動させるパーキングブレーキ系、及び、左右の前輪10の設定角度以上の操舵に連動して旋回内側のブレーキ31を作動させる旋回ブレーキ系などが含まれている。旋回ブレーキ系には、左右のブレーキ31を独立して作動させることが可能な電子油圧制御式のブレーキ操作装置18Aが含まれている。
車両状態検出機器22は、トラクタ1の各部に備えられた各種のセンサやスイッチなどの総称である。図4に示すように、車両状態検出機器22には、アクセルレバーの操作位置を検出するアクセルセンサ22A、変速レバーの操作位置を検出する変速センサ22B、前後進切り換え用のリバーサレバーの操作位置を検出するリバーサセンサ22C、エンジン14の出力回転数を検出する第1回転センサ22D、トラクタ1の車速を検出する車速センサ22E、前輪10の操舵角を検出する舵角センサ22F、ロータリ耕耘装置3の高さ位置を検出する高さセンサ22G、及び、PTO軸41の回転数をロータリ耕耘装置3の駆動回転数として検出する第2回転センサ22Hなどが含まれている。
図2に示すように、車速センサ22Eには、副変速装置34又はクリープ変速装置35から後輪用差動装置36に伝動する伝動軸49の回転数及び回転方向を検出する回転センサが採用されている。
図3及び図4に示すように、車載制御ユニット23には、エンジン14に関する制御を行うエンジン制御部23A、トラクタ1の車速や前後進の切り換えなどの変速ユニット16に関する制御を行う変速ユニット制御部23B、ステアリングに関する制御を行うステアリング制御部23C、ロータリ耕耘装置3などの作業装置に関する制御を行う作業装置制御部23D、操作端末27などに対する表示や報知に関する制御を行う表示制御部23E、自動走行に関する制御を行う自動走行制御部23F、及び、圃場Aに応じて生成された自動走行用の目標経路P(図5参照)などを記憶する不揮発性の車載記憶部23Gなどが含まれている。各制御部23A~23Fは、マイクロコントローラなどが集積された電子制御ユニットや各種の制御プログラムなどによって構築されている。各制御部23A~23Fは、CAN(Controller Area Network)を介して相互通信可能に接続されている。
尚、各制御部23A~23Fの相互通信には、CAN以外の通信規格や次世代通信規格である、例えば、車載EthernetやCAN-FD(CAN with FLexible Data rate)などを採用してもよい。
エンジン制御部23Aは、アクセルセンサからの検出情報と第1回転センサ22Dからの検出情報とに基づいて、エンジン回転数をアクセルレバーの操作位置に応じた回転数に維持するエンジン回転数維持制御などを実行する。
変速ユニット制御部23Bは、車速センサ22Eの検出情報に基づいて、トラクタ1の実車速を算出するとともにトラクタ1の進行方向を判定する。変速ユニット制御部23Bは、変速センサ22Bの検出情報と車速センサ22Eの検出情報などに基づいて、トラクタ1の車速が変速レバーの操作位置に応じた速度に変更されるように主変速装置32の作動を制御する車速制御、及び、リバーサセンサ22Cの検出情報に基づいて前後進切換装置33の伝動状態を切り換える前後進切り換え制御などを実行する。車速制御には、変速レバーが零速位置に操作された場合に、主変速装置32を零速状態まで減速制御してトラクタ1の走行を停止させる減速停止処理が含まれている。
変速ユニット制御部23Bは、トラクタ1における走行駆動モードの選択を可能にする第1選択スイッチ(図示せず)の操作に基づいて、トラクタ1の走行駆動モードを、二輪駆動モードと四輪駆動モードと前輪増速モードと旋回ブレーキモードと前輪増速旋回ブレーキモードとに切り換える。第1選択スイッチは、運転部12に備えられ、車両状態検出機器22に含まれている。
変速ユニット制御部23Bは、二輪駆動モードにおいては、伝動切換装置38を伝動遮断状態に切り換えることで、トラクタ1を、左右の前輪10への伝動を遮断して左右の後輪11のみを駆動させた二輪駆動状態で走行させる。
変速ユニット制御部23Bは、四輪駆動モードにおいては、伝動切換装置38を等速駆動状態に切り換えることで、トラクタ1を、左右の前輪10に伝動して左右の前輪10と左右の後輪11とを等速駆動させた四輪駆動状態で走行させる。
変速ユニット制御部23Bは、前輪増速モードにおいては、舵角センサ22Fの検出情報に基づいて、伝動切換装置38を等速伝動状態と倍速伝動状態とに切り換える前輪変速制御を実行する。前輪変速制御には、前輪10の操舵角が設定角度以上に達したときに、トラクタ1が旋回を開始したと判定して、伝動切換装置38を等速伝動状態から倍速伝動状態に切り換える前輪増速処理と、前輪10の操舵角が設定角度未満に至ったときに、トラクタ1が旋回を終了したと判定して、伝動切換装置38を倍速伝動状態から等速伝動状態に切り換える前輪減速処理とが含まれている。これにより、前輪増速モードにおいては、トラクタ1の旋回走行時にトラクタ1を前輪増速状態で走行させることができ、トラクタ1の旋回半径を小さくすることができる。
変速ユニット制御部23Bは、旋回ブレーキモードにおいては、舵角センサ22Fの検出情報に基づいて、ブレーキ操作装置18Aの作動を制御して左右のブレーキ31を制動解除状態と旋回内側制動状態とに切り換える旋回ブレーキ制御を実行する。旋回ブレーキ制御には、前輪10の操舵角が設定角度以上に達したときに、トラクタ1が旋回を開始したと判定するとともに、そのときの操舵角の増減方向から前輪10の操舵方向を判定して、旋回内側のブレーキ31を制動解除状態から制動状態に切り換える旋回内側制動処理と、前輪10の操舵角が設定角度未満に至ったときに、トラクタ1が旋回を終了したと判定して、制動状態(旋回内側)のブレーキ31を制動解除状態に切り換える制動解除処理とが含まれている。これにより、旋回ブレーキモードにおいては、トラクタ1の旋回走行時にトラクタ1を旋回内側制動状態で走行させることができ、トラクタ1の旋回半径を小さくすることができる。
変速ユニット制御部23Bは、前輪増速旋回ブレーキモードにおいては、舵角センサ22Fの検出情報に基づいて、前述した前輪変速制御と旋回ブレーキ制御とを実行する。これにより、前輪増速旋回ブレーキモードにおいては、トラクタ1の旋回走行時にトラクタ1を前輪増速旋回内側制動状態で走行させることができ、トラクタ1の旋回半径を更に小さくすることができる。
作業装置制御部23Dは、運転部12に備えられたPTOスイッチ22K(図4参照)の操作などに基づいて作業クラッチユニット19の作動を制御する作業クラッチ制御、運転部12に備えられた昇降スイッチ22L(図4参照)の操作や高さ設定ダイヤルの設定値などに基づいて昇降駆動ユニット20の作動を制御する昇降制御、及び、運転部12に備えられたロール角設定ダイヤルの設定値などに基づいてローリングユニット21の作動を制御するローリング制御などを実行する。PTOスイッチ22K、昇降スイッチ22L、高さ設定ダイヤル、及び、ロール角設定ダイヤルは、車両状態検出機器22に含まれている。
図3に示すように、トラクタ1には、トラクタ1の位置や方位などを測定する測位ユニット42が備えられている。測位ユニット42には、衛星測位システムの一例であるGNSS(Global Navigation Satellite System)を利用してトラクタ1の位置と方位とを測定する衛星航法装置43、及び、3軸のジャイロスコープ及び3方向の加速度センサなどを有してトラクタ1の姿勢や方位などを測定する慣性計測装置(IMU:Inertial Measurement Unit)44などが含まれている。GNSSを利用した測位方法には、DGNSS(Differential GNSS:相対測位方式)やRTK-GNSS(Real Time Kinematic GNSS:干渉測位方式)などがある。本実施形態においては、移動体の測位に適したRTK-GNSSが採用されている。そのため、図1に示すように、圃場周辺の既知位置には、RTK-GNSSによる測位を可能にする基地局6が設置されている。測位ユニット42は、本発明の測位処理部の一例である。
図1及び図3に示すように、トラクタ1と基地局6とのそれぞれには、測位衛星7(図1参照)から送信された電波を受信するGNSSアンテナ45,60、及び、トラクタ1と基地局6との間における測位情報を含む各情報の無線通信を可能にする通信モジュール46,61などが備えられている。これにより、測位ユニット42の衛星航法装置43は、トラクタ1のGNSSアンテナ45が測位衛星7からの電波を受信して得た測位情報と、基地局6のGNSSアンテナ60が測位衛星7からの電波を受信して得た測位情報とに基づいて、トラクタ1の位置及び方位を高い精度で測定することができる。また、測位ユニット42は、衛星航法装置43と慣性計測装置44とを有することにより、トラクタ1の位置、方位、姿勢角(ヨー角、ロール角、ピッチ角)を高精度に測定することができる。
このトラクタ1において、測位ユニット42の慣性計測装置44、GNSSアンテナ45、及び、通信モジュール46は、図1に示すアンテナユニット47に含まれている。アンテナユニット47は、キャビン13の前面側における上部の左右中央箇所に配置されている。
図示は省略するが、測位ユニット42にて測定されるトラクタ1の位置(測位基準位置)は、トラクタ1におけるGNSSアンテナ45の設置位置に設定されている。GNSSアンテナ45は、キャビン13における前面側の上部においてトラクタ1の左右中心上に設置されている。
尚、測位ユニット42にて測定されるトラクタ1の位置は、GNSSアンテナ45の設置位置に代えて、トラクタ1における後輪車軸中心位置に設定されていてもよい。この場合、トラクタ1の位置は、測位ユニット42の測位情報、及び、トラクタ1におけるGNSSアンテナ45の取り付け位置と後輪車軸中心位置との位置関係を含む車体情報から求めることができる。
図3に示すように、携帯通信端末5には、マイクロコントローラなどが集積された電子制御ユニットや各種の制御プログラムなどを有する端末制御ユニット51などが備えられている。端末制御ユニット51には、表示デバイス50などに対する表示や報知に関する制御を行う表示制御部51A、トラクタ1の自動走行を可能にする目標経路Pを生成する目標経路生成部51B、及び、目標経路生成部51Bが生成した目標経路Pなどを記憶する不揮発性の端末記憶部51Cなどが含まれている。端末記憶部51Cには、目標経路Pの生成に使用する各種の情報として、トラクタ1の旋回半径やロータリ耕耘装置3の作業幅などを含む車体情報、及び、圃場Aの位置や形状などを含む圃場情報などが記憶されている。
目標経路Pは、車体情報や圃場情報などに関連付けされた状態で端末記憶部51Cに記憶されており、携帯通信端末5の表示デバイス50にて表示することができる。目標経路Pには、トラクタ1の進行方向、目標車速、前輪操舵角、自動走行の開始位置pa、及び、自動走行の終了位置pbなどの自動走行に関する各種の情報が含まれている。
図3に示すように、トラクタ1及び携帯通信端末5には、車載制御ユニット23と端末制御ユニット51との間における測位情報などを含む各情報の無線通信を可能にする通信モジュール48,52が備えられている。トラクタ1の通信モジュール48は、携帯通信端末5との無線通信にWi-Fiが採用される場合には、通信情報をCANとWi-Fiとの双方向に変換する変換器として機能する。端末制御ユニット51は、車載制御ユニット23との無線通信にてトラクタ1の位置や方位などを含むトラクタ1に関する各種の情報を取得することができる。これにより、携帯通信端末5の表示デバイス50にて、目標経路Pに対するトラクタ1の位置や方位などを含む各種の情報を表示させることができる。
端末制御ユニット51は、車載制御ユニット23からの送信要求指令に応じて、端末記憶部51Cに記憶されている圃場情報や目標経路Pなどを車載制御ユニット23に送信する。車載制御ユニット23は、受信した圃場情報や目標経路Pなどを車載記憶部23Gに記憶する。目標経路Pの送信に関しては、例えば、端末制御ユニット51が、トラクタ1が自動走行を開始する前の段階において、目標経路Pの全てを端末記憶部51Cから車載制御ユニット23に一挙に送信するようにしてもよい。また、端末制御ユニット51が、目標経路Pを所定距離ごとの複数の分割経路情報に分割して、トラクタ1が自動走行を開始する前の段階からトラクタ1の走行距離が所定距離に達するごとに、トラクタ1の走行順位に応じた所定数の分割経路情報を端末記憶部51Cから車載制御ユニット23に逐次送信するようにしてもよい。
自動走行制御部23Fには、車両状態検出機器22に含まれた各種のセンサやスイッチなどからの検出情報が入力されている。これにより、自動走行制御部23Fは、トラクタ1における各種の設定状態や各部の動作状態などを監視することができる。
自動走行制御部23Fは、搭乗者や管理者などのユーザにより、トラクタ1の自動走行を可能にするための各種の手動設定操作が行われて、トラクタ1の走行モードが手動走行モードから自動走行モードに切り換えられた状態において、携帯通信端末5の表示デバイス50が操作されて自動走行の開始が指示された場合に、測位ユニット42にてトラクタ1の位置や方位などを取得しながら目標経路Pに従ってトラクタ1を自動走行させる自動走行制御を開始する。
自動走行制御部23Fは、自動走行制御の実行中に、例えば、ユーザにより携帯通信端末5の表示デバイス50が操作されて自動走行の終了が指示された場合や、運転部12に搭乗しているユーザにてステアリングホイール25やアクセルペダルなどの手動操作具が操作された場合は、自動走行制御を終了するとともに走行モードを自動走行モードから手動走行モードに切り換える。
自動走行制御部23Fによる自動走行制御には、エンジン14に関する自動走行用の制御指令をエンジン制御部23Aに送信するエンジン用自動制御処理、トラクタ1の車速や前後進の切り換えなどに関する自動走行用の制御指令を変速ユニット制御部23Bに送信する車速用自動制御処理、ステアリングに関する自動走行用の制御指令をステアリング制御部23Cに送信するステアリング用自動制御処理、及び、ロータリ耕耘装置3などの作業装置に関する自動走行用の制御指令を作業装置制御部23Dに送信する作業用自動制御処理などが含まれている。
自動走行制御部23Fは、エンジン用自動制御処理においては、目標経路Pに含まれた設定回転数などに基づいてエンジン回転数の変更を指示するエンジン回転数変更指令などをエンジン制御部23Aに送信する。エンジン制御部23Aは、自動走行制御部23Fから送信されたエンジン14に関する各種の制御指令に応じてエンジン回転数を自動で変更するエンジン回転数変更制御などを実行する。
自動走行制御部23Fは、車速用自動制御処理においては、目標経路Pに含まれた目標車速に基づいて主変速装置32の変速操作を指示する変速操作指令、及び、目標経路Pに含まれたトラクタ1の進行方向などに基づいて前後進切換装置の前後進切り換え操作を指示する前後進切り換え指令などを変速ユニット制御部23Bに送信する。変速ユニット制御部23Bは、自動走行制御部23Fから送信された主変速装置32や前後進切換装置などに関する各種の制御指令に応じて、主変速装置32の作動を自動で制御する自動車速制御、及び、前後進切換装置の作動を自動で制御する自動前後進切り換え制御などを実行する。自動車速制御には、例えば、目標経路Pに含まれた目標車速が零速である場合に、主変速装置32を零速状態まで減速制御してトラクタ1の走行を停止させる自動減速停止処理などが含まれている。
自動走行制御部23Fは、ステアリング用自動制御処理においては、目標経路Pに含まれた前輪操舵角などに基づいて左右の前輪10の操舵を指示する操舵指令などをステアリング制御部23Cに送信する。ステアリング制御部23Cは、自動走行制御部23Fから送信された操舵指令に応じて、パワーステアリングユニット17の作動を制御して左右の前輪10を操舵する自動ステアリング制御、及び、左右の前輪10が設定角度以上に操舵された場合に、ブレーキユニット18を作動させて旋回内側のブレーキを作動させる自動旋回ブレーキ制御などを実行する。
自動走行制御部23Fは、作業用自動制御処理においては、目標経路Pに含まれた各作業開始位置へのトラクタ1の到達に基づいてロータリ耕耘装置3の作業状態への切り換えを指示する作業開始指令、及び、目標経路Pに含まれた各作業停止位置へのトラクタ1の到達に基づいてロータリ耕耘装置3の非作業状態への切り換えを指示する作業終了指令などを作業装置制御部23Dに送信する。作業装置制御部23Dは、自動走行制御部23Fから送信されたロータリ耕耘装置3に関する各種の制御指令に応じて、作業クラッチユニット19及び昇降駆動ユニット20の作動を制御して、ロータリ耕耘装置3を駆動させて作業高さまで下降させる自動作業開始制御、及び、ロータリ耕耘装置3を非作業高さまで上昇させて駆動停止させる自動作業終了制御などを実行する。これにより、目標経路Pに従って自動走行するトラクタ1の走行状態を、ロータリ耕耘装置3の作業状態(ロータリ耕耘装置3が駆動されて作業高さまで下降した状態)でトラクタ1が自動走行する作業走行状態と、ロータリ耕耘装置3の非作業状態(ロータリ耕耘装置3が非作業高さまで上昇して駆動停止された状態)でトラクタ1が自動走行する非作業走行状態とに切り換えることができる。
つまり、前述した自動走行ユニット4には、パワーステアリングユニット17、ブレーキユニット18、作業クラッチユニット19、昇降駆動ユニット20、ローリングユニット21、車両状態検出機器22、車載制御ユニット23、測位ユニット42、及び、通信モジュール46,48などが含まれている。そして、これらが適正に作動することにより、トラクタ1を目標経路Pに従って精度良く自動走行させることができるとともに、ロータリ耕耘装置3による耕耘作業を適正に行うことができる。
図3及び図4に示すように、トラクタ1には、トラクタ1の周辺状況を取得する周辺状況取得システム8が備えられている。図4に示すように、周辺状況取得システム8には、トラクタ1の周囲を撮像して画像情報を取得する撮像ユニット80、及び、トラクタ1の周囲に存在する障害物を検出する障害物検出ユニット85が含まれている。障害物検出ユニット85が検出する障害物には、圃場Aにて作業する作業者などの人物や他の作業車両、及び、圃場Aに既存の電柱や樹木などが含まれている。
図1及び図4に示すように、撮像ユニット80には、キャビン13から前方の所定範囲が撮像範囲に設定された前カメラ81と、キャビン13から後方の所定範囲が撮像範囲に設定された後カメラ82と、前後の各カメラ81,82からの画像情報を処理する画像処理装置83(図4参照)とが含まれている。画像処理装置83は、マイクロコントローラなどが集積された電子制御ユニットや各種の制御プログラムなどによって構築されている。画像処理装置83は、車載制御ユニット23などにCANを介して相互通信可能に接続されている。
画像処理装置83は、前後の各カメラ81,82から順次送信される画像情報に対して、各カメラ81,82の撮像範囲に対応したトラクタ1の前側画像と後側画像とを生成する画像生成処理などを行う。そして、生成した各画像を、車載制御ユニット23の表示制御部23Eに送信する画像送信処理を行う。表示制御部23Eは、画像処理装置83からの各画像を、CANを介して操作端末27に送信するとともに、通信モジュール48,52を介して携帯通信端末5の表示制御部5Aに送信する。
これにより、画像処理装置83が生成したトラクタ1の前側画像と後側画像とを、トラクタ1の操作端末27や携帯通信端末5の表示デバイス50などにおいて表示することができる。そして、この表示により、ユーザは、トラクタ1の前方側と後方側の状況を容易に把握することができる。
図1及び図4に示すように、障害物検出ユニット85には、トラクタ1の前方側が障害物の検出範囲に設定された前障害物センサ86と、トラクタ1の後方側が障害物の検出範囲に設定された後障害物センサ87と、トラクタ1の左右両横側が障害物の検出範囲に設定された横障害物センサ88とが含まれている。前障害物センサ86及び後障害物センサ87には、障害物の検出にパルス状の近赤外レーザ光を使用するライダーセンサが採用されている。横障害物センサ88には、障害物の検出に超音波を使用するソナーが採用されている。
図4に示すように、前障害物センサ86及び後障害物センサ87は、近赤外レーザ光を使用して測定範囲に存在する各測距点(測定対象物)までの距離を測定する測定部86A,87A、及び、測定部86A,87Aの測定情報に基づいて距離画像の生成などを行う制御部86B,87Bを有している。横障害物センサ88は、超音波の送受信を行う右超音波センサ88Aと左超音波センサ88B、及び、各超音波センサ88A,88Bでの超音波の送受信に基づいて測定範囲に存在する測定対象物までの距離を測定する単一の制御部88Cを有している。
各障害物センサ86~88の制御部86B,87B,88Cは、マイクロコントローラなどが集積された電子制御ユニットや各種の制御プログラムなどによって構築されている。各制御部86B,87B,88Cは、車載制御ユニット23などにCANを介して相互通信可能に接続されている。
自動走行制御部23Fは、測位ユニット42の測位情報、及び、車載制御ユニット23に送信された各障害物センサ86~88の検出情報などに基づいて、トラクタ1の走行を制御して障害物との衝突を回避する衝突回避制御を実行する。自動走行制御部23Fは、衝突回避制御においては、各障害物センサ86~88の検出情報などに応じた各衝突回避用の走行制御の実行を変速ユニット制御部23Bに指示することで、トラクタ1の走行を制御して障害物との衝突を回避する。自動走行制御部23Fは、本発明の走行処理部の一例である。
目標経路生成部51Bは、トラクタ1の旋回半径やロータリ耕耘装置3の作業幅などを含む車体情報、トラクタ1を使用して作業する圃場Aの位置や形状などを含む圃場情報、及び、ユーザにて設定される各種の任意設定情報などに基づいて目標経路Pを生成する目標経路生成制御を実行する。目標経路生成部51Bは、本発明の経路生成処理部の一例である。
車体情報には、測位ユニット42にて測定されるトラクタ1におけるGNSSアンテナ45の設置位置からロータリ耕耘装置3までの第1離隔距離L1(図5~8参照)、及び、トラクタ1の後輪11からロータリ耕耘装置3までの第2離隔距離L2(図5~8参照)などが含まれている。
尚、本実施形態において、図1に示すように、第1離隔距離L1は、トラクタ1におけるGNSSアンテナ45の設置位置からロータリ耕耘装置3における耕耘爪3Aの回転中心位置X1までの距離に設定されている。また、第2離隔距離L2は、トラクタ1における後輪11の車軸中心X2から耕耘爪3Aの回転中心位置X1までの距離に設定されている。
圃場情報には、圃場Aの形状や大きさなどを特定する上において、トラクタ1を圃場Aの外周縁に沿って走行させたときにGNSSを利用して取得した圃場Aにおける複数の形状特定地点(形状特定座標)Cp1~Cp4(図5参照)、及び、それらの形状特定地点を繋いで圃場Aの形状や大きさなどを特定する形状特定線SL(図5参照)などが含まれている。
尚、本実施形態においては、図5に示すように、圃場Aとして矩形状の圃場Aを例示することから、複数の形状特定地点として4つの角部地点Cp1~Cp4が取得され、かつ、それらの角部地点Cp1~Cp4を繋ぐ矩形状の形状特定線SLが生成されている。
以下、図5~図15に示す目標経路P、及び、図16~図18に示すフローチャートに基づいて、目標経路生成制御における目標経路生成部51Bの制御作動について説明する。
尚、この目標経路生成制御においては、各種の任意設定情報として、例えば、自動走行の開始位置paや終了位置pb、及び、トラクタ1の作業走行方向などがユーザにて既に手動入力されていることを前提として説明する。
図16のフローチャートに示すように、目標経路生成部51Bは、例えば、図5に示す矩形状の圃場Aにおいて、自動走行の開始位置paと終了位置pbとが図5に示す位置に設定され、トラクタ1の作業走行方向が圃場Aの短辺に沿う方向に設定されている場合は、先ず、圃場Aを、前述した4つの角部地点Cp1~Cp4と矩形状の形状特定線SLとに基づいて、圃場Aの外周縁に隣接するマージン領域A1と、マージン領域A1の内側に位置する作業可能領域A2とに区分けする第1区分け処理を行う(ステップ#1)。
尚、マージン領域A1は、トラクタ1が作業可能領域A2の端部を自動走行するときに、ロータリ耕耘装置3などが圃場Aに隣接する畦や柵などの他物に接触するのを防止するために、圃場Aの外周縁と作業可能領域A2との間に確保された領域である。
目標経路生成部51Bは、トラクタ1の旋回半径やロータリ耕耘装置3の作業幅などに基づいて、作業可能領域A2を、作業可能領域A2における各長辺側の端部に設定される一対の方向転換領域A2aと、一対の方向転換領域A2aの間に設定される往復走行領域A2bとに区分けする第2区分け処理を行う(ステップ#2)。
尚、図5~図15には、方向転換領域A2aと往復走行領域A2bとを把握し易くするために、方向転換領域A2aと往復走行領域A2bとの境界を示す境界線BLが記載されている。
目標経路生成部51Bは、往復走行領域A2bに、圃場Aの長辺に沿う方向に作業幅に応じた所定間隔を置いて並列に配置される複数の並列経路P1を生成する並列経路生成処理を行う(ステップ#3)。
目標経路生成部51Bは、各方向転換領域A2aに、ロータリ耕耘装置3が作業状態に切り換えられたトラクタ1を方向転換させる複数の方向転換経路P2を生成する方向転換経路生成処理を行う(ステップ#4)。
尚、前述した各種の任意設定情報には、方向転換経路P2の種類が含まれており、本実施形態においては、図5~図15に示すように、方向転換経路P2として、スイッチバックを利用してトラクタ1をフィッシュテール状に方向転換走行させるスイッチバック式旋回経路が選択された場合を例示している。
ちなみに、方向転換経路P2としては、スイッチバック式旋回経路以外に、トラクタ1をU字状に方向転換走行させるU字旋回経路などを選択することができる。
並列経路生成処理においては、図17のフローチャートに示すように、目標経路生成部51Bは、各並列経路P1の始端位置p1から並列経路P1でのトラクタ1の前進方向に第1所定距離L3を隔てた第1中継位置p2にわたる第1前進経路P1aを生成する第1経路生成処理を行う(ステップ#31)。
目標経路生成部51Bは、第1中継位置p2から並列経路P1でのトラクタ1の後進方向に所定長さL4を隔てた第2中継位置p3にわたる後進経路P1bを生成する第2経路生成処理を行う(ステップ#32)。
目標経路生成部51Bは、第2中継位置p3から並列経路P1の終端位置p4にわたる第2前進経路P1cを生成する第3経路生成処理を行う(ステップ#33)。目標経路生成部51Bは、この第3経路生成処理においては、第2前進経路P1cの始端側を、第1中継位置p2から第2中継位置p3にわたる所定長さL4で延長し、かつ、第2前進経路P1cの終端側を、方向転換領域A2aと往復走行領域A2bとの境界から所定長さL4で延長して、第2前進経路P1cの全長を、第2中継位置p3から、方向転換領域A2aと往復走行領域A2bとの境界を越えて、第2前進経路P1cの終端側が所定長さL4で方向転換領域A2aに入り込む第2所定距離L5を有する長さに設定する。
目標経路生成部51Bは、第1中継位置p2を、この第1中継位置p2へのトラクタ1の到達に伴って、トラクタ1が走行する経路を第1前進経路P1aから後進経路P1bに切り換える第1切り換え位置に設定する第1切り換え位置設定処理を行う(ステップ#34)。
目標経路生成部51Bは、第2中継位置p3を、この第2中継位置p3へのトラクタ1の到達に伴って、トラクタ1が走行する経路を後進経路P1bから第2前進経路P1cに切り換える第2切り換え位置に設定する第2切り換え位置設定処理を行う(ステップ#35)。
方向転換経路生成処理においては、図18のフローチャートに示すように、目標経路生成部51Bは、各方向転換経路P2の始端位置p5からトラクタ1を右方向に前進で90度旋回させる始端側旋回経路P2aを生成する第4経路生成処理を行う(ステップ#41)。
目標経路生成部51Bは、始端側旋回経路P2aの終端位置p6からトラクタ1を右方向に前進させる右前進経路P2bを生成する第5経路生成処理を行う(ステップ#42)。
目標経路生成部51Bは、右前進経路P2bの終端位置p7からトラクタ1を左方向に後進させる左後進経路P2cを生成する第6経路生成処理を行う(ステップ#43)。
目標経路生成部51Bは、左後進経路P2cの終端位置p8からトラクタ1を右方向に前進で90度旋回させる終端側旋回経路P2dを生成する第7経路生成処理を行う(ステップ#44)。
目標経路生成部51Bは、始端側旋回経路P2aの終端位置p6を、この終端位置p6へのトラクタ1の到達に伴って、トラクタ1が走行する経路を始端側旋回経路P2aから右前進経路P2bに切り換える第3切り換え位置に設定する第3切り換え位置設定処理を行う(ステップ#45)。
目標経路生成部51Bは、右前進経路P2bの終端位置p7を、この終端位置p7へのトラクタ1の到達に伴って、トラクタ1が走行する経路を右前進経路P2bから左後進経路P2cに切り換える第4切り換え位置に設定する第4切り換え位置設定処理を行う(ステップ#46)。
目標経路生成部51Bは、左後進経路P2cの終端位置p8を、この終端位置p8へのトラクタ1の到達に伴って、トラクタ1が走行する経路を左後進経路P2cから終端側旋回経路P2dに切り換える第5切り換え位置に設定する第5切り換え位置設定処理を行う(ステップ#47)。
目標経路生成部51Bは、終端側旋回経路P2dの終端位置p9を、この終端位置p9へのトラクタ1の到達に伴って、トラクタ1が走行する経路を終端側旋回経路P2dから並列経路P1の第1前進経路P1aに切り換える第6切り換え位置に設定する第6切り換え位置設定処理を行う(ステップ#48)。
目標経路生成部51Bは、図16のフローチャートに示すように、並列経路生成処理と方向転換経路生成処理とを行った後、並列経路P1の終端位置p4から方向転換経路P2の始端位置p5にわたってトラクタ1を後進させる中継後進経路P3を生成する後進経路生成処理を行う(ステップ#5)。
このようにして、目標経路生成部51Bは、圃場Aにおいてトラクタ1が自動走行で耕耘作業を行うのに適した目標経路Pを生成する。
自動走行制御部23Fは、トラクタ1が自動走行の開始位置paとなる目標経路Pの始端位置(並列経路P1の始端位置p1)に、目標経路Pに従った自動走行が可能の適正姿勢で位置する状態において、自動走行の開始が指示された場合に、先ず、トラクタ1を、ロータリ耕耘装置3が非作業状態に切り換えられた非作業走行状態で、並列経路P1の第1前進経路P1aに従って前進させる(図12及び図13参照)。
自動走行制御部23Fは、トラクタ1が第1前進経路P1aの終端位置である第1中継位置p2に到達すると、この到達に伴って走行経路が第1前進経路P1aから後進経路P1bに切り換えられるのに基づいて、変速ユニット制御部23Bを介してトラクタ1を前進状態から後進状態に切り換える。これにより、トラクタ1を、非作業走行状態で後進経路P1bに従って後進させる(図13及び図14参照)。
自動走行制御部23Fは、トラクタ1が後進経路P1bの終端位置である第2中継位置p3に到達すると、この到達に伴って走行経路が後進経路P1bから第2前進経路P1cに切り換えられるのに基づいて、変速ユニット制御部23Bを介してトラクタ1を後進状態から前進状態に切り換えるとともに、ロータリ耕耘装置3を非作業状態から作業状態に切り換える。これにより、トラクタ1を、ロータリ耕耘装置3が作業状態に切り換えられた作業走行状態で、第2前進経路P1cに従って前進させる(図14、図15、及び図6参照)。
自動走行制御部23Fは、トラクタ1が第2前進経路P1cの終端位置である並列経路P1の終端位置p4に到達すると、この到達に伴って走行経路が第2前進経路P1cから中継後進経路P3に切り換えられるのに基づいて、変速ユニット制御部23Bを介してトラクタ1を前進状態から後進状態に切り換えるとともに、ロータリ耕耘装置3を作業状態から非作業状態に切り換える。これにより、トラクタ1を、非作業走行状態で中継後進経路P3に従って後進させる(図7及び図8参照)。
自動走行制御部23Fは、トラクタ1が中継後進経路P3の終端位置である方向転換経路P2の始端位置p5に到達すると、この到達に伴って走行経路が中継後進経路P3から方向転換経路P2の始端側旋回経路P2aに切り換えられるのに基づいて、変速ユニット制御部23Bを介してトラクタ1を後進状態から前進状態に切り換える。これにより、トラクタ1を、非作業走行状態で始端側旋回経路P2aに従って前進させる(図8及び図9参照)。
自動走行制御部23Fは、トラクタ1が始端側旋回経路P2aの終端位置p6に到達すると、この到達に伴って走行経路が始端側旋回経路P2aから右前進経路P2bに切り換えられるのに基づいて、トラクタ1を、非作業走行状態で右前進経路P2bに従って前進させる(図9及び図10参照)。
自動走行制御部23Fは、トラクタ1が右前進経路P2bの終端位置p7に到達すると、この到達に伴って走行経路が右前進経路P2bから左後進経路P2cに切り換えられるのに基づいて、変速ユニット制御部23Bを介してトラクタ1を前進状態から後進状態に切り換える。これにより、トラクタ1を、非作業走行状態で左後進経路P2cに従って後進させる(図10及び図11参照)。
自動走行制御部23Fは、トラクタ1が左後進経路P2cの終端位置p8に到達すると、この到達に伴って走行経路が左後進経路P2cから終端側旋回経路P2dに切り換えられるのに基づいて、変速ユニット制御部23Bを介してトラクタ1を後進状態から前進状態に切り換える。これにより、トラクタ1を、非作業走行状態で終端側旋回経路P2dに従って前進させる(図11及び図12参照)。
自動走行制御部23Fは、トラクタ1が終端側旋回経路P2dの終端位置p9に到達すると、この到達に伴って走行経路が終端側旋回経路P2dから並列経路P1の第1前進経路P1aに切り換えられるのに基づいて、トラクタ1を、非作業走行状態で第1前進経路P1aに従って前進させる(図12及び図13参照)。
つまり、この目標経路Pにおいては、各並列経路P1の第2前進経路P1cが、ロータリ耕耘装置3が作業状態に切り換えられたトラクタ1を前進させる作業経路として機能する。そして、目標経路Pは、作業幅に応じた所定間隔を置いて並列に配置される複数の並列経路P1の第2前進経路(作業経路)P1cを、複数の中継後進経路P3と、複数の方向転換経路P2と、複数の並列経路P1における第1前進経路P1a及び後進経路P1bとを介してトラクタ1の走行順に接続する経路設定で生成されている。
また、この目標経路Pにおいて、第2前進経路P1cは、その終端側が所定長さL4で延長されて、その所定長さL4で方向転換経路P2側に入り込む長さに生成されている。そして、延長された第2前進経路P1cの終端位置p4から方向転換経路の始端位置p5にわたってトラクタ1を後進させる中継後進経路P3が生成されている。
これにより、この目標経路Pに従ってトラクタ1を自動走行させると、トラクタ1が方向転換経路P2の始端位置p5を超えて延長後の第2前進経路P1cの終端位置p4に到達するまでの間は、ロータリ耕耘装置3を作業状態に維持することができる。これにより、第2前進経路P1cの終端位置p4を方向転換経路P2の始端位置p5とする場合に比較して、トラクタ1が第2前進経路P1cの終端位置p4に到達したときのロータリ耕耘装置3の接地位置である作業終端位置pdを、方向転換経路P2の始端位置p5に近づけることができる。
その結果、各第2前進経路P1cにおいて、トラクタ1による作業終端位置pdと方向転換経路P2の始端位置p5との間に存在する未作業経路を、第2前進経路P1cを延長する所定長さL4の分だけ短くすることができる。これにより、トラクタ1の自動走行で作業する作業領域を広くすることができ、トラクタ1の自動走行で作業する場合の作業効率を向上させることができる。
ちなみに、図5~図15においては、トラクタ1が方向転換経路P2の始端位置p5に到達したときのロータリ耕耘装置3の位置が符号pxで示されており、トラクタ1が第2前進経路P1cの終端位置p4に到達して作業走行を終了するときのロータリ耕耘装置3の接地位置pdが、トラクタ1が方向転換経路P2の始端位置p5に到達したときのロータリ耕耘装置3の位置pxよりも、方向転換経路P2の始端位置p5に近くなることが示されている。
そして、トラクタ1が第2前進経路P1cの終端位置p4に到達してから方向転換経路P2に従って方向転換するまでの間においては、トラクタ1が、中継後進経路P3に従って、非作業走行状態で第2前進経路P1cの終端位置p4から方向転換経路P2の始端位置p5にわたって後進することから、トラクタ1を方向転換させる方向転換領域の位置及び広さを、第2前進経路P1cの終端側を延長する前と同じにしながら、トラクタ1を方向転換経路P2に従って次の並列経路P1の始端位置p1に向けて適正に方向転換させることができる。
従って、トラクタ1を方向転換させる方向転換領域A2aの位置及び広さを変更することなく、前述した未作業経路を短くすることができ、トラクタ1の自動走行で作業する場合の作業効率を向上させることができる。
この目標経路Pにおいては、第2前進経路P1cの終端側を延長する所定長さL4が、トラクタ1の後輪11からロータリ耕耘装置3までの第2離隔距離L2に基づく長さに設定されている。具体的には、所定長さL4は、トラクタ1における後輪11の車軸中心X2からロータリ耕耘装置3における耕耘爪3Aの回転中心位置X1までの第2離隔距離L2よりも短い長さに設定されている。
これにより、トラクタ1が、中継後進経路P3に従って、非作業走行状態で第2前進経路P1cの終端位置p4から方向転換経路P2の始端位置p5にわたって後進するときに、トラクタ1の後輪11がロータリ耕耘装置3による既作業領域に踏み入る虞を回避することができる。
従って、トラクタ1の後輪11が既作業領域に踏み入る虞を回避しながら、前述した未作業経路を短くすることができ、トラクタ1の自動走行で作業する場合の作業効率を向上させることができる。
この目標経路Pにおいては、方向転換後のトラクタ1が第2前進経路P1cの始端位置である第2中継位置p3に到達したときのロータリ耕耘装置3の接地位置である作業始端位置pcが、トラクタ1が延長後の第2前進経路P1cの終端位置p4に到達したときのロータリ耕耘装置3の接地位置である作業終端位置pdと一致するように、第2前進経路P1cの始端位置(第2中継位置p3)が、各並列経路P1の始端位置p1から第1所定距離L3を隔てた第1中継位置p2よりも所定長さL4だけ並列経路P1の始端位置p1に近づけた位置に設定されている。
これにより、トラクタ1が第2前進経路P1cの始端位置p3に到達して作業走行を開始するときのロータリ耕耘装置3の接地位置(作業始端位置)pcを、トラクタ1が第2前進経路P1cの終端位置p6に到達して作業走行を終了するときのロータリ耕耘装置3の接地位置(作業終端位置)pdに揃えることができる。
また、第2前進経路P1cの終端側と同様に、トラクタ1が第2前進経路P1cの始端位置p3に到達したときのロータリ耕耘装置3の接地位置(作業始端位置)pcを、方向転換経路P2の終端位置p9に近づけることができる。
従って、各方向転換経路P2の終端位置p9とトラクタ1による作業始端位置pcとの間に存在する未作業経路を短くすることができ、トラクタ1の自動走行で作業する場合の作業効率を向上させることができる上に、トラクタ1の自動走行で作業を行う場合の作業精度を向上させることができる。
この目標経路Pには、方向転換経路P2の終端位置p9から第2前進経路P1cの始端位置p3を越えて延びる第1前進経路P1aと、第1前進経路P1aの終端位置である第1中継位置p2から第2前進経路P1cの始端位置p3にわたってトラクタ1を後進させる後進経路P1bとが含まれている。
これにより、トラクタ1が方向転換経路P2の終端位置p9から第2前進経路P1cの始端位置p3に移動するときに、トラクタ1の位置や方位が第2前進経路P1cに対して許容範囲を超えて外れる場合には、第1前進経路P1aでのトラクタ1の前進と後進経路P1bでのトラクタ1の後進とで、第2前進経路P1cの始端位置p3に対するトラクタ1の位置や方位を許容範囲内に軌道修正することができる。
従って、トラクタ1が第2前進経路P1cの始端位置p3に到達して作業走行を開始するときの第2前進経路P1cに対するトラクタ1の位置や方位を適正にすることができ、トラクタ1の自動走行で作業を行う場合の作業精度を向上させることができる。
前述した各種の任意設定情報には、前述した第1選択スイッチの操作で選択されたトラクタ1の走行駆動モードが含まれている。そのため、目標経路生成部51Bは、前述した方向転換経路生成処理においては、任意設定されたトラクタ1の走行駆動モードに応じて、始端側旋回経路P2a及び終端側旋回経路P2dの旋回半径を決定する。自動走行制御部23Fは、トラクタ1の走行駆動モードとして、前輪増速モードと旋回ブレーキモードと前輪増速旋回ブレーキモードのうちのいずれかが任意設定されている場合は、トラクタ1が中継後進経路P3の終端位置である方向転換経路P2の始端位置p5に到達すると、トラクタ1の走行駆動モードを任意設定された走行駆動モードに切り換える。自動走行制御部23Fは、トラクタ1が始端側旋回経路P2aの終端位置p6に到達すると、トラクタ1の走行駆動モードを、任意設定された走行駆動モードに切り換えられる前の元の走行駆動モードに復帰させる。自動走行制御部23Fは、トラクタ1が終端側旋回経路P2dの始端位置である左後進経路P2cの終端位置p8に到達すると、トラクタ1の走行駆動モードを任意設定された走行駆動モードに切り換える。自動走行制御部23Fは、トラクタ1が終端側旋回経路P2dの終端位置p9に到達すると、トラクタ1の走行駆動モードを、任意設定された走行駆動モードに切り換えられる前の元の走行駆動モードに復帰させる。
これにより、ユーザは、目標経路Pを生成する場合に、トラクタ1の走行駆動モードとして、前輪増速モードと旋回ブレーキモードと前輪増速旋回ブレーキモードのうちのいずれかを任意設定すれば、任意設定されたトラクタ1の走行駆動モードを含む各種の任意設定情報に基づいて目標経路生成部51Bが目標経路Pを生成することから、この目標経路Pの始端側旋回経路P2a又は終端側旋回経路P2dに従ってトラクタ1が旋回走行する場合には、任意設定されたトラクタ1の走行駆動モードに応じて、トラクタ1を前輪増速状態と旋回内側制動状態と前輪増速旋回内側制動状態のいずれかで走行させることができ、トラクタ1の旋回半径を小さくすることができる。
つまり、目標経路Pを生成する場合に、トラクタ1の走行駆動モードとして、前輪増速モードと旋回ブレーキモードと前輪増速旋回ブレーキモードのうちのいずれかが任意設定されていれば、目標経路生成部51Bは、前述した第2区分け処理においては、方向転換経路P2が生成される一対の方向転換領域A2aを狭くして、並列経路P1が生成される往復走行領域A2bを広くすることができる。そして、これに応じて、作業領域Awを広くすることができ、トラクタ1の自動走行で作業する場合の作業効率を向上させることができる。
尚、トラクタ1の走行駆動モードは、上記のようにユーザが任意設定するのではなく、目標経路生成部51Bが、作業領域Awを広くして作業効率の向上を図るのに最適な走行駆動モードを自動設定するように構成されていてもよい。
尚、図5に示す目標経路Pはあくまでも一例であり、目標経路生成部51Bは、トラクタ1の機種や作業装置の種類などに応じて異なる車体情報、及び、圃場Aに応じて異なる圃場Aの形状や大きさなどの圃場情報などに基づいて、それらに適した種々の目標経路Pを生成することができる。
[車速制御処理]
ところで、従来の自動走行システムでは、例えば作業車両(トラクタ1)を方向転換させるために前進から後進に切り替える場合に、前後進が切り替わる目標位置で一旦停止するように当該目標位置の手前で作業車両を減速走行させることがある。このような減速制御が行われると、方向転換に時間がかかり作業効率が低下する問題が生じる。一方で、前記減速制御を行わない場合には方向転換にかかる時間を短縮することはできるが、作業車両を目標位置で停止させることができず、例えば作業車両が圃場外(圃場外領域A1)に飛び出して自動走行が停止したりして、結果的に作業効率が低下する問題が生じる。これに対して、本発明に係る自動走行システムは、以下の構成を備えることによって、作業車両を適切に方向転換させることにより作業車両の作業効率を向上させることが可能である。
ところで、従来の自動走行システムでは、例えば作業車両(トラクタ1)を方向転換させるために前進から後進に切り替える場合に、前後進が切り替わる目標位置で一旦停止するように当該目標位置の手前で作業車両を減速走行させることがある。このような減速制御が行われると、方向転換に時間がかかり作業効率が低下する問題が生じる。一方で、前記減速制御を行わない場合には方向転換にかかる時間を短縮することはできるが、作業車両を目標位置で停止させることができず、例えば作業車両が圃場外(圃場外領域A1)に飛び出して自動走行が停止したりして、結果的に作業効率が低下する問題が生じる。これに対して、本発明に係る自動走行システムは、以下の構成を備えることによって、作業車両を適切に方向転換させることにより作業車両の作業効率を向上させることが可能である。
目標経路生成部51Bは、圃場Aにおいてトラクタ1を前進させる作業経路P1と、トラクタ1を方向転換させる方向転換経路P2とを含む目標経路Pを生成する。目標経路生成部51Bは、本発明の経路生成処理部の一例である。例えば図19Aに示すように、目標経路Pは、並列する複数の作業経路P1と、トラクタ1が一つの作業経路P1から隣り合う作業経路P1に方向転換するための方向転換経路P2とを含む。方向転換経路P2は、方向転換経路P2の始端位置p5から終端位置p6を結ぶ始端側旋回経路P2aと、終端位置p6から終端位置p7を結ぶ右前進経路P2bと、終端位置p7から終端位置p8を結ぶ左後進経路P2cと、終端位置p8から作業経路P1の始端位置p1を結ぶ終端側旋回経路P2dとを含む。
自動走行制御部23Fは、測位ユニット42の測位情報に基づいてトラクタ1を目標経路Pに従って自動走行させる。また、自動走行制御部23Fは、トラクタ1が方向転換経路P2で方向転換する場合において、トラクタ1の前後方向を切り替える方向転換位置が、トラクタ1が前記方向転換位置に到達する直前のトラクタ1の進行方向側の前記所定領域から所定距離未満となる場合に、トラクタ1の目標速度を前記方向転換位置に向かって減速させる減速処理を実行する。前記方向転換位置は、トラクタ1の進行する前後方向を切り替える位置であり、例えば前進から後進に切り替える位置、又は、後進から前進に切り替える位置である。
一方、自動走行制御部23Fは、トラクタ1の前記方向転換位置が、トラクタ1が前記方向転換位置に到達する直前のトラクタ1の進行方向側の前記所定領域から前記所定距離以上となる場合には前記減速処理を実行しない。自動走行制御部23Fは、本発明の走行処理部の一例である。
ここで、本発明の前記所定領域は、例えば圃場Aの外の領域(圃場外領域A1)である。なお、前記所定領域は、圃場外領域A1に限定されず、例えばトラクタ1の重複走行を禁止する作業済領域であってもよいし、障害物、入口用スロープなどが存在する障害物領域などであってもよい。自動走行制御部23Fは、トラクタ1が方向転換する際に前記所定領域に進入しないように減速制御を実行する。
例えばトラクタ1は、方向転換経路P2の始端位置p5から右方向に前進で90度旋回して終端位置p6まで始端側旋回経路P2aを前進し、終端位置p6に到達すると終端位置p7まで右方向に右前進経路P2bを前進する(図19A参照)。トラクタ1は、終端位置p7に到達すると、終端位置p8まで左方向に左後進経路P2cを後進する(図19B参照)。トラクタ1は、終端位置p8に到達すると、右方向に前進で90度旋回して、作業経路P1の始端位置p1まで終端側旋回経路P2dを前進する(図19C参照)。なお、図19A~図19Cには、圃場Aの左側の作業経路P1及び方向転換経路P2を例示し、図20A~図20Cには、圃場Aの右側の作業経路P1及び方向転換経路P2を例示している。
図19A~図19Cに示す方向転換経路P2では、自動走行制御部23Fは、トラクタ1が圃場外領域A1(圃場Aの左端部)に近づく左後進経路P2cを後進走行する場合において、トラクタ1の前後方向を切り替える終端位置p8(方向転換位置)と、トラクタ1が終端位置p8に到達する直前のトラクタ1の進行方向側(左側)の圃場外領域A1(圃場Aの左端部)との間の距離Lpが所定距離Lth未満となる場合に、トラクタ1の目標速度を終端位置p8に向かって減速させる減速処理を実行する。例えば、自動走行制御部23Fは、左後進経路P2cを後進するトラクタ1が終端位置p8において零速状態(停止状態)になるように前記減速処理を実行する(図19C参照)。これにより、トラクタ1が圃場外領域A1に飛び出すことを防ぐことができる。なお、前記所定距離Lthは、方向転換経路P2(例えば左後進経路P2c)の長さと、トラクタ1の目標車速とに基づいて予め設定される。
一方、自動走行制御部23Fは、トラクタ1が圃場外領域A1(圃場Aの左端部)に近づく左後進経路P2cを後進走行する場合(図19B参照)において、トラクタ1の前後方向を切り替える終端位置p8(方向転換位置)と、トラクタ1が終端位置p8に到達する直前のトラクタ1の進行方向側(左側)の圃場外領域A1(圃場Aの左端部)との間の距離Lpが所定距離Lth以上となる場合には前記減速処理を実行しない。また、自動走行制御部23Fは、トラクタ1が圃場外領域A1(圃場Aの左端部)に近づかない右前進経路P2bを前進走行する場合には前記減速処理を実行しない。この場合には、自動走行制御部23Fは、所定の速度でトラクタ1を方向転換させ、方向転換経路P2の所定位置で前後進を切り替える切替指示をトラクタ1に出力する。これにより、トラクタ1の方向転換にかかる時間を短縮することができる。また、例えばトラクタ1が左後進経路P2cを後進して目標の終端位置p8よりも左側に飛び出したとしても圃場外領域A1に進入することを防ぐことができる。
同様に、図20A~図20Cに示す方向転換経路P2では、自動走行制御部23Fは、トラクタ1が圃場外領域A1(圃場Aの右端部)に近づく右前進経路P2bを前進走行する場合において、トラクタ1の前後方向を切り替える終端位置p7(方向転換位置)と、トラクタ1が終端位置p7に到達する直前のトラクタ1の進行方向側(右側)の圃場外領域A1(圃場Aの右端部)との間の距離Lpが所定距離Lth未満となる場合に、トラクタ1の目標速度を終端位置p7に向かって減速させる減速処理を実行する(図20B参照)。例えば、自動走行制御部23Fは、右前進経路P2bを前進するトラクタ1が終端位置p7において零速状態(停止状態)になるように前記減速処理を実行する。これにより、トラクタ1が圃場外領域A1に飛び出すことを防ぐことができる。なお、前記所定距離Lthは、方向転換経路P2(例えば右前進経路P2b)の長さと、トラクタ1の目標車速とに基づいて予め設定される。なお、トラクタ1が後進走行により方向転換する場合の前記所定距離Lth(図19A~図19C参照)と、トラクタ1が前進走行により方向転換する場合の前記所定距離Lth(図20A~図20C参照)とが、互いに異なる値に設定されてもよい。例えば、前記所定距離Lthは、左後進経路P2cの長さと右前進経路P2bの長さとに応じて異なる値に設定される。
一方、自動走行制御部23Fは、トラクタ1が圃場外領域A1(圃場Aの右端部)に近づく右前進経路P2bを前進走行する場合(図20A参照)において、トラクタ1の前後方向を切り替える終端位置p7(方向転換位置)と、トラクタ1が終端位置p7に到達する直前のトラクタ1の進行方向側(右側)の圃場外領域A1(圃場Aの右端部)との間の距離Lpが所定距離Lth以上となる場合には前記減速処理を実行しない。また、自動走行制御部23Fは、トラクタ1が圃場外領域A1(圃場Aの右端部)に近づかない左後進経路P2cを後進走行する場合には前記減速処理を実行しない。この場合には、自動走行制御部23Fは、所定の速度でトラクタ1を方向転換させ、方向転換経路P2の所定位置で前後進を切り替える切替指示をトラクタ1に出力する。これにより、トラクタ1の方向転換にかかる時間を短縮することができる。また、例えばトラクタ1が右前進経路P2bを前進して目標の終端位置p7よりも右側に飛び出したとしても圃場外領域A1に進入することを防ぐことができる。
なお、トラクタ1が始端側旋回経路P2aを前進する場合(図19及び図20参照)には、圃場領域(圃場Aの上端部)に近づくことになるが、この場合には、トラクタ1の前後方向を切り替える終端位置p7に到達する直前のトラクタ1の進行方向が右側になるため、自動走行制御部23Fは、終端位置p7と圃場Aの右端部との間の距離Lpに基づいて前記減速処理の要否を決定する。すなわち、この場合に、自動走行制御部23Fは、終端位置p7と圃場Aの上端部との間の距離に基づいて前記減速処理の要否を決定しない。なお、トラクタ1の前後方向を切り替える終端位置p7に到達する直前のトラクタ1の進行方向が上側になる場合には、自動走行制御部23Fは、終端位置p7と圃場Aの上端部との間の距離に基づいて前記減速処理の要否を決定する。
ここで、方向転換経路P2は、フィッシュテール状の方向転換経路に限定されない。方向転換経路P2は、例えば図21又は図22に示す方向転換経路であってもよい。
図21に示す方向転換経路P2では、トラクタ1は、作業経路P1を左方向に走行して位置p11に到達すると作業を停止して位置11から位置12まで前進し、位置12に到達すると前後進を切り替えて位置p12から位置p13まで後進する。トラクタ1は、位置p13に到達すると前後進を切り替えて位置p13から左方向に前進で90度旋回して位置p14まで前進する。トラクタ1は、位置p14に到達すると前後進を切り替えて位置p15まで後進し、位置p15に到達すると前後進を切り替えて位置p11まで前進する。トラクタ1は、位置p11に到達すると作業経路P1を前進して作業を再開する。
図21に示す方向転換経路P2では、自動走行制御部23Fは、トラクタ1が圃場外領域A1(圃場Aの左端部)に近づく左前進経路(位置p11から位置p12の経路)を前進走行する場合において、トラクタ1の前後方向を切り替える位置p12(方向転換位置)と、トラクタ1が位置p12に到達する直前のトラクタ1の進行方向側(左側)の圃場外領域A1(圃場Aの左端部)との間の距離Lpが所定距離Lth未満となる場合に、トラクタ1の目標速度を位置p12に向かって減速させる減速処理を実行する。例えば、自動走行制御部23Fは、左前進するトラクタ1が位置p12において零速状態(停止状態)になるように前記減速処理を実行する。また、自動走行制御部23Fは、トラクタ1が圃場外領域A1(圃場Aの上端部)に近づく上後進経路(位置p14から位置p15の経路)を後進走行する場合において、トラクタ1の前後方向を切り替える位置p15(方向転換位置)と、トラクタ1が位置p15に到達する直前のトラクタ1の進行方向側(上側)の圃場外領域A1(圃場Aの上端部)との間の距離Lpが所定距離Lth未満となる場合に、トラクタ1の目標速度を位置p15に向かって減速させる減速処理を実行する。例えば、自動走行制御部23Fは、上後進するトラクタ1が位置p15において零速状態(停止状態)になるように前記減速処理を実行する。これにより、トラクタ1が圃場外領域A1に飛び出すことを防ぐことができる。
一方、自動走行制御部23Fは、トラクタ1が圃場外領域A1(圃場Aの左端部又は上端部)に近づく左前進経路(位置p11から位置p12の経路)又は上後進経路(位置p14から位置p15の経路)を走行し、かつトラクタ1の位置p12又は位置p15と圃場外領域A1との間の距離Lpが所定距離Lth以上となる場合(例えば、作業経路P12の場合)には、前記減速処理を実行しない。また、自動走行制御部23Fは、トラクタ1が圃場外領域A1(圃場Aの左端部又は上端部)に近づかない右後進経路(位置p12から位置p13の経路)又は左旋回経路(位置p13から位置p14の経路)を走行する場合には前記減速処理を実行しない。この場合には、自動走行制御部23Fは、所定の速度でトラクタ1を方向転換させ、方向転換経路P2の所定位置で前後進を切り替える切替指示をトラクタ1に出力する。これにより、トラクタ1の方向転換にかかる時間を短縮することができる。また、例えばトラクタ1が右後進経路を後進して目標の位置p13よりも右側に飛び出したとしても圃場外領域A1に進入することを防ぐことができる。また、例えばトラクタ1が作業経路P12において左前進経路(位置p11から位置p12の経路)を前進して目標の位置p12よりも左側に飛び出したとしても圃場外領域A1に進入することを防ぐことができる。
図22に示す方向転換経路P2では、トラクタ1は、作業経路P1を左方向に走行して位置p21に到達すると作業を停止して位置21から位置22まで前進し、位置22に到達すると前後進を切り替えて位置p22から右方向に後進で90度旋回して位置p23まで後進する。トラクタ1は、位置p23に到達すると前後進を切り替えて位置p21まで前進する。トラクタ1は、位置p21に到達すると作業経路P1を前進して作業を再開する。
図22に示す方向転換経路P2では、自動走行制御部23Fは、トラクタ1が圃場外領域A1(圃場Aの左端部)に近づく左前進経路(位置p21から位置p22の経路)を前進走行する場合において、トラクタ1の前後方向を切り替える位置p22(方向転換位置)と、トラクタ1が位置p22に到達する直前のトラクタ1の進行方向側(左側)の圃場外領域A1(圃場Aの左端部)との間の距離Lpが所定距離Lth未満となる場合に、トラクタ1の目標速度を位置p22に向かって減速させる減速処理を実行する。例えば、自動走行制御部23Fは、左前進するトラクタ1が位置p22において零速状態(停止状態)になるように前記減速処理を実行する。また、自動走行制御部23Fは、トラクタ1が圃場外領域A1(圃場Aの上端部)に近づく上旋回経路(位置p22から位置p23の旋回経路)を後進走行する場合において、トラクタ1の前後方向を切り替える位置p23(方向転換位置)と、トラクタ1が位置p23に到達する直前のトラクタ1の進行方向側(上側)の圃場外領域A1(圃場Aの上端部)との間の距離Lpが所定距離Lth未満となる場合に、トラクタ1の目標速度を位置p23に向かって減速させる減速処理を実行する。例えば、自動走行制御部23Fは、上旋回するトラクタ1が位置p23において零速状態(停止状態)になるように前記減速処理を実行する。これにより、トラクタ1が圃場外領域A1に飛び出すことを防ぐことができる。
一方、自動走行制御部23Fは、トラクタ1が圃場外領域A1(圃場Aの左端部又は上端部)に近づく左前進経路(位置p21から位置p22の経路)又は上旋回経路(位置p22から位置p23の経路)を走行し、かつトラクタ1の位置p22又は位置p23と圃場外領域A1との間の距離Lpが所定距離Lth以上となる場合(例えば、作業経路P12の場合)には、前記減速処理を実行しない。この場合には、自動走行制御部23Fは、所定の速度でトラクタ1を方向転換させ、方向転換経路P2の所定位置で前後進を切り替える切替指示をトラクタ1に出力する。これにより、トラクタ1の方向転換にかかる時間を短縮することができる。また、例えばトラクタ1が作業経路P12において左前進経路(位置p21から位置p22の経路)を前進して目標の位置p22よりも左側に飛び出したとしても圃場外領域A1に進入することを防ぐことができる。
このように、トラクタ1の方向転換経路P2は特に限定されない。また、本発明の「作業車両が方向転換位置に到達する直前の前記作業車両の進行方向側の所定領域」における「進行方向」には、作業車両(トラクタ1)が前進する場合の前進方向、作業車両が後進する場合の後進方向、作業車両が前進しながら旋回(前進旋回)する場合の前進方向、作業車両が後進しながら旋回(後進旋回)する場合の後進方向が含まれる。また「所定領域」は、作業車両が前記進行方向に進行(走行)した場合に進入する領域である。なお、上述したフィッシュテール状の方向転換経路(図6等参照)において、トラクタ1を終端位置p4まで延長させる第2前進経路P1cと、終端位置p4から方向転換経路の始端位置p5にわたってトラクタ1を後進させる中継後進経路P3とが省略されてもよい。すなわち、トラクタ1は、作業経路P1を前進して始端位置p5に到達した後、始端側旋回経路P2aを旋回走行してもよい。本発明は、これらのフィッシュテール状の方向転換経路、当該フィッシュテールとは異なる方向転換経路などに適用することが可能である。
このように、自動走行制御部23Fは、トラクタ1を方向転換経路R2において前記目標速度で方向転換させるとトラクタ1が圃場外領域A1に進入する場合に前記減速処理を実行する。一方、自動走行制御部23Fは、トラクタ1を方向転換経路R2において前記目標速度で方向転換させてもトラクタ1が圃場外領域A1に進入しない場合には前記減速処理を実行しない。よって、本実施形態に係る自動走行システムによれば、トラクタ1を適切に方向転換させることによりトラクタ1の作業効率を向上させることが可能となる。
ここで、自動走行制御部23Fは、トラクタ1が所定位置に到達したときに進行方向を切り替える切替指示をトラクタ1に出力する。また、自動走行制御部23Fは、前記切替指示をトラクタ1に出力してトラクタ1に作業を停止させるとともに、トラクタ1を目標位置までの制動距離を走行させる。前記制動距離は、作業を停止させたときのトラクタ1の位置からトラクタ1が停止するまでの走行距離である。
前記所定位置は、トラクタ1が前記切替指示を取得して作業を停止する動作(制動動作)をして車速が零速状態になる停止位置が目標位置に一致する位置であってもよいし、当該目標位置よりもトラクタ1の進行方向側に延長した位置であってもよい。
ここで、前記所定位置が、作業領域(各作業経路)の終端よりも手前側に設定された場合には、作業領域の端部において非作業領域が生じる場合がある。例えば、図7に示すように、トラクタ1が前後進の切替指示を取得して車速が零速状態になったときに終端位置p4で停止するように、トラクタ1が作業領域の終端に到達する前に前記切替指示を出力する。これにより、トラクタ1は前記切替指示を取得した時点で作業を停止するため、前記切替指示を取得した時点のトラクタ1の位置から作業領域の端部までの領域が未作業領域となる。
前記未作業領域を削減するために、自動走行制御部23Fは、トラクタ1が作業領域において前進走行しながら作業を行い、非作業領域において方向転換する場合において、トラクタ1が前記作業領域を前進走行している間は前記切替指示をトラクタ1に出力しない構成としてもよい。この場合、自動走行制御部23Fは、ロータリ耕耘装置3が前記作業領域を超えた時点で前記切替指示を出力してもよいし、ロータリ耕耘装置3が前記作業領域を超えた時点で前記減速処理を実行してもよい。
また、トラクタ1が後進経路P1b(図13参照)を後進して作業始端位置pcにおいて作業を開始する場合も同様に、未作業領域を削減することが望ましい。そこで、自動走行制御部23Fは、さらに、トラクタ1が前記作業領域を後進走行している間は前記切替指示をトラクタ1に出力しない構成としてもよい。この場合、自動走行制御部23Fは、ロータリ耕耘装置3が前記作業領域を超えた時点で前記切替指示を出力してもよいし、ロータリ耕耘装置3が前記作業領域を超えた時点で前記減速処理を実行してもよい。
これらの構成によれば、非作業領域を削減して作業領域の全体を確実に作業することができる。また、作業領域においてトラクタ1の車速を減速させない構成とした場合には作業スピードを向上するため、作業効率を向上させることができる。
なお、自動走行制御部23Fは、トラクタ1が並列経路P1の第2前進経路(作業経路)P1cに従って自動走行している間は、トラクタ1の車速に基づいて算出した制動距離と、前障害物センサ86の検出情報に含まれたトラクタ1から圃場端までの直線距離とを比較して、トラクタ1が圃場外領域A1に飛び出す可能性の有無を判定する飛び出し判定処理を行ってもよい。そして、自動走行制御部23Fは、飛び出し判定処理において、トラクタ1が圃場外領域A1に飛び出す可能性があると判定した場合は、トラクタ1が圃場外領域A1に飛び出すことを防止するために、変速ユニット制御部23Bなどにトラクタ1の減速処理を行う。また、自動走行制御部23Fは、トラクタ1が圃場外領域A1に飛び出す可能性があると判定し、かつトラクタ1が安全に旋回することができないと判定した場合には、緊急停止処理を行ってもよい。
また、自動走行制御部23Fは、トラクタ1が並列経路P1の第2前進経路(作業経路)P1cに従って自動走行している間は、算出した制動距離が、直線距離から飛び出し防止用の設定距離を差し引いた距離よりも短くなる状態が維持されるように、変速ユニット制御部23Bを介してトラクタ1の車速を制限する車速制限制御を実行してもよい。
これにより、目標車速が方向転換経路P2などよりも高速に設定される並列経路P1の第2前進経路(作業経路)P1cを圃場端側に延長するようにしながらも、飛び出し判定処理において、トラクタ1が圃場外領域A1に飛び出す可能性があると判定されて、トラクタ1が緊急停止されることに起因した作業効率の低下を防止することができる。
なお、本発明は、車載制御ユニット23により前記減速処理の一部又は全部を実行する方法(自動走行方法)の発明、又は、当該方法の一部又は全部を車載制御ユニット23に実行させるためのプログラム(自動走行プログラム)の発明として捉えてもよい。また、前記減速処理は、一又は複数のプロセッサーによって実行されてもよい。
例えば、前記自動走行方法は、圃場Aにおいてトラクタ1を前進させる作業経路P1と、トラクタ1を方向転換させる方向転換経路P2とを含む目標経路Pを生成することと、トラクタ1の位置を測定することと、トラクタ1の位置に基づいてトラクタ1を目標経路Pに従って自動走行させることと、トラクタ1が方向転換経路R2で方向転換する場合において、トラクタ1の前後方向を切り替える方向転換位置が、トラクタ1が前記方向転換位置に到達する直前のトラクタ1の進行方向側の前記所定領域から所定距離未満となる場合に、トラクタ1の目標速度を前記方向転換位置に向かって減速させる減速処理を実行することと、を一又は複数のプロセッサーにより実行する方法である。
また例えば、前記自動走行プログラムは、圃場Aにおいてトラクタ1を前進させる作業経路P1と、トラクタ1を方向転換させる方向転換経路P2とを含む目標経路Pを生成することと、トラクタ1の位置を測定することと、トラクタ1の位置に基づいてトラクタ1を目標経路Pに従って自動走行させることと、トラクタ1が方向転換経路P2で方向転換する場合において、トラクタ1の前後方向を切り替える方向転換位置が、トラクタ1が前記方向転換位置に到達する直前のトラクタ1の進行方向側の前記所定領域から所定距離未満となる場合に、トラクタ1の目標速度を前記方向転換位置に向かって減速させる減速処理を実行することと、を一又は複数のプロセッサーに実行させるためのプログラムである。前記自動走行プログラムは、例えばCD又はDVDなどのコンピュータ読取可能な記録媒体に非一時的に記録されており、トラクタ1が備えるCDドライブ又はDVDドライブなどの読取装置(不図示)で読み取られて車載記憶部23Gに記憶される。なお、前記自動走行プログラムは、サーバー(不図示)から通信網N1を介してトラクタ1にダウンロードされて車載記憶部23Gに記憶されてもよい。車載制御ユニット23は、前記自動走行プログラムに従って各種の処理を実行することにより前記各種の処理部として機能する。
[別実施形態]
本発明の別実施形態について説明する。
本発明の別実施形態について説明する。
なお、以下に説明する各別実施形態の構成は、それぞれ単独で適用することに限らず、他の別実施形態の構成と組み合わせて適用することも可能である。
(1)自動走行システムは、測位ユニットと、目標経路生成部と、制御ユニットとを備えてもよい。前記測位ユニットは、作業状態と非作業状態とに切り換え可能な作業装置が後部に備えられた作業車両の位置を測定する。前記目標経路生成部は、前記作業車両の自動走行を可能にする目標経路を生成する。前記制御ユニットは、前記測位ユニットの測位情報に基づいて前記作業車両を前記目標経路に従って自動走行させる。前記目標経路には、前記作業装置が前記作業状態に切り換えられた前記作業車両を前進させる作業経路と、前記作業装置が前記非作業状態に切り換えられた前記作業車両を方向転換させる方向転換経路と、が含まれる。前記目標経路生成部は、所定間隔を置いて並列に配置される複数の前記作業経路を、複数の前記方向転換経路を介して前記作業車両の走行順に接続する経路設定で前記目標経路を生成する。また、前記目標経路生成部は、前記作業経路の終端側を所定長さで延長して、前記作業経路を、その終端側が前記所定長さで前記方向転換経路側に入り込む長さに生成し、かつ、延長後の前記作業経路の終端位置から前記方向転換経路の始端位置にわたって前記作業車両を後進させる第1後進経路を生成する。また、前記制御ユニットは、前記作業車両が走行する経路の前記作業経路から前記第1後進経路への切り換えに基づいて、前記作業装置を前記作業状態から前記非作業状態に切り換える。
(2)前記所定長さが、前記作業車両に備えられた走行装置から前記作業装置までの離隔距離に基づく長さに設定されてもよい。
(3)前記目標経路生成部は、方向転換後の前記作業車両が前記作業経路の始端位置に到達したときの前記作業装置の位置が、前記作業車両が延長後の前記作業経路の終端位置に到達したときの前記作業装置の位置と一致するように、前記作業経路の始端位置を設定してもよい。
(4)前記目標経路生成部は、前記方向転換経路の終端位置から前記作業経路の始端位置を越えて延びる非作業経路と、前記非作業経路の後端位置から前記作業経路の始端位置にわたって前記作業車両を後進させる第2後進経路とを生成してもよい。
(5)前記目標経路生成部は、前記作業経路における終端位置よりも前記作業経路での前記作業車両の目標車速に応じた制動距離だけ手前の位置に、前記作業車両の到達に伴って、前記作業車両が走行する経路を前記作業経路から前記第1後進経路に切り換える切り換え位置を設定してもよい。
(6)前記制御ユニットは、前記作業車両が前記作業経路の終端位置に近づくにつれて前記目標車速を低下させてもよい。
(7)トラクタ1の構成は種々の変更が可能である。例えば、トラクタ1は、走行装置として、左右の前輪10と、左右の後輪11に代わる左右のクローラとが備えられたセミクローラ仕様に構成されていてもよい。例えば、トラクタ1は、走行装置として、左右の前輪10及び左右の後輪11に代えて左右のクローラが備えられたフルクローラ仕様に構成されていてもよい。これらの構成においては、各クローラの後端からロータリ耕耘装置3などの作業装置までの離隔距離に基づいて、各第2前進経路(作業経路)P1cを延長する所定長さL4を設定することが考えられる。例えば、トラクタ1は、原動部として、エンジンの代わりに電動モータが備えられた電動仕様に構成されていてもよい。例えば、トラクタ1は、原動部として、エンジンと電動モータとが備えられたハイブリッド仕様に構成されていてもよい。
(8)後輪(走行装置)11からロータリ耕耘装置3までの第2離隔距離L2は、例えば、後輪11の接地面後端からロータリ耕耘装置3の作業位置までの距離に設定されてもよい。この場合、各第2前進経路(作業経路)P1cを延長する所定長さL4は第2離隔距離L2と同じ長さに設定してもよい。
(9)図23に示すように、各並列経路P1の第2前進経路(作業経路)P1cにおいては、第2前進経路P1cおける終端位置p4よりも第2前進経路P1cでのトラクタ1の目標車速に応じた制動距離Laだけ手前の位置に、トラクタ1の到達に伴って、トラクタ1が走行する経路を第2前進経路P1cから中継後進経路P3に切り換える切り換え位置p10を設定してもよい。
前記別実施形態(9)について説明すると、トラクタ1の前後進切り換え操作を行う場合には、前後進の切り換え操作が開始されてから完了するまでの間にトラクタ1の移動を許容する距離(前後進切り換え用の制動距離)が必要になる。そのため、上記の実施形態に例示したように、トラクタ1が第2前進経路P1cの終端位置p4に到達したときに、トラクタ1が走行する経路が第2前進経路P1cから中継後進経路P3に切り換えられるように設定されていると、トラクタ1が、第2前進経路P1cの終端位置p4から制動距離の分だけ不要にオーバーランすることになる。そして、このオーバーランは、トラクタ1の車速が速いほど長くなることから、第2前進経路P1cに設定されたトラクタ1の目標車速が速いほど、不要なオーバーランによる作業効率の低下などを招くことになる。
そこで、前記別実施形態(9)においては、図23に示すように、第2前進経路P1cの終端位置p4よりも前述した制動距離だけ手前の位置に前述した切り換え位置p10を設定するようにしているのであり、これにより、トラクタ1が、第2前進経路P1cの終端位置p4から不要にオーバーランするのを防止することができ、不要なオーバーランによる作業効率の低下などを回避することができる。
尚、前記別実施形態(9)は、各並列経路P1の第2前進経路(作業経路)P1c以外に、トラクタ1の前後進切り換えに関係する各並列経路P1の第1前進経路P1aや後進経路P1b、各中継後進経路P3、及び、各方向転換経路P2の右前進経路P2bや左後進経路P2cに適用してもよい。
(10)ところで、切り換え位置p10を前記別実施形態(9)で例示したように設定するだけでは、前述したように、自動走行制御部23Fは、トラクタ1が走行する経路の第2前進経路P1cから中継後進経路P3への切り換えに基づいて、ロータリ耕耘装置3を作業状態から非作業状態に切り換えることから、第2前進経路P1cでの目標車速が速いほど、第2前進経路P1cにおいてトラクタ1が自動走行で作業する距離が短くなる。
そこで、前記別実施形態(10)においては、前記別実施形態(9)に加えて、トラクタ1が第2前進経路P1cの終端位置p4に近づくにつれて、自動走行制御部23Fが作業経路での目標車速を低下させる目標車速低下処理を行うように構成している。
これにより、トラクタ1が第2前進経路P1cの終端位置p4に近づくほど、トラクタ1の車速を低下させることができ、前述した制動距離Laを短くすることができる。その結果、各第2前進経路P1cにおいてトラクタ1が自動走行で作業する距離を長くすることができる。
従って、トラクタ1の第2前進経路P1cからのオーバーランによる作業効率の低下などを招くことなく、トラクタ1の自動走行で作業する場合の作業領域Awを拡張することができて作業効率を向上させることができる。
(11)前記別実施形態(10)においては、前記別実施形態(9)で例示した構成に加えて、自動走行制御部23Fが目標車速低下処理を行う構成を例示したが、これに代えて、自動走行制御部23Fが、トラクタ1が切り換え位置p10に到達したときの車速センサ22Eの検出に基づいて、トラクタ1が切り換え位置p10に到達してから後進状態に切り換わるまでに要する制動時間を算出し、トラクタ1が切り換え位置p10に到達してから制動時間が経過したタイミング、又は、制動時間が経過する少し前のタイミングで、トラクタ1の走行状態を作業走行状態から非作業走行状態に切り換えるように構成してもよい。
これにより、トラクタ1が切り換え位置p10に到達してからも、制動時間が経過するまでの間、又は、制動時間が経過する少し前までの間は、トラクタ1を作業走行状態に維持することができ、作業領域Awの拡張による作業効率の向上を図ることができる。
(12)前記別実施形態(9)で例示した構成に加えて、自動走行制御部23Fが、トラクタ1が切り換え位置p10に到達したときに、車速センサ22Eの検出に基づいてトラクタ1の走行状態を作業走行状態から非作業走行状態に切り換える走行状態切り換え制御を開始し、この走行状態切り換え制御においては、車速センサ22Eの検出に基づいて、トラクタ1が前進状態から後進状態に切り換わったことを検知したタイミングでトラクタ1の走行状態を作業走行状態から非作業走行状態に切り換えるように構成してもよい。
これにより、トラクタ1が切り換え位置p10に到達してからも、トラクタ1が実際に後進を開始するまでの間は、トラクタ1を作業走行状態に維持することができ、作業領域Awの拡張による作業効率の向上を図ることができる。
Claims (10)
- 圃場において作業車両を前進させる作業経路と、前記作業車両を方向転換させる方向転換経路とを含む目標経路を生成することと、
前記作業車両の位置を測定することと、
前記作業車両の位置に基づいて前記作業車両を前記目標経路に従って自動走行させることと、
前記作業車両が前記方向転換経路で方向転換する場合において、前記作業車両の前後方向を切り替える方向転換位置が、前記作業車両が前記方向転換位置に到達する直前の前記作業車両の進行方向側の前記所定領域から所定距離未満となる場合に、前記作業車両の目標速度を前記方向転換位置に向かって減速させる減速処理を実行することと、
を実行する自動走行方法。 - 前記作業車両の前記方向転換位置が、前記作業車両が前記方向転換位置に到達する直前の前記作業車両の進行方向側の前記所定領域から前記所定距離以上となる場合に、前記減速処理を実行しない、
請求項1に記載の自動走行方法。 - 前記作業車両を前記方向転換経路において前記目標速度で方向転換させると前記作業車両が前記所定領域に進入する場合に前記減速処理を実行する、
請求項1又は2に記載の自動走行方法。 - 前記作業車両を前記方向転換経路において前記目標速度で方向転換させても前記作業車両が前記所定領域に進入しない場合に前記減速処理を実行しない、
請求項1~3のいずれかに記載の自動走行方法。 - 前記作業車両が所定位置に到達したときに進行方向を切り替える切替指示を前記作業車両に出力する、
請求項4に記載の自動走行方法。 - 前記切替指示を前記作業車両に出力して前記作業車両に作業を停止させるとともに、前記作業車両を目標位置までの制動距離を走行させる、
請求項5に記載の自動走行方法。 - 前記作業車両が作業領域において前進走行しながら作業を行い、非作業領域において方向転換する場合において、前記作業車両が前記作業領域を前進走行している間は前記切替指示を前記作業車両に出力しない、
請求項5又は6に記載の自動走行方法。 - さらに、前記作業車両が前記作業領域を後進走行している間は前記切替指示を前記作業車両に出力しない、
請求項7に記載の自動走行方法。 - 圃場において作業車両を前進させる作業経路と、前記作業車両を方向転換させる方向転換経路とを含む目標経路を生成する経路生成処理部と、
前記作業車両の位置を測定する測位処理部と、
前記測位処理部の測位情報に基づいて前記作業車両を前記目標経路に従って自動走行させる走行処理部と、
を備え、
前記走行処理部は、前記作業車両が前記方向転換経路で方向転換する場合において、前記作業車両の前後方向を切り替える方向転換位置が、前記作業車両が前記方向転換位置に到達する直前の前記作業車両の進行方向側の前記所定領域から所定距離未満となる場合に、前記作業車両の目標速度を前記方向転換位置に向かって減速させる減速処理を実行する、自動走行システム。 - 圃場において作業車両を前進させる作業経路と、前記作業車両を方向転換させる方向転換経路とを含む目標経路を生成することと、
前記作業車両の位置を測定することと、
前記作業車両の位置に基づいて前記作業車両を前記目標経路に従って自動走行させることと、
前記作業車両が前記方向転換経路で方向転換する場合において、前記作業車両の前後方向を切り替える方向転換位置が、前記作業車両が前記方向転換位置に到達する直前の前記作業車両の進行方向側の前記所定領域から所定距離未満となる場合に、前記作業車両の目標速度を前記方向転換位置に向かって減速させる減速処理を実行することと、
を一又は複数のプロセッサーに実行させるための自動走行プログラム。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
EP21872221.3A EP4218379A4 (en) | 2020-09-23 | 2021-09-13 | AUTOMATIC DRIVING SYSTEM, AUTOMATIC DRIVING PROCEDURE AND AUTOMATIC DRIVING PROGRAM |
KR1020237004824A KR20230071118A (ko) | 2020-09-23 | 2021-09-13 | 자동 주행 시스템, 자동 주행 방법, 및 자동 주행 프로그램 |
US18/025,362 US20230320246A1 (en) | 2020-09-23 | 2021-09-13 | Automatic Traveling System, Automatic Traveling Method, And Automatic Traveling Program |
CN202180063160.9A CN116507986A (zh) | 2020-09-23 | 2021-09-13 | 自动行驶系统、自动行驶方法以及自动行驶程序 |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020-158531 | 2020-09-23 | ||
JP2020158531A JP2022052261A (ja) | 2020-09-23 | 2020-09-23 | 自動走行システム、自動走行方法、及び自動走行プログラム |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2022065091A1 true WO2022065091A1 (ja) | 2022-03-31 |
Family
ID=80845310
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2021/033448 WO2022065091A1 (ja) | 2020-09-23 | 2021-09-13 | 自動走行システム、自動走行方法、及び自動走行プログラム |
Country Status (6)
Country | Link |
---|---|
US (1) | US20230320246A1 (ja) |
EP (1) | EP4218379A4 (ja) |
JP (1) | JP2022052261A (ja) |
KR (1) | KR20230071118A (ja) |
CN (1) | CN116507986A (ja) |
WO (1) | WO2022065091A1 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20210076561A1 (en) * | 2019-09-13 | 2021-03-18 | Kanzaki Kokyukoki Mfg. Co., Ltd. | Lawn mower with autonomous traveling function |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2023097950A (ja) * | 2021-12-28 | 2023-07-10 | 株式会社クボタ | 農作業支援システム、農業機械、農作業支援装置 |
WO2024004911A1 (ja) * | 2022-06-28 | 2024-01-04 | 株式会社クボタ | 作業車両 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2015119263A1 (ja) | 2014-02-06 | 2015-08-13 | ヤンマー株式会社 | 自律走行作業車両の走行経路の設定方法 |
US20170144702A1 (en) * | 2015-11-19 | 2017-05-25 | Agjunction Llc | K-turn path controller |
JP2017174229A (ja) * | 2016-03-24 | 2017-09-28 | ヤンマー株式会社 | 経路生成装置 |
JP2019154394A (ja) * | 2018-03-16 | 2019-09-19 | 井関農機株式会社 | 作業車両 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7044664B2 (ja) * | 2018-08-24 | 2022-03-30 | ヤンマーパワーテクノロジー株式会社 | 自動走行システム |
-
2020
- 2020-09-23 JP JP2020158531A patent/JP2022052261A/ja active Pending
-
2021
- 2021-09-13 US US18/025,362 patent/US20230320246A1/en active Pending
- 2021-09-13 CN CN202180063160.9A patent/CN116507986A/zh active Pending
- 2021-09-13 KR KR1020237004824A patent/KR20230071118A/ko active Search and Examination
- 2021-09-13 EP EP21872221.3A patent/EP4218379A4/en active Pending
- 2021-09-13 WO PCT/JP2021/033448 patent/WO2022065091A1/ja active Application Filing
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2015119263A1 (ja) | 2014-02-06 | 2015-08-13 | ヤンマー株式会社 | 自律走行作業車両の走行経路の設定方法 |
US20170144702A1 (en) * | 2015-11-19 | 2017-05-25 | Agjunction Llc | K-turn path controller |
JP2017174229A (ja) * | 2016-03-24 | 2017-09-28 | ヤンマー株式会社 | 経路生成装置 |
JP2019154394A (ja) * | 2018-03-16 | 2019-09-19 | 井関農機株式会社 | 作業車両 |
Non-Patent Citations (1)
Title |
---|
See also references of EP4218379A4 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20210076561A1 (en) * | 2019-09-13 | 2021-03-18 | Kanzaki Kokyukoki Mfg. Co., Ltd. | Lawn mower with autonomous traveling function |
US12005787B2 (en) * | 2019-09-13 | 2024-06-11 | Kanzaki Kokyukoki Mfg. Co., Ltd. | Lawn mower with autonomous traveling function |
Also Published As
Publication number | Publication date |
---|---|
CN116507986A (zh) | 2023-07-28 |
EP4218379A1 (en) | 2023-08-02 |
KR20230071118A (ko) | 2023-05-23 |
US20230320246A1 (en) | 2023-10-12 |
JP2022052261A (ja) | 2022-04-04 |
EP4218379A4 (en) | 2024-10-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP7549698B2 (ja) | 自動走行システム及び自動走行方法 | |
JP6975668B2 (ja) | 作業車両用の自動走行システム | |
WO2022065091A1 (ja) | 自動走行システム、自動走行方法、及び自動走行プログラム | |
JP7091189B2 (ja) | 作業車両用の自動走行システム | |
JP7132191B2 (ja) | 作業車両用の自動走行システム | |
JP7349277B2 (ja) | 作業車両用の自動走行システム | |
JP7556103B2 (ja) | 自動走行方法及び自動走行システム | |
WO2021075315A1 (ja) | 障害物検知システム | |
JP2024053067A (ja) | 自動走行システム及び自動走行方法 | |
WO2021010297A1 (ja) | 自動走行システム | |
JP7544778B2 (ja) | 作業車両用の自動走行システム | |
EP3901722B1 (en) | Travel state display device and automated travel system | |
JP7438718B2 (ja) | 作業車両用の自動走行システム |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 21872221 Country of ref document: EP Kind code of ref document: A1 |
|
WWE | Wipo information: entry into national phase |
Ref document number: 202180063160.9 Country of ref document: CN |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
ENP | Entry into the national phase |
Ref document number: 2021872221 Country of ref document: EP Effective date: 20230424 |