WO2021125273A1 - 作業車両 - Google Patents
作業車両 Download PDFInfo
- Publication number
- WO2021125273A1 WO2021125273A1 PCT/JP2020/047171 JP2020047171W WO2021125273A1 WO 2021125273 A1 WO2021125273 A1 WO 2021125273A1 JP 2020047171 W JP2020047171 W JP 2020047171W WO 2021125273 A1 WO2021125273 A1 WO 2021125273A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- obstacle
- work
- detection
- vehicle body
- threshold value
- Prior art date
Links
- 238000001514 detection method Methods 0.000 claims abstract description 293
- 238000004364 calculation method Methods 0.000 claims description 19
- 230000008878 coupling Effects 0.000 abstract 1
- 238000010168 coupling process Methods 0.000 abstract 1
- 238000005859 coupling reaction Methods 0.000 abstract 1
- 239000000126 substance Substances 0.000 description 19
- 239000003337 fertilizer Substances 0.000 description 13
- 238000003971 tillage Methods 0.000 description 13
- 230000005540 biological transmission Effects 0.000 description 9
- 238000005507 spraying Methods 0.000 description 8
- 230000004720 fertilization Effects 0.000 description 7
- 244000025254 Cannabis sativa Species 0.000 description 5
- 239000000428 dust Substances 0.000 description 4
- 238000000034 method Methods 0.000 description 4
- 230000001678 irradiating effect Effects 0.000 description 3
- 238000003860 storage Methods 0.000 description 3
- 230000005856 abnormality Effects 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 2
- 238000012937 correction Methods 0.000 description 2
- 230000007423 decrease Effects 0.000 description 2
- 230000003028 elevating effect Effects 0.000 description 2
- 238000003306 harvesting Methods 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000000465 moulding Methods 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 239000000575 pesticide Substances 0.000 description 2
- 230000001681 protective effect Effects 0.000 description 2
- 240000007594 Oryza sativa Species 0.000 description 1
- 235000007164 Oryza sativa Nutrition 0.000 description 1
- 238000001816 cooling Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000009313 farming Methods 0.000 description 1
- 239000010720 hydraulic oil Substances 0.000 description 1
- 239000007943 implant Substances 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000007935 neutral effect Effects 0.000 description 1
- 230000001141 propulsive effect Effects 0.000 description 1
- 235000009566 rice Nutrition 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 239000002689 soil Substances 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
-
- 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
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D49/00—Tractors
- B62D49/06—Tractors adapted for multi-purpose use
-
- 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/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- 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/60—Intended control result
- G05D1/617—Safety or protection, e.g. defining protection zones around obstacles or avoiding hazards
-
- 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/001—Steering by means of optical assistance, e.g. television cameras
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
- B60Y2200/00—Type of vehicle
- B60Y2200/20—Off-Road Vehicles
- B60Y2200/22—Agricultural vehicles
Definitions
- the present invention relates to a work vehicle such as a tractor.
- Patent Document 1 is known as an automatic traveling work vehicle that works along a traveling route.
- the work vehicle (tractor) disclosed in Patent Document 1 includes a vehicle body equipped with a work device, a work travel control unit that controls the work travel, a work travel state detection sensor group that detects the work travel state, and a travel obstacle.
- One or more obstacle sensors that detect obstacles, an obstacle detection unit that detects obstacles existing in the obstacle detection area based on sensor signals from the obstacle sensors, and a working running state detection sensor group. It is provided with an obstacle detection area determination unit that determines an obstacle detection area based on the work running state detected by.
- the obstacle detection area is determined based on the working running state, the obstacle detection area is only determined according to the working state at the time of advancing.
- the rear side where the work equipment is mounted is not considered. That is, the actual situation is that the obstacle detection area is not changed according to the work device of Patent Document 1, and the obstacle detection area is not changed according to the work.
- the present invention provides a work vehicle capable of improving workability while efficiently performing automatic driving by changing information for detecting an obstacle behind the vehicle body. The purpose.
- the technical means of the present invention for solving this technical problem is characterized by the following points.
- the work vehicle includes a vehicle body, a connecting device provided on the vehicle body and capable of connecting the work device, a control device for automatically traveling the vehicle body, and a rear obstacle detection device capable of detecting an obstacle behind the vehicle body.
- the rear obstacle detecting device includes a setting changing unit capable of changing the rear setting information for detecting an obstacle.
- the rear setting information includes the size of the detection range for detecting the obstacle, and the setting changing unit changes the size of the detection range based on the traveling speed of the vehicle body.
- the setting changing unit changes the size of the detection range according to the working device connected to the vehicle body.
- the rear setting information includes the size of the object to be determined as the obstacle, and the setting change unit sets the size of the object to be determined based on either the work or the work device.
- the rear obstacle detection device includes a first time calculation unit that calculates the detection time of an object located within the detection range for detecting the obstacle, and a detection time calculated by the first time calculation unit that is equal to or greater than the first threshold value.
- a first obstacle determination unit for determining the object as an obstacle is provided.
- the setting change unit changes the first threshold value.
- the work vehicle includes a front obstacle detection device capable of detecting an obstacle in front of the vehicle body, and the setting changing unit changes the front setting information for detecting an obstacle in the front obstacle detection device.
- the present invention by changing the information for detecting an obstacle behind the vehicle body, it is possible to improve workability while efficiently performing automatic driving.
- the work vehicle 1 will be described as the tractor 1.
- the work vehicle 1 is not limited to the tractor, and may be another work vehicle (agricultural vehicle) such as a combine harvester or a rice transplanter.
- the front side of the operator seated in the driver's seat 6 of the tractor 1 is referred to as the front side
- the rear side of the operator is referred to as the rear side
- the left side of the operator is referred to as the left side
- the right side of the operator is referred to as the right side.
- the direction of arrow D is referred to as the vehicle width direction.
- the direction away from the center in the vehicle width direction in the vehicle width direction is referred to as the outside in the vehicle width direction
- the direction in the vehicle width direction approaching the center in the vehicle width direction is referred to as the inside in the vehicle width direction.
- the tractor 1 includes a vehicle body 2, a traveling device 3, a prime mover 4, and a transmission 5.
- the traveling device 3 supports the vehicle body 2 so as to travel, and has front wheels 3F and rear wheels 3R.
- the front wheels 3F and the rear wheels 3R are tire type in the case of this embodiment, but may be crawler type.
- the prime mover 4 is an engine (diesel engine, gasoline engine), an electric motor, or the like.
- the transmission 5 can switch the propulsive force of the traveling device 3 by shifting, and can also switch the traveling device 3 forward and backward.
- the driver's seat 6 is mounted on the vehicle body 2.
- a driver's seat protective body 7 is provided around the driver's seat 6.
- the driver's seat protective body 7 is a cabin that protects the driver's seat 6 by surrounding the front, rear, upper and side of the driver's seat 6, but may be a lops or the like.
- a connecting device 8 is provided at the rear of the vehicle body 2.
- the connecting device 8 is a lifting device or the like that connects the working device 9 and the vehicle body 2 and does not lift or lower, and is composed of a swing drawr, a three-point link mechanism, or the like.
- a working device (implant, etc.) 9 can be attached to and detached from the connecting device.
- the working device 9 includes a tilling device for cultivating, a fertilizer spraying device for spraying fertilizer, a pesticide spraying device for spraying pesticides, a harvesting device for harvesting, a cutting device for cutting grass and the like, and a spreading device for spreading grass and the like.
- the vehicle body 2 has a vehicle body frame 10.
- the vehicle body frame 10 extends forward from the transmission 5 side and supports the lower portion of the prime mover 4. As shown in FIG. 2, a bonnet 13 is provided above the vehicle body frame 10.
- the bonnet 13 extends in the front-rear direction along the vehicle body frame 10.
- the bonnet 13 is arranged in front of the central portion of the driver's seat protection body 7 in the vehicle width direction.
- the bonnet 13 has a left side wall 13L provided on the left side, a right side wall 13R provided on the right side, and an upper wall portion 13U connecting the upper portions of the left side wall 13L and the right side wall 13R.
- An engine room is formed by the left side wall 13L, the right side wall 13R, and the upper wall portion 13U, and the prime mover 4, the cooling fan, the radiator, the battery, and the like are housed in the engine room.
- Front wheels 3F are arranged on the left side of the left side wall 13L and on the right side of the right side wall 13R, respectively.
- a weight 14 is provided on the front side of the bonnet 13, that is, on the front side of the vehicle body frame 10.
- the weight 14 is attached to a weight bracket 15 provided on the front portion of the vehicle body 2.
- the weight bracket 15 is attached to the front portion of the vehicle body frame 10 by fasteners such as bolts.
- the circumference of the weight 14 is covered with the weight cover 16.
- the tractor 1 includes a steering device 11.
- the steering device 11 includes a steering wheel (steering wheel) 11a, a rotation shaft (steering shaft) 11b that rotates with the rotation of the steering wheel 11a, and an auxiliary mechanism (power steering mechanism) 11c that assists the steering of the steering wheel 11a. ..
- the auxiliary mechanism 11c includes a hydraulic pump 21, a control valve 22 to which hydraulic oil discharged from the hydraulic pump 21 is supplied, and a steering cylinder 23 operated by the control valve 22.
- the control valve 22 is a solenoid valve that operates based on a control signal.
- the control valve 22 is, for example, a three-position switching valve that can be switched by moving the spool or the like.
- the control valve 22 can also be switched by steering the steering shaft 11b.
- the steering cylinder 23 is connected to an arm (knuckle arm) 24 that changes the direction of the front wheels 3F.
- the switching position and opening degree of the control valve 22 are switched according to the steering wheel 11a, and the steering cylinder 23 expands and contracts to the left or right according to the switching position and opening degree of the control valve 22. Therefore, the steering direction of the front wheel 3F can be changed.
- the above-mentioned steering device 11 is an example, and the configuration of the steering device 11 is not limited to the above-mentioned configuration.
- the tractor 1 includes a position detecting device 20.
- the position detecting device 20 is mounted in front of the top plate of the cabin 7 via a mounting body 18.
- the mounting position of the position detecting device 20 is not limited to the position shown in the drawing, and may be mounted on the top plate of the cabin 7 or may be mounted at another location on the vehicle body 2.
- the position detecting device 20 may be attached to a working device such as the above-mentioned tilling device.
- the position detection device 20 is a device that detects its own position (positioning information including latitude and longitude) by a satellite positioning system. That is, the position detection device 20 receives signals transmitted from the positioning satellite (position of the positioning satellite, transmission time, correction information, etc.), and detects the position (latitude, longitude) based on the received signals. The position detection device 20 may detect a corrected position based on a signal such as a correction from a base station (reference station) capable of receiving a signal from a positioning satellite as its own position (latitude, longitude). Further, the position detection device 20 may have an inertial measurement unit such as a gyro sensor or an acceleration sensor, and may detect the position corrected by the inertial measurement unit as its own position.
- the position detection device 20 can detect the position (running position) of the vehicle body 2 of the tractor 1.
- the self-position of the tractor 1 detected by the position detection device 20 may be the center position of the vehicle body 2, the position of the front wheels 3F (for example, the front end position), the position of the rear wheels 3R (for example, the rear end position), and the like. It may be.
- the tractor 1 includes an obstacle detection device 31 that detects an obstacle that hinders traveling.
- the obstacle detection device 31 includes a front obstacle detection device 31A and a rear obstacle detection device 31B.
- the front obstacle detection device 31A is a device capable of detecting an obstacle in front of the vehicle body 2.
- the rear obstacle detection device 31B is a device capable of detecting an obstacle behind the vehicle body 2.
- the front obstacle detection device 31A and the rear obstacle detection device 31B are laser scanners that detect obstacles by irradiating light waves as detection waves.
- the obstacle detection device may be a sensor (distance measuring sensor) other than a sonar or a laser scanner that detects an obstacle by irradiating a sound wave (ultrasonic wave) as a detection wave.
- the front obstacle detection device 31A is provided at a different position in the front-rear direction from the rear obstacle detection device 31B.
- the front obstacle detection device 31A is provided in front of the rear obstacle detection device 31B.
- the front obstacle detection device 31A is arranged in front of the front wheel 3F.
- the front obstacle detection device 31A is arranged outside the front wheel 3F in the vehicle width direction.
- the front obstacle detection device 31A is arranged outside the vehicle width direction with respect to the rear wheels 3R.
- the front obstacle detection device 31A is arranged on the left front of the left front wheel 3F and on the right front of the right front wheel 3F, respectively.
- the front obstacle detection device 31A arranged on the left front of the left front wheel 3F and the front obstacle detection device 31A arranged on the right front of the right front wheel 3F sandwich the center line of the tractor 1 in the vehicle width direction. Is in a symmetrical position.
- the front obstacle detection device 31A is attached to the vehicle body frame 10 via the attachment structure 50.
- the mounting structure 50 has a first structure 51, a second structure 52, a third structure 53, and a fourth structure 54.
- the first structure 51 is attached to the vehicle body frame 10 and extends forward from the vehicle body frame 10 and outward in the vehicle width direction (left front and right front).
- the second structure 52 is attached to the front end (extending end) of the first structure 51.
- the second structure 52 extends outward in the width direction of the airframe and supports the forward obstacle detection device 31A.
- a sonar 55 different from the sonar constituting the rear obstacle detection device 31B is attached to the second structure 52.
- the irradiation direction of the laser emitted from the front obstacle detection device 31A is the horizontal direction.
- a part of the front obstacle detection device 31A and the second structure 52 is covered with a cover 56.
- the cover 56 is attached to the second structure 52 by an attachment such as a bolt.
- the cover 56 includes an upper cover arranged above the front obstacle detecting device 31A and a lower cover arranged below the front obstacle detecting device 31A.
- a gap G is formed between the upper cover 56A and the lower cover 56B around the front obstacle detection device 31A (see FIG. 2), and the front obstacle detection device 31A transmits a detection wave (laser) through the gap G. Can be sent and received.
- the sonar 55 can transmit and receive a detection wave (sound wave) through the opening formed in the upper cover 56A.
- the rear obstacle detection device 31B is the rear part of the cabin 7, and is attached to the upper part of the cabin 7 via a bracket (not shown).
- the detection direction is inclined slightly downward with respect to the horizontal direction, that is, is directed to the work device 9 side.
- the detection direction is the direction in which the optical axis for irradiating the laser is directed when the rear obstacle detection device 31B is a laser scanner, and when the rear obstacle detection device 31B is a sonar, it irradiates sound waves. This is the direction in which the optical axis (central axis of the lens) of the image sensor faces when the rear obstacle detection device 31B is a camera.
- the front obstacle detection device 31A stores the front setting information for detecting an obstacle
- the rear obstacle detection device 31B also stores the rear setting information for detecting an obstacle.
- the front setting information and the rear setting information are various information for detecting an obstacle by the obstacle detection device 31 (front obstacle detection device 31A, rear obstacle detection device 31B), and are a detection range and a detection range. It is a judgment condition for determining whether or not the object detected in is an obstacle. First, the detection range will be described.
- FIG. 4 shows an example of the detection ranges Q1 and Q2 of the front obstacle detection device 31A and the rear obstacle detection device 31B.
- the detection range Q1 of the front obstacle detection device 31A includes a lateral range Qa1 extending from the front obstacle detection device 31A to the rear and side of the vehicle body 2 (outside in the width direction of the vehicle body 2) and the front obstacle detection device 31A. Includes the front range Qa2 extending from the front of the vehicle body 2 to the inside of the vehicle body 2 in the width direction.
- the lateral range Qa1 is set by the detection lengths L1 and L2 toward the outside in the width direction and the lengths L3 in the front-rear direction.
- the front range Qa2 is set by the detection length L6 toward the front and the detection length L5 in the width direction.
- the default values (standard detection range, standard detection length) of the size of the detection range Q1 are in front of the front obstacle detection device 31A. It is stored as setting information.
- the detection range Q2 of the rear obstacle detection device 31B is a range extending from the rear obstacle detection device 31B to the rear of the vehicle body 2, and has a detection length L10 toward the rear and a detection length L11 toward the width direction. Is set by. As shown in FIG. 7, the default values (standard detection range, standard detection length) of the size of the detection range Q2 (detection lengths L10 and L11) are stored as the rear setting information of the rear obstacle detection device 31B. There is. In the front obstacle detection device 31A and the rear obstacle detection device 31B, the sizes of the detection ranges Q1 and Q2 can be freely set, and the width, length, angle, and the like can be changed.
- FIG. 5 shows an example of the object M1 detected by the front obstacle detection device 31A and the object M2 detected by the rear obstacle detection device 31B.
- the front obstacle detection device 31A detects the object (detection object) M1.
- the height H1 of the detection object M1 is the height threshold value H2 or more (H1 ⁇ H2)
- the object width W1 of the detection object M1 is the width threshold value W2 or more (W1 ⁇ W2).
- the forward obstacle detection device 31A determines that the detected object M1 is an obstacle.
- the forward obstacle detection device 31A determines that the detection object M1 is not an obstacle when the height H1 of the detection object M1 is less than the height threshold value H2 or the object width W1 of the detection object M1 is less than the width threshold value W2. ..
- the front obstacle detection device 31A stores a height threshold value H2 and a width threshold value W2 as determination conditions for determining whether or not the detected object M1 is an obstacle. That is, the forward obstacle detection device 31A stores the height threshold value H2 and the width threshold value W2, which are the determination conditions, as the forward setting information.
- the rear obstacle detection device 31B detects the object (detection object) M2.
- the height H3 of the detection object M2 is the height threshold value H4 or more (H3 ⁇ H4)
- the object width W3 of the detection object M2 is the width threshold value W4 or more (W3 ⁇ W4).
- the rear obstacle detection device 31B determines that the detected object M2 is an obstacle.
- the height H3 of the detection object M2 is less than the height threshold value H4 or the object width W3 of the detection object M2 is less than the width threshold value W4
- the rear obstacle detection device 31B determines that the detection object M2 is not an obstacle. .. As shown in FIG.
- the rear obstacle detection device 31B stores a height threshold value H4 and a width threshold value W4 as determination conditions for determining whether or not the detected object M2 is an obstacle. That is, the rear obstacle detection device 31B stores the height threshold value H4 and the width threshold value W4, which are the determination conditions, as the rear setting information.
- the size of the detected objects M1 and M2 (heights H1, H3, object widths W1 and W4) is used to determine whether or not the object is an obstacle.
- the detected objects M1 and M2 are detected. It may be judged whether or not it is an obstacle by the time (the time of staying) located in the ranges Q1 and Q2.
- the forward obstacle detection device 31A has a second time calculation unit 33 and a second obstacle determination unit 34.
- the second time calculation unit 33 and the second obstacle determination unit 34 are composed of stored programs such as electric circuits and electronic circuits provided in the front obstacle detection device 31A.
- the second time calculation unit 33 calculates the detection time (second detection time) T2 in which the detection object M1 is located in the detection range Q1.
- the second obstacle determination unit 34 determines the detected object M1 as an obstacle when the second detection time T2 calculated by the second time calculation unit 33 is equal to or greater than the second threshold value T11, and the second detection time T2 is the second.
- the threshold value is less than T11, the detected object M1 is not determined as an obstacle.
- the forward obstacle detection device 31A stores the second threshold value T11 as a determination condition. That is, the forward obstacle detection device 31A stores the second threshold value T11, which is a determination condition, as forward setting information.
- the rear obstacle detection device 31B has a first time calculation unit 35 and a first obstacle determination unit 36.
- the first time calculation unit 35 and the first obstacle determination unit 36 are composed of stored programs such as electric circuits and electronic circuits provided in the front obstacle detection device 31A.
- the first time calculation unit 35 calculates the detection time (first detection time) T1 in which the detection object M2 is located in the detection range Q2.
- the first obstacle determination unit 36 determines the detected object M2 as an obstacle when the first detection time T1 calculated by the first time calculation unit 35 is equal to or greater than the first threshold value T10, and the first detection time T1 is the first. When the threshold value is less than T10, the detected object M2 is not determined as an obstacle.
- the rear obstacle detection device 31B stores the first threshold value T10 as a determination condition.
- the rear obstacle detection device 31B stores the first threshold value T10, which is a determination condition, as the rear setting information.
- the default value of the first threshold value T10 can be set by a setting member such as a volume before the start of automatic operation. That is, the first threshold value T10 is set according to the operation amount of the setting member, is set to the minimum value when the operation amount is the minimum, and is set to the maximum value when the operation amount is the maximum.
- FIG. 6 shows a second detection time T2 after the front obstacle detection device 31A detects the detected object M1 and a first detection time T1 after the rear obstacle detection device 31B detects the detected object M2.
- An example is shown. As shown in FIG. 6, it is assumed that the detection object M1 enters the detection range Q1 at the time point P1.
- the second time calculation unit 33 calculates the second detection time T2 in which the detection object M1 is in the detection range Q1.
- the second obstacle determination unit 34 determines that the detected object M1 is an obstacle.
- the first time calculation unit 35 calculates the first detection time T1 in which the detection object M2 enters the detection range Q2.
- the first obstacle determination unit 36 determines that the detected object M2 is an obstacle.
- the tractor 1 includes a control device 25.
- the control device 25 is composed of a CPU, a storage unit (RAM, ROM, etc.) and the like, and executes various controls of the tractor 1 based on a program and the like stored in the storage unit.
- a state detection device 26 for detecting the driving state of the tractor 1 and the like is connected to the control device 25.
- the state detection device 26 is, for example, a crank sensor, a cam sensor, an engine rotation sensor, an accelerator sensor, a vehicle speed sensor, an acceleration sensor, a steering angle sensor, an elevating lever detection sensor, a PTO rotation detection sensor, and the like.
- a transmission 5, a forward / backward switching device 28, a PTO clutch 29, and a brake device 30 are connected to the control device 25.
- the state detection device 26, the transmission 5, the forward / backward switching device 28, the PTO clutch 29, and the brake device 30 are connected via an in-vehicle network N1 such as CAN (Controller Area Network) and the international standard ISO11783 (ISO-BUS). ing.
- the control device 9a of the work device 9 is connected to the vehicle-mounted network N1.
- the control device 9a is composed of, for example, an electric circuit including a CPU, a storage unit (RAM, ROM, etc.), an electronic circuit, and the like, and controls the work device 9.
- the control device 25 controls the traveling system and the working system in the tractor 1.
- the control device 25 controls, for example, the engine speed, the vehicle speed, the steering angle of the steering device 11, and the like based on the detection state detected by the state detection device 26.
- the state detection device 26 controls the elevating device, the PTO rotation speed, and the like based on the detection state detected by the state detecting device 26.
- the control device 25 can control the automatic running of the tractor 1 (vehicle body 2) (automatic running control).
- the control device 25 can switch between the automatic traveling mode and the manual traveling mode.
- the control device 25 automatically drives the vehicle body 2 along a preset traveling route.
- the control device 25 at least the traveling position of the vehicle body 2 (the position detected by the position detecting device 20) and the preset traveling route (traveling route) match, that is, the vehicle body 2 and the traveling route match.
- the switching position and opening degree of the control valve 22 are set so as to be performed.
- the control device 25 sets the moving direction and the amount of movement (steering direction and steering angle of the front wheels 3F) of the steering cylinder 23 so that the traveling position of the tractor 1 and the traveling route match. Set.
- the control device 25 compares the traveling position of the vehicle body 2 with the position indicated by the traveling route (scheduled traveling position), and the traveling position and the planned traveling position match. If so, the steering angle and steering direction (steering angle and steering direction of the front wheels 3F) of the steering wheel 11a in the steering device 11 are held unchanged (the opening degree and switching position of the control valve 22 are maintained unchanged). ). When the traveling position and the planned traveling position do not match, the control device 25 increases the steering angle of the steering wheel 11a in the steering device 11 and the steering angle of the steering wheel 11a so that the deviation (deviation amount) between the traveling position and the planned traveling position becomes zero. / Or change the steering direction (change the opening and / or switching position of the control valve 22).
- the control device 25 changes the steering angle of the steering device 11 based on the deviation between the traveling position and the planned traveling position in the automatic traveling control, but the direction of the traveling route and the tractor
- the control device 25 may set the steering angle so that the vehicle body direction matches the direction of the traveling route.
- the control device 25 sets the final steering angle in the automatic driving control based on the steering angle obtained based on the deviation (positional deviation) and the steering angle obtained based on the directional deviation in the automatic driving control. You may.
- the steering angle may be set by a method different from the steering angle setting method in the automatic traveling control described above.
- control device 25 sets the traveling device 3 (that is, the front wheels 3F and / /) so that the actual vehicle speed of the tractor 1 (vehicle body 2) matches the vehicle speed corresponding to the preset traveling route in the automatic traveling control. Alternatively, the rotation speed of the rear wheels 3R) may be controlled. Further, the control device 25 controls the automatic traveling based on the obstacle detection result by the obstacle detection device 31. For example, if the obstacle detection device 31 does not detect an obstacle, the automatic running is continued, and if the obstacle detection device 31 detects an obstacle, the automatic running is stopped. More specifically, when the obstacle detection device 31 detects an obstacle, the control device 25 travels the tractor 1 when the distance between the obstacle and the tractor 1 is less than or equal to a predetermined distance. By stopping, automatic driving is stopped.
- control device 25 controls the operation of the transmission 5, the forward / backward switching device 28, the PTO clutch 29, and the brake device 30 when the obstacle detection device 31 detects an obstacle.
- control device 25 operates the transmission 5 on the deceleration side to reduce the vehicle speed.
- control device 25 switches the forward / backward switching device 28 to the neutral state and operates the brake device 30.
- the control device 25 switches the PTO clutch 29 to the off state to cut off the power transmission from the PTO axis of the tractor 1 to the work device 9.
- the driving of the working device 9 is stopped.
- the control device 25 includes a setting changing unit 27.
- the setting changing unit 27 is composed of an electric circuit, an electronic circuit, a program, etc. provided in the control device 25.
- the rear setting information of the rear obstacle detection device 31B can be changed.
- the setting changing unit 27 changes the size of the detection range Q2 based on the traveling speed of the vehicle body 2. Specifically, when the automatic traveling is started by the automatic traveling control of the control device 25, the setting changing unit 27 refers to the vehicle speed (traveling speed) of the vehicle body 2 detected by the vehicle speed sensor. When the traveling speed exceeds the traveling threshold value, the setting changing unit 27 changes the detection length L10 to be longer than the default value (standard detection length). That is, the setting changing unit 27 makes the size of the detection range Q2 larger than the standard detection range by making the detection length L10 longer than the default value (standard detection length).
- the setting changing unit 27 changes the detection length L10 to be shorter than the default value (standard detection length). That is, the setting changing unit 27 makes the size of the detection range Q2 smaller than the standard detection range by making the detection length L10 shorter than the default value (standard detection length).
- the running threshold value is a value for determining whether the speed is high speed or low speed.
- the travel threshold value may be stored in the control device 25 in advance, may be changed by a volume or the like, and is not limited.
- the detection length L10 may be changed to be longer or shorter depending on the traveling speed.
- the setting changing unit 27 gradually increases the length of the detection length L10 as the traveling speed increases and gradually shortens the length of the detection length L10 as the traveling speed decreases in proportion to the traveling speed. ..
- the detection range Q2 and the like in the setting changing unit 27 may be changed according to the traveling speed of the vehicle body 2 when moving backward.
- the setting changing unit 27 changes the sizes of the detection lengths L10 and L11 according to the working device 9 connected to the vehicle body 2. Specifically, when the work device 9 is connected to the vehicle body 2, the machine width W10 and the machine length L20 of the work device 9 are acquired from the control device 9a of the work device 9 via the vehicle-mounted network N1. As shown in FIG. 8A, when the default value (standard detection length) of the detection length L11 is shorter than the machine width W10 of the working device 9, as shown in FIG. 8B, the setting changing unit 27 sets the detection length L11. Is longer than the machine width W10 of the working device 9.
- the rear end Q2a of the detection range Q2 is the rear end 9b of the working device 9.
- the boundary Q2b in the width direction of the detection range Q2 is on the front side and inside the end portion 9c in the width direction of the rear end 9b of the working device 9, as shown in FIG. 8D, the setting changing unit 27 ,
- the detection lengths L10 and L11 are made larger than the default value (standard detection length)
- the rear end Q2a of the detection range Q2 is located behind the rear end 9b of the working device 9, and the detection range Q2.
- the boundary Q2b in the width direction is positioned outside the end portion 9c in the width direction of the rear end 9b of the working device 9 in the width direction.
- the front end of the working device 9 can be detected by the front obstacle detecting device 31A. Further, by lengthening the detection length L3 in the forward obstacle detection device 31A in the direction side, the detection range Ha1 and the work device 9 can be overlapped with each other.
- the setting changing unit 27 acquires the machine width W10 of the working device 9 via the vehicle-mounted network N1
- the setting changing unit 27 is the display device 60 provided in the tractor 1. (See FIG. 3), an input screen for inputting the machine width W10 and the machine length L20 of the work device 9 may be displayed, and the machine width W10 of the work device 9 input to the input screen may be acquired.
- the setting changing unit 27 changes the determination conditions (height threshold value H4, width threshold value W4, first threshold value T10) for determining the detected object M2 as an obstacle.
- the setting changing unit 27 sets the height threshold value H4 and the width threshold value W4 to be smaller than the default values when the work is, for example, a spraying work (fertilization work, chemical work), a tilling work, or other work in which dust or the like is likely to fly up. .. Further, when the work is a work other than the spraying work (fertilization work, chemical work) and the tilling work, the setting changing unit 27 sets the height threshold value H4 and the width threshold value W4 to the default values.
- the setting change unit 27 displays the setting screen J1 for setting the work (agricultural work).
- a plurality of farm works are displayed on the setting screen J1.
- fertilizer application work, chemical work, and tillage work are selected on the setting screen J1
- the height threshold value H4 and the width threshold value W4 are made smaller than the default values, and agricultural work other than fertilizer application work, chemical work, and tillage work is selected. If so, the height threshold value H4 and the width threshold value W4 are set to the default values.
- the setting change unit 27 makes the height threshold value H4 and the width threshold value W4 smaller than the default values, and makes the fertilizer work, chemical work, and chemical work.
- the height threshold value H4 and the width threshold value W4 are set to default values.
- the height threshold value H4 and the width threshold value W4 are changed based on either the farm work or the work device 9, but the elapsed time (first threshold value) for determining the detected object M2 as an obstacle. T10) may be changed.
- the setting change unit 27 maximizes the first threshold value T10 and selects the agricultural work other than the fertilizer application work, the chemical work, and the tillage work. If so, the first threshold T10 is set to the default value.
- the setting changing unit 27 maximizes the first threshold value T10 and sets the first threshold value T10 to the default value when the work device 9 that performs other than fertilization work, chemical work, and tillage work is connected to the vehicle body 2. ..
- the setting change unit 27 can also change the front setting information of the front obstacle detection device 31A.
- the setting changing unit 27 changes the size of the detection range Q1 based on the traveling speed of the vehicle body 2. Specifically, the setting changing unit 27 changes the detection length L6 to be longer than the default value (standard detection length) when the vehicle speed (running speed) of the vehicle body 2 detected by the vehicle speed sensor exceeds the running threshold value. I do. That is, the setting changing unit 27 makes the size of the detection range Q1 larger than the standard detection range by making the detection length L6 longer than the default value (standard detection length).
- the setting changing unit 27 changes the detection length L6 to be shorter than the default value (standard detection length). That is, the setting changing unit 27 makes the size of the detection range Q1 smaller than the standard detection range by making the detection length L6 shorter than the default value (standard detection length).
- the detection length L6 may be changed to be longer or shorter depending on the traveling speed.
- the setting changing unit 27 gradually increases the length of the detection length L6 as the traveling speed increases and gradually shortens the length of the detection length L6 as the traveling speed decreases in proportion to the traveling speed. ..
- the setting changing unit 27 changes the size of the detection length L5 according to the working device 9 connected to the vehicle body 2. Specifically, when the default value (standard detection length) of the detection length L5 is shorter than the machine width W10 of the work device 9, the setting changing unit 27 sets the detection length L5 from the machine width W10 of the work device 9. Also lengthen.
- the setting changing unit 27 changes the determination conditions (height threshold value H2, width threshold value W2, second threshold value T11) for determining the detected object M1 as an obstacle. Similar to the rear obstacle detection device 31B, the setting changing unit 27 sets the height threshold value H2 and the width threshold value W2 to be smaller than the default values when the work is spraying work (fertilization work, chemical work), tilling work, or the like. .. Further, when the work is a work other than the spraying work (fertilization work, chemical work) and the tilling work, the setting changing unit 27 sets the height threshold value H2 and the width threshold value W2 to the default values. The default values of the height threshold value H2 and the width threshold value W2 corresponding to the detected object M1 are set smaller than the height threshold value H4 and the width threshold value W4 corresponding to the detected object M2.
- the height threshold value H2 and the width threshold value W2 are changed based on either the farm work or the work device 9, but the elapsed time (second) for determining the detected object M1 as an obstacle.
- the threshold value T11) may be changed.
- the setting changing unit 27 sets the second threshold value T11 to be smaller than the default value when fertilizer application work, chemical work, and tillage work are selected, and when agricultural work other than fertilizer application work, chemical work, and tillage work is selected, ,
- the second threshold value T11 is set to the default value.
- the setting change unit 27 sets the second threshold value T11 to be smaller than the default value, and fertilizer work, chemical work, and tillage work.
- the second threshold value T11 is set to the default value.
- the setting changing unit 27 may make the length of the detection length L6 smaller than the default value when the fertilization work, the chemical work, and the tilling work are selected.
- each change of the front setting information and the rear setting information in the setting changing unit 27 may be performed in conjunction with each other according to the traveling speed, the work (agricultural work), and the type of the work device 9. It may be done independently. As shown in FIG. 10, by displaying the setting screen J2 on the display device 60 and operating the display device 60 on the setting screen J2, it is possible to make settings related to each change of the front setting information and the rear setting information. May be good.
- the setting change unit 27 For example, in the first item K1 of the setting screen J2, it may be possible to select whether the front setting information and the rear setting information can be changed / cannot be changed from the default values during automatic driving.
- the setting information is set according to the traveling speed, the work (farming work), the type of the work device 9, and the like.
- the change can be made by the setting change unit 27.
- the setting change unit 27 does not change the information, and the value is fixed to the default value during automatic driving.
- the items to be changed (detection range Q1, Q2, height threshold value H2, H4, width threshold value W2, W4, first threshold value T10, second threshold value) when the setting information can be changed. T11) may be selectable.
- the setting information (forward setting information, backward setting information) corresponding to the item selected in the second item K2 is changed.
- each of the change conditions [running speed, work (agricultural work), type of work device 9] to be changed may be selected. In this case, when the change conditions [running speed, work (agricultural work), type of work device 9] corresponding to the item selected in the third item K3 are satisfied during automatic running, the setting information (forward setting information, Backward setting information) is changed.
- a predetermined change item can be selected from a plurality of change items, and even the change condition can be arbitrarily selected. It is possible to realize settings according to various situations in agricultural work. For example, it can be changed not only according to the farm work itself but also according to the condition of the field where the farm work is performed (soil is soft and hard, inclined, etc.), the size of the tractor 1, the size of the work device 9, the weather, etc. is there.
- the work vehicle 1 includes a vehicle body 2, a connecting device 8 provided on the vehicle body 2 and capable of connecting the work device 9, a control device 25 for automatically traveling the vehicle body 2, and a rear portion capable of detecting an obstacle behind the vehicle body 2. It includes an obstacle detection device 31B and a setting change unit 27 that can change the rear setting information for detecting an obstacle in the rear obstacle detection device 31B. According to this, since the setting change unit 27 can change the rear setting information of the rear obstacle detection device 31B provided behind the vehicle body 2, the work of the work device 9 and the traveling of the vehicle body 2 (forward, reverse). ), The accuracy of obstacle detection can be adjusted, and appropriate work can be carried out according to various situations. In particular, by changing the information for detecting an obstacle behind the vehicle body, it is possible to improve workability while efficiently performing automatic driving.
- the rear setting information includes the size of the detection range Q2 for detecting an obstacle, and the setting changing unit 27 changes the size of the detection range Q2 based on the traveling speed of the vehicle body 2.
- the detection range Q2 can be changed according to the traveling speed corresponding to the work of the work device 9. For example, when working at high speed in the work device 9, by widening the detection range Q2, it is possible to quickly detect an abnormality or the like during backward work, while when working at low speed, it is possible to quickly detect an abnormality. By narrowing the detection range Q2, it is possible to perform monitoring with higher accuracy. Further, when the work is performed at a low speed, if the detection range Q2 is narrowed, the work can be performed up to the field in the work device 9, and the work area can be increased.
- the setting changing unit 27 changes the size of the detection range Q2 according to the working device 9 connected to the vehicle body 2. According to this, not only the blind spot behind the work device 9 is eliminated as much as possible depending on the size of the work device 9, but also the situation with respect to the ground after the work differs depending on the size of the work device 9. Can be enhanced.
- the rear setting information includes the size of the object M2 to be determined as an obstacle, and the setting changing unit 27 sets the size of the object M2 to be determined based on either the work or the work device 9. According to this, in the case of work that generates relatively dust such as fertilizer application work, chemical work, and tillage work, it is possible to reduce false detection of obstacles, but work that does not generate dust. If this is the case, the accuracy of obstacle detection can be improved.
- the rear obstacle detection device 31B has a first time calculation unit 35 that calculates the detection time of the object M2 located within the detection range Q2 for detecting obstacles, and a first time calculation unit 35 that calculates the detection time calculated by the first time calculation unit 35. It includes a first obstacle determination unit 36 that determines objects M1 and M2 as obstacles when the value is equal to or greater than a threshold value. According to this, the object M1 can be detected in consideration of the situation where the object M1 stays in the detection range Q2.
- the setting change unit 27 changes the first threshold value. According to this, by changing the time that the object M2 stays in the detection range Q2, false detection of obstacles is reduced when the work is relatively dusty, such as fertilization work, chemical work, and tillage work. On the other hand, if the work does not generate dust, the accuracy of obstacle detection can be improved.
- the work vehicle 1 includes a front obstacle detection device 31A capable of detecting an obstacle in front of the vehicle body 2, and the setting changing unit 27 changes the front setting information for detecting an obstacle in the front obstacle detection device 31A.
- the accuracy of obstacle detection is determined according to the work of the work device 9 and the traveling (forward, reverse) of the vehicle body 2. It is possible to proceed with appropriate work according to various situations.
- by combining the front setting information and the rear setting information on the front side of the vehicle body it is possible to detect obstacles with higher accuracy in work such as repeating forward and backward movements or in complex work. it can.
Landscapes
- Engineering & Computer Science (AREA)
- Life Sciences & Earth Sciences (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Environmental Sciences (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Soil Sciences (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Transportation (AREA)
- Human Computer Interaction (AREA)
- Combustion & Propulsion (AREA)
- Chemical & Material Sciences (AREA)
- Optics & Photonics (AREA)
- Electromagnetism (AREA)
- Guiding Agricultural Machines (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
特許文献1に開示の作業車両(トラクタ)は、作業装置を装備した車体と、作業走行を制御する作業走行制御部と、作業走行状態を検出する作業走行状態検出センサ群と、走行の障害となる障害物を検出する1つ以上の障害物センサと、障害物センサからのセンサ信号に基づいて障害物検出領域内に存在する障害物を検出する障害物検出部と、作業走行状態検出センサ群によって検出された作業走行状態に基づいて障害物検出領域を決定する障害物検出領域決定部と、を備えている。
作業車両は、車体と、前記車体に設けられ且つ作業装置を連結可能な連結装置と、前記車体を自動走行させる制御装置と、前記車体の後方の障害物を検出可能な後方障害物検出装置と、前記後方障害物検出装置において障害物を検出する後方設定情報を変更可能な設定変更部と、を備えている。
前記設定変更部は、前記検出範囲の大きさを前記車体に連結された前記作業装置に応じて変更する。
前記後方設定情報は、前記障害物として判定する物体の大きさを含み、記設定変更部は、作業及び前記作業装置のいずれかに基づいて、前記判定する物体の大きさを設定する。
前記設定変更部は、前記第1閾値を変更する。
作業車両は、前記車体の前方の障害物を検出可能な前方障害物検出装置を備え、前記設定変更部は、前方障害物検出装置において障害物を検出する前方設定情報を変更する。
図1、図2は本発明に係る作業車両1の一実施形態を示している。本実施形態では、作業車両1がトラクタ1であるとして説明する。但し、作業車両1は、トラクタに限らず、コンバイン、田植機等の他の作業車両(農業車両)であってもよい。
以下の説明において、トラクタ1の運転席6に着座したオペレータの前側を前方、オペレータの後側を後方、オペレータの左側を左方、オペレータの右側を右方という。また、矢印D方向を車幅方向という。また、車幅方向であって車幅方向の中心から離れる方向を車幅方向外方、車幅方向であって車幅方向の中心に近づく方向を車幅方向内方という。
原動機4は、エンジン(ディーゼルエンジン、ガソリンエンジン)、電動モータ等である。変速装置5は、変速によって走行装置3の推進力を切り換え可能であると共に、走行装置3の前進と後進の切り換えが可能である。
車体2は、車体フレーム10を有する。車体フレーム10は、変速装置5側から前方に延設されていて、原動機4の下部を支持している。図2に示すように、車体フレーム10の上方にはボンネット13が設けられている。ボンネット13は、車体フレーム10に沿って前後方向に延設されている。ボンネット13は、運転席保護体7の車幅方向の中央部の前方に配置されている。ボンネット13は、左側に設けられた左側壁13Lと、右側に設けられた右側壁13Rと、左側壁13Lと右側壁13Rとの上部を連結する上壁部13Uとを有する。左側壁13L、右側壁13R及び上壁部13Uによってエンジンルームが形成され、エンジンルームに原動機4、冷却ファン、ラジエータ、バッテリ等が収容されている。左側壁13Lの左側方と右側壁13Rの右側方には、それぞれ前輪3Fが配置されている。
図1及び図2に示すように、トラクタ1は、走行の障害となる障害物を検出する障害物検出装置31を備えている。障害物検出装置31は、前方障害物検出装置31Aと、後方障害物検出装置31Bとを含む。前方障害物検出装置31Aは、車体2の前方の障害物を検出可能な装置である。後方障害物検出装置31Bは、車体2の後方の障害物を検出可能な装置である。前方障害物検出装置31A及び後方障害物検出装置31Bは、検出波として光波を照射することによって障害物を検出するレーザスキャナである。但し、障害物検出装置は、検出波として音波(超音波)を照射することによって障害物を検出するソナー、レーザスキャナ以外のセンサ(測距センサ)であってもよい。
前方障害物検出装置31Aは、障害物を検出する前方設定情報が記憶されていて、後方障害物検出装置31Bも障害物を検出する後方設定情報が記憶されている。前方設定情報及び後方設定情報とは、障害物検出装置31(前方障害物検出装置31A、後方障害物検出装置31B)によって障害物を検出するための様々な情報であって、検出範囲、検出範囲で検出した物体が障害物であるか否かを判定する判断条件等である。
まず、検出範囲について説明する。
前方障害物検出装置31Aの検出範囲Q1は、当該前方障害物検出装置31Aから車体2の後方及び側方(車体2の幅方向外方)へ亘る側方範囲Qa1と、前方障害物検出装置31Aから車体2の前方及び車体2の幅方向内側へ亘る前方範囲Qa2とを含んでいる。側方範囲Qa1は、幅方向の外側に向けての検知長さL1、L2と、前後方向の長さL3によって設定される。前方範囲Qa2は、前方に向けての検知長さL6と、幅方向の検出長さL5によって設定される。図7に示すように、検出範囲Q1の大きさ(検知長さL1、L2、L3、L5、L6)のデフォルト値(標準検出範囲、標準検知長さ)は、前方障害物検出装置31Aの前方設定情報として記憶されている。
図5は、前方障害物検出装置31Aが検出した物体M1と、後方障害物検出装置31Bが検出した物体M2の一例を示している。
前方障害物検出装置31Aは、第2時間演算部33と、第2障害物判定部34とを有している。第2時間演算部33及び第2障害物判定部34は、前方障害物検出装置31Aに設けられた電気回路、電子回路等、格納されたプログラム等により構成されている。
第1時間演算部35は、検出物体M2が検出範囲Q2に位置している検出時間(第1検出時間)T1を演算する。第1障害物判定部36は、第1時間演算部35で演算した第1検出時間T1が第1閾値T10以上である場合に検出物体M2を障害物として判定し、第1検出時間T1が第1閾値T10未満である場合に検出物体M2を障害物として判定しない。なお、後方障害物検出装置31Bは、判断条件として、第1閾値T10を記憶している。即ち、後方障害物検出装置31Bは、判断条件である第1閾値T10を後方設定情報として記憶している。なお、第1閾値T10のデフォルト値は、自動運転の開始前にボリューム等の設定部材によって設定可能である。即ち、設定部材の操作量に応じて、第1閾値T10が設定され、操作量が最小である場合には最小値に設定され、操作量が最大である場合には最大値に設定される。
図6に示すように、時点P1で検出物体M1が検出範囲Q1に入ったとする。第2時間演算部33は、検出物体M1が検出範囲Q1に入った第2検出時間T2を演算する。第2障害物判定部34は、第2検出時間T2が第2閾値T11以上経過すると、検出物体M1は、障害物であると判断する。
図3に示すように、トラクタ1は、制御装置25を備えている。制御装置25は、CPUや記憶部(RAM、ROM等)等で構成されていて、記憶部に記憶されたプログラム等に基づいてトラクタ1の様々な制御を実行する。
制御装置25には、トラクタ1の駆動状態等を検出する状態検出装置26が接続されている。状態検出装置26は、例えば、クランクセンサ、カムセンサ、エンジン回転センサ、アクセルセンサ、車速センサ、加速度センサ、操舵角センサ、昇降レバー検出センサ、PTO回転検出センサ等である。また、制御装置25には、変速装置5、前後進切換装置28、PTOクラッチ29、ブレーキ装置30が接続されている。
また、制御装置25は、障害物検出装置31による障害物の検出結果に基づいて自動走行を制御する。例えば、障害物検出装置31が障害物を検出していない場合は自動走行を継続して行い、障害物検出装置31が障害物を検出した場合に自動走行を停止する。より具体的には、障害物検出装置31が障害物を検出した場合に、制御装置25は、障害物とトラクタ1との距離が予め定められた距離以下である場合に、トラクタ1の走行を停止することで自動走行を停止する。
図3に示すように、制御装置25は、設定変更部27を備えている。設定変更部27は、制御装置25に設けられた電気回路、電子回路、プログラム等で構成されている。後方障害物検出装置31Bの後方設定情報を変更可能である。
さて、設定変更部27は、前方障害物検出装置31Aの前方設定情報も変更可能である。
設定変更部27は、車体2の走行速度に基づいて検出範囲Q1の大きさを変更する。具体的には、設定変更部27は、車速センサで検出された車体2の車速(走行速度)が走行閾値以上超えると、検知長さL6をデフォルト値(標準検知長さ)よりも長くする変更を行う。即ち、設定変更部27は、検知長さL6をデフォルト値(標準検知長さ)よりも長くすることで検出範囲Q1の大きさを標準検出範囲よりも大きくする。一方、設定変更部27は、走行速度が走行閾値未満になると、検知長さL6をデフォルト値(標準検知長さ)よりも短くする変更を行う。即ち、設定変更部27は、検知長さL6をデフォルト値(標準検知長さ)よりも短くすることで検出範囲Q1の大きさを標準検出範囲よりも小さくする。
設定変更部27は、車体2に連結された作業装置9に応じて、検知長さL5の大きさを変更する。具体的には、検知長さL5のデフォルト値(標準検知長さ)が作業装置9の機械幅W10よりも短い場合、設定変更部27は、検知長さL5を作業装置9の機械幅W10よりも長くする。
設定変更部27は、施肥作業、薬剤作業、耕耘作業が選択された場合は、第2閾値T11をデフォルト値よりも小さくし、施肥作業、薬剤作業、耕耘作業以外の農作業が選択された場合は、第2閾値T11をデフォルト値に設定する。或いは、設定変更部27は、施肥作業、薬剤作業、耕耘作業を行う作業装置9が車体2に連結された場合、第2閾値T11をデフォルト値よりも小さくし、肥作業、薬剤作業、耕耘作業以外を行う作業装置9が車体2に連結された場合、第2閾値T11をデフォルト値に設定する。また、設定変更部27は、施肥作業、薬剤作業、耕耘作業が選択された場合は、検知長さL6の長さをデフォルト値よりも小さくしてもよい。
上述したように、設定変更部27における前方設定情報及び後方設定情報のそれぞれの変更は、走行速度、作業(農作業)、作業装置9の種類に応じて連動して行われてもよいし、それぞれ独立して行ってもよい。図10に示すように、表示装置60に設定画面J2を表示して、設定画面J2において、当該表示装置60を操作することにより、前方設定情報及び後方設定情報のそれぞれの変更に関する設定を行えるとしてもよい。
設定画面J2の第3項目K3において、変更する変更条件[走行速度、作業(農作業)、作業装置9の種類]のそれぞれを選択できるようにしてもよい。この場合、第3項目K3において選択された項目に対応する変更条件[走行速度、作業(農作業)、作業装置9の種類]が、自動走行時に満たされた場合に、設定情報(前方設定情報、後方設定情報)が変更される。
後方設定情報は、障害物として判定する物体M2の大きさを含み、設定変更部27は、作業及び作業装置9のいずれかに基づいて、判定する物体M2の大きさを設定する。これによれば、施肥作業、薬剤作業、耕耘作業など比較的、土埃が発生するような作業である場合に、障害物の誤検知を低減することができる一方で、土埃が発生しないような作業である場合には、障害物の検出の精度を向上させることができる。
2 :車体
8 :連結装置
9 :作業装置
25 :制御装置
27 :設定変更部
31 :障害物検出装置
31A :前方障害物検出装置
31B :後方障害物検出装置
35 :第1時間演算部
36 :第1障害物判定部
Ha1 :検出範囲
M1 :物体
M2 :物体
Q1 :検出範囲
Q2 :検出範囲
T10 :第1閾値
Claims (7)
- 車体と、
前記車体に設けられ且つ作業装置を連結可能な連結装置と、
前記車体を自動走行させる制御装置と、
前記車体の後方の障害物を検出可能な後方障害物検出装置と、
前記後方障害物検出装置において障害物を検出する後方設定情報を変更可能な設定変更部と、
を備えている作業車両。 - 前記後方設定情報は、前記障害物を検出する検出範囲の大きさを含み、
前記設定変更部は、前記検出範囲の大きさを前記車体の走行速度に基づいて変更する請求項1に記載の作業車両。 - 前記設定変更部は、前記検出範囲の大きさを前記車体に連結された前記作業装置に応じて変更する請求項1に記載の作業車両。
- 前記後方設定情報は、前記障害物として判定する物体の大きさを含み、
記設定変更部は、作業及び前記作業装置のいずれかに基づいて、前記判定する物体の大きさを設定する請求項1~3のいずれか1項に記載の作業車両。 - 前記後方障害物検出装置は、
前記障害物を検出する検出範囲内に位置する物体の検出時間を演算する第1時間演算部と、
前記第1時間演算部で演算した検出時間が第1閾値以上である場合に前記物体を障害物として判定する第1障害物判定部と、
を備えている請求項2~4のいずれか1項に記載の作業車両。 - 前記設定変更部は、前記第1閾値を変更する請求項5に記載の作業車両。
- 前記車体の前方の障害物を検出可能な前方障害物検出装置を備え、
前記設定変更部は、前方障害物検出装置において障害物を検出する前方設定情報を変更する請求項1~6のいずれか1項に記載の作業車両。
Priority Applications (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202080080648.8A CN114828616B (zh) | 2019-12-18 | 2020-12-17 | 作业车辆 |
AU2020408764A AU2020408764A1 (en) | 2019-12-18 | 2020-12-17 | Work vehicle |
EP20901456.2A EP4079125A4 (en) | 2019-12-18 | 2020-12-17 | WORK VEHICLE |
KR1020227016481A KR20220111254A (ko) | 2019-12-18 | 2020-12-17 | 작업 차량 |
US17/740,802 US12097866B2 (en) | 2019-12-18 | 2022-05-10 | Working vehicle |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019228668A JP7547044B2 (ja) | 2019-12-18 | 2019-12-18 | 作業車両 |
JP2019-228668 | 2019-12-18 |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
US17/740,802 Continuation US12097866B2 (en) | 2019-12-18 | 2022-05-10 | Working vehicle |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2021125273A1 true WO2021125273A1 (ja) | 2021-06-24 |
Family
ID=76429733
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2020/047171 WO2021125273A1 (ja) | 2019-12-18 | 2020-12-17 | 作業車両 |
Country Status (7)
Country | Link |
---|---|
US (1) | US12097866B2 (ja) |
EP (1) | EP4079125A4 (ja) |
JP (1) | JP7547044B2 (ja) |
KR (1) | KR20220111254A (ja) |
CN (1) | CN114828616B (ja) |
AU (1) | AU2020408764A1 (ja) |
WO (1) | WO2021125273A1 (ja) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7159083B2 (ja) * | 2019-03-06 | 2022-10-24 | 株式会社クボタ | 作業車両 |
JP7482838B2 (ja) | 2021-06-28 | 2024-05-14 | 株式会社クボタ | 作業支援システム |
JP2023110512A (ja) * | 2022-01-28 | 2023-08-09 | 株式会社小松製作所 | 作業機械、作業機械を制御するための方法、及び、作業機械の制御システム |
US20240117604A1 (en) * | 2022-10-05 | 2024-04-11 | Deere & Company | Automatic mode for object detection range setting |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0819A (ja) * | 1988-10-13 | 1996-01-09 | Kawasaki Heavy Ind Ltd | 無人走行装置 |
JP2017211734A (ja) * | 2016-05-24 | 2017-11-30 | ヤンマー株式会社 | 自律走行経路生成システム |
JP2018113937A (ja) | 2017-01-20 | 2018-07-26 | 株式会社クボタ | 自動走行作業車 |
JP2019175048A (ja) * | 2018-03-28 | 2019-10-10 | ヤンマー株式会社 | 作業車両の自動走行装置 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107226088B (zh) * | 2016-03-25 | 2022-03-08 | 松下电器(美国)知识产权公司 | 控制器、驾驶控制方法以及程序 |
JP6701002B2 (ja) * | 2016-06-23 | 2020-05-27 | 株式会社クボタ | 走行支援システム及び作業車 |
JP6837902B2 (ja) * | 2017-04-21 | 2021-03-03 | 株式会社クボタ | 作業車 |
JP6648727B2 (ja) | 2017-03-28 | 2020-02-14 | 井関農機株式会社 | 農作業支援システム |
JP7013170B2 (ja) * | 2017-08-24 | 2022-01-31 | 株式会社クボタ | 作業機 |
JP6945399B2 (ja) * | 2017-09-13 | 2021-10-06 | 株式会社クボタ | 障害物検出装置 |
JP2019114138A (ja) | 2017-12-25 | 2019-07-11 | 井関農機株式会社 | 農作業支援システム |
JP6881417B2 (ja) * | 2018-10-26 | 2021-06-02 | 井関農機株式会社 | 作業車両 |
-
2019
- 2019-12-18 JP JP2019228668A patent/JP7547044B2/ja active Active
-
2020
- 2020-12-17 WO PCT/JP2020/047171 patent/WO2021125273A1/ja unknown
- 2020-12-17 EP EP20901456.2A patent/EP4079125A4/en active Pending
- 2020-12-17 CN CN202080080648.8A patent/CN114828616B/zh active Active
- 2020-12-17 AU AU2020408764A patent/AU2020408764A1/en active Pending
- 2020-12-17 KR KR1020227016481A patent/KR20220111254A/ko unknown
-
2022
- 2022-05-10 US US17/740,802 patent/US12097866B2/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0819A (ja) * | 1988-10-13 | 1996-01-09 | Kawasaki Heavy Ind Ltd | 無人走行装置 |
JP2017211734A (ja) * | 2016-05-24 | 2017-11-30 | ヤンマー株式会社 | 自律走行経路生成システム |
JP2018113937A (ja) | 2017-01-20 | 2018-07-26 | 株式会社クボタ | 自動走行作業車 |
JP2019175048A (ja) * | 2018-03-28 | 2019-10-10 | ヤンマー株式会社 | 作業車両の自動走行装置 |
Non-Patent Citations (1)
Title |
---|
See also references of EP4079125A4 |
Also Published As
Publication number | Publication date |
---|---|
JP2021093984A (ja) | 2021-06-24 |
US12097866B2 (en) | 2024-09-24 |
CN114828616B (zh) | 2024-05-21 |
EP4079125A1 (en) | 2022-10-26 |
CN114828616A (zh) | 2022-07-29 |
US20220266841A1 (en) | 2022-08-25 |
EP4079125A4 (en) | 2023-11-22 |
JP7547044B2 (ja) | 2024-09-09 |
KR20220111254A (ko) | 2022-08-09 |
AU2020408764A1 (en) | 2022-05-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2021125273A1 (ja) | 作業車両 | |
KR102493698B1 (ko) | 작업차 | |
WO2019187937A1 (ja) | 障害物検知システム、及び、作業車両 | |
JP7356829B2 (ja) | 自動走行システム | |
JP7355902B2 (ja) | 作業車両用の自動走行システム及び作業車両の制御方法 | |
JP6615823B2 (ja) | 作業車 | |
JP2019174347A (ja) | 障害物検知システム | |
JP7349277B2 (ja) | 作業車両用の自動走行システム | |
KR20200053659A (ko) | 작업 차량 제어 시스템 | |
JP2018185236A (ja) | 作業車 | |
JP7179638B2 (ja) | 農業機械 | |
WO2020137134A1 (ja) | 作業車両用の衝突回避システム | |
JP2018114924A (ja) | 作業車 | |
JP7470843B2 (ja) | 自動走行システム及び自動走行方法 | |
JP2019175059A (ja) | 作業車両の走行制御システム | |
JP2018114923A (ja) | 作業車 | |
JP2002074436A (ja) | 作業車両の管理システム | |
WO2020166164A1 (ja) | 農業機械 | |
JP2022188155A (ja) | 作業車両用の自動走行システム | |
WO2021199879A1 (ja) | 農業機械 | |
JP7399680B2 (ja) | 作業支援システム | |
US12124264B2 (en) | Work vehicle | |
JP7058679B2 (ja) | 作業車 | |
US20220276656A1 (en) | Work vehicle | |
JP6832716B2 (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: 20901456 Country of ref document: EP Kind code of ref document: A1 |
|
ENP | Entry into the national phase |
Ref document number: 2020408764 Country of ref document: AU Date of ref document: 20201217 Kind code of ref document: A |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
ENP | Entry into the national phase |
Ref document number: 2020901456 Country of ref document: EP Effective date: 20220718 |