Work vehicle

By combining the obstacle detection system of lidar and ultrasonic sensors, and dynamically switching vehicle speed management of detection signals such as fog droplets and raindrops, the problem of degradation of lidar detection performance in bad weather is solved, and the fog, rain and other conditions are realized. Reliable obstacle avoidance control improves the driving safety of the working vehicle.

CN110412978BActive Publication Date: 2024-11-12KUBOTA CORP
View PDF 10 Cites 0 Cited by

Patent Information

Application Number
CN201910332625.0
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Priority Date
2018-04-26
Filing Date
2019-04-24
Publication Date
2024-11-12
Estimated Expiration
2039-04-24

AI Technical Summary

Technical Problem

Under harsh weather conditions such as fog and rain, the obstacle detection performance of the lidar is degraded, resulting in poor obstacle avoidance and control effect, especially when the vehicle speed is high, it is impossible to slow down in time or stop to avoid obstacles.

Method used

Adopt an obstacle detection system combining lidar and ultrasonic sensors. The measurement environment determination unit determines the quality of the measurement environment based on the detection signals of fog droplets, raindrops, etc., dynamically switches the vehicle speed management to respond to the detection capabilities of different sensors, ensuring that the vehicle body is in front of the obstacle. Stop or evade.

Benefits of technology

Under severe weather conditions, obstacle collisions can be reliably avoided, ensuring the safe driving of the working vehicle, and improving the reliability of obstacle detection and vehicle driving safety.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN110412978B_ABST
    Figure CN110412978B_ABST
Patent Text Reader

Abstract

A work vehicle is provided, which can reliably avoid collision with obstacles in a vehicle provided with a laser radar and an ultrasonic sensor for detecting obstacles, regardless of which one is selected. The work vehicle comprises: a first obstacle detection unit, which detects obstacles using a laser radar unit; a second obstacle detection unit, which detects obstacles using an ultrasonic sensor unit; a measurement environment determination unit, which determines the quality of the measurement environment of the laser radar unit; a vehicle speed management unit, which manages a first vehicle speed and a second vehicle speed, the first vehicle speed being a vehicle speed at which the vehicle body can stop in front of the obstacle in response to the detection of the obstacle by the first obstacle detection unit, and the second vehicle speed being a vehicle speed slower than the first vehicle speed at which the vehicle body can stop in front of the obstacle in response to the detection of the obstacle by the second obstacle detection unit; and a driving control unit, which causes the vehicle body to drive at the second vehicle speed if it is determined that the measurement environment is poor while the vehicle body is driven at the first vehicle speed.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to a working vehicle provided with an obstacle sensor for detecting an obstacle that hinders working travel. Background Art

[0002] In the tractor of Patent Document 1, four laser radars with a scanning range of more than 90° are provided as obstacle detection sensors, thereby detecting obstacles in the entire circumference area near the vehicle body. The obstacle detection processing unit that processes the signal from the laser radar calculates the horizontal width of the detected obstacle and the distance of the obstacle from the vehicle body, and outputs obstacle detection information. Based on the obstacle detection information, the driving control unit decelerates or stops the vehicle body, or performs steering to avoid the obstacle. In addition, in this patent document, an obstacle detection sensor using an ultrasonic beam is also proposed as an obstacle detection sensor.

[0003] The laser beam used in the laser radar has good linear propagation and can detect obstacles far away. However, the laser beam will also be reflected by fog droplets, so in the case of thick fog or rain, fog droplets and raindrops will be detected as obstacles, resulting in false detection. Therefore, in the vehicle of patent document 2, there is a laser radar type inter-vehicle distance measuring device (laser radar) installed in front of the vehicle, an ultrasonic radar type inter-vehicle distance measuring device (ultrasonic sensor) installed in front of the vehicle, a fog detection mechanism for detecting fog in front of the vehicle, and an alarm mechanism arranged in the vehicle cabin. When the laser radar type inter-vehicle distance measuring device is working, when the fog detection mechanism detects fog, it switches to the ultrasonic radar type inter-vehicle distance measuring device. If the front vehicle or the front obstacle is measured by the ultrasonic radar type inter-vehicle distance measuring device, an alarm is sounded. That is, when fog occurs, the laser radar is replaced with an ultrasonic radar that is less susceptible to fog droplets, raindrops, etc. than the laser radar. In Patent Document 2, although ultrasonic radar has the disadvantage of having a shorter measurable distance than laser radar, it is considered to be able to avoid dangerously approaching the vehicle ahead or obstacles ahead because the vehicle's driving speed is naturally suppressed to a lower level in fog and rain.

[0004] Patent Document 1: Japanese Patent Application Publication No. 2018-014554

[0005] Patent Document 2: Japanese Patent Application Laid-Open No. 08-184675 Summary of the invention

[0006] Since the ultrasonic radar has a short distance to detect obstacles, even if the ultrasonic radar is used instead of the laser radar when fog or rain occurs, which reduces the obstacle detection performance of the laser radar, as in the vehicle of Patent Document 2, if the vehicle speed is not reduced to a speed suitable for detecting obstacles using the ultrasonic radar, even if an obstacle is detected, it may not be properly avoided. Therefore, in a vehicle equipped with a laser radar and an ultrasonic sensor for detecting obstacles, a working vehicle that can reliably avoid collision with obstacles is urgently desired regardless of which one is selected.

[0007] The work vehicle of the present invention comprises: a vehicle body; a first obstacle detection unit that detects an obstacle based on a radar signal from a laser radar unit; a second obstacle detection unit that detects the obstacle based on a sensor signal from an ultrasonic sensor unit; a measurement environment determination unit that determines the quality of the measurement environment of the laser radar unit; a vehicle speed management unit that manages a first vehicle speed and a second vehicle speed, wherein the first vehicle speed is a vehicle speed that can stop the vehicle body in front of the obstacle in response to the obstacle being detected by the first obstacle detection unit, and the second vehicle speed is a vehicle speed that can stop the vehicle body in front of the obstacle in response to the obstacle being detected by the second obstacle detection unit and is slower than the first vehicle speed; and a travel control unit that, while the vehicle body is being driven at the first vehicle speed, causes the vehicle body to travel at the second vehicle speed when the measurement environment determination unit determines that the measurement environment is poor. Here, the first vehicle speed and the second vehicle speed do not mean only one vehicle speed value, but a plurality of vehicle speed values ​​or a specific vehicle speed value range. For example, assuming that the first vehicle speed includes 5 km / h, 5 km / h, 6 km / h, 5 to 7 km / h, etc., the second vehicle speed includes 2 km / h, 1.5 km / h, 2 km / h, 1 to 2 km / h, etc.

[0008] According to this structure, for example, when the measurement environment determination unit determines that the measurement environment of the laser radar unit is poor to the extent that false detection occurs due to the generation of fog, rain, dust, etc., the driving control unit causes the driving body to travel at the second vehicle speed. The second vehicle speed is a vehicle speed that can stop the vehicle body in front of the obstacle in response to the detection of the obstacle. When the measurement environment of the laser radar unit is good, the working vehicle travels at a first vehicle speed higher than the second vehicle speed, and when the measurement environment of the laser radar unit becomes poor, in order to perform obstacle collision avoidance control using the ultrasonic sensor unit that can only detect obstacles at a short distance compared to the laser radar unit, the vehicle decelerates to a second vehicle speed suitable for performing obstacle collision avoidance control using the ultrasonic sensor unit. In this way, the vehicle body decelerated to the second vehicle speed can stop in front of the obstacle detected by the ultrasonic sensor unit.

[0009] When the measurement environment becomes poor, the possibility of false detection by the laser radar unit is high, so the reliability of the obstacle detection result of the first obstacle detection unit is reduced. Although the obstacle detection result of the first obstacle detection unit and the obstacle detection result of the second obstacle detection unit can be used in combination by reducing the sensitivity of the laser radar unit, it is preferable to temporarily stop using the first obstacle detection unit to detect obstacles. Therefore, in a preferred embodiment of the present invention, when the measurement environment determination unit determines that the measurement environment is poor, the first obstacle detection unit is discontinued to detect obstacles.

[0010] The work vehicle can use the equipped work device to carry out various work driving in various work sites. In particular, in the tillage work in the field, there is a lot of sand and dust (dust), and the sand and dust will cause the measurement environment of the laser radar unit to become poor. Therefore, in a preferred embodiment of the present invention, the measurement environment determination unit determines the quality of the measurement environment based on the detection signal from the dust detector that detects the sand and dust. The dust detector can also be configured to use a laser beam or an ultrasonic beam, so the first obstacle detection unit or the second obstacle detection unit can also have a dust detection function.

[0011] In addition, during the harrowing operation in the paddy field, the splashing water droplets will cause the measurement environment of the laser radar unit to become poor. Of course, in the work vehicle operating in the field, due to meteorological conditions, the measurement environment of the laser radar unit will inevitably become poor due to fog droplets, raindrops, and snow flakes. Therefore, in a preferred embodiment of the present invention, the measurement environment determination unit determines the quality of the measurement environment based on the detection signal from the raindrop detector that detects raindrops. Of course, the measurement environment determination unit can also determine the quality of the measurement environment based on the detection signal from any of the fog droplet detectors that detect fog droplets and the snow flake detectors that detect snow flakes. The raindrop detector, the fog droplet detector, and the snow flake detector can also be constructed to use a laser beam or an ultrasonic beam. The first obstacle detection unit or the second obstacle detection unit can also have such a detection function.

[0012] If it is a manned work vehicle, its driver / if it is an unmanned work vehicle, its monitor can grasp the above-mentioned deterioration of the measurement environment and provide information about the poor measurement environment to the control system of the work vehicle. Therefore, in a preferred embodiment of the present invention, the measurement environment determination unit determines the poor measurement environment based on the operation signal generated by human operation of the human operation element.

[0013] By using image processing technology, it is possible to determine changes in the measurement environment of the laser radar unit based on the captured images of the surroundings of the work vehicle. Therefore, in a preferred embodiment of the present invention, the work vehicle is equipped with an image processing unit, which outputs evaluation data related to the measurement environment based on the image obtained by capturing the measurement environment of the laser radar unit, and the measurement environment determination unit determines the quality of the measurement environment based on the evaluation data. BRIEF DESCRIPTION OF THE DRAWINGS

[0014] Figure 1 It is a side view of a tractor as an example of a work vehicle equipped with an obstacle sensor.

[0015] Figure 2 FIG. 1 is a schematic top view of a tractor showing an obstacle sensor group equipped on the tractor.

[0016] Figure 3 This is a functional block diagram showing a control system of a tractor.

[0017] Figure 4 1 is a flowchart showing the obstacle collision avoidance driving process and the measurement environment determination process.

[0018] Description of Reference Numerals

[0019] 4: First control unit

[0020] 5: Second control unit

[0021] 7: Obstacle sensor group

[0022] 51: Driving control unit

[0023] 55: Vehicle Speed ​​Management Department

[0024] 56: Obstacle detection processing unit

[0025] 561: First obstacle detection unit

[0026] 562: Second obstacle detection unit

[0027] 57: Measurement environment determination department

[0028] 70: Image processing unit

[0029] 71: LiDAR unit

[0030] 72: Ultrasonic sensor unit

[0031] 73: Camera

[0032] 83: Measurement environment detector group

[0033] 831: Raindrop Detector

[0034] 832: Dust detector

[0035] 95: Operation switch DETAILED DESCRIPTION

[0036] Next, an embodiment of a work vehicle having an obstacle collision avoidance function according to the present invention will be described using the accompanying drawings. In this embodiment, the work vehicle is an automatically driven tractor that performs work while traveling in a field (work site).

[0037] like Figure 1 As shown in FIG. 1 , the tractor is provided with a control unit 20 at the center of a vehicle body 1 supported by a front wheel 11 and a rear wheel 12. A working device 30 as a rotary tilling device is provided at the rear of the vehicle body 1 via a hydraulic lifting mechanism 31. The front wheel 11 functions as a steering wheel, and the driving direction of the tractor is changed by changing its steering angle. The steering angle of the front wheel 11 is changed by the operation of a steering mechanism 13. The steering mechanism 13 includes a steering motor 14 for automatic steering. When driving manually, the steering of the front wheel 11 is performed by operating a steering wheel 22 disposed on the control unit 20. A satellite positioning module 80 configured as a GNSS (global navigation satellite system) module is provided in the cabin 21 of the tractor. As a component of the satellite positioning module 80, a satellite antenna for receiving GNSS signals (including GPS signals) is installed in the top area of ​​the cabin 21. In addition, in order to supplement satellite navigation, an inertial navigation module having a gyro acceleration sensor and a magnetic orientation sensor can be combined and assembled in the satellite positioning module 80. Of course, the inertial navigation module may also be located in another location different from the satellite positioning module 80 .

[0038] like Figure 2As shown schematically in FIG. 1 , an obstacle sensor group 7 for detecting obstacles that hinder the driving of the tractor is provided on the body 1 of the tractor. The obstacle sensor group 7 includes a laser radar unit 71, also known as a laser radar, an ultrasonic sensor unit 72, also known as a sonar, and a camera 73. The laser radar should be interpreted in a broad sense, for example, including millimeter wave radars, etc. In addition, the ultrasonic sensor unit 72 includes one or more ultrasonic sensors, and the laser radar unit 71 includes one or more laser radars. In this embodiment, the laser radar unit 71 is provided at the front and rear of the body 1, and two are provided in total. The laser radar unit 71 detects obstacles from short distances to long distances in the forward and backward directions of the body 1. Two ultrasonic sensor units 72 are provided at the front, rear, left, and right of the body 1, and eight are provided in total. The ultrasonic sensor units 72 detect obstacles existing at short distances in the substantially entire circumference of the vicinity of the body 1. The camera 73 is provided at the front, rear, left, and right of the body 1, and four are provided in total, and the entire surrounding area of ​​the body 1 is photographed. The captured images output from the four cameras 73 are used as monitoring images as they are, or as bird's-eye views obtained through viewpoint conversion processing. In addition, the captured images output from the cameras 73 can also be used to detect weather conditions such as rain, fog, and snow, and ground conditions such as sand and dust, which are the measurement environment of the laser radar unit 71.

[0039] Figure 3 The control system constructed in the tractor is shown in FIG. The control system of this embodiment includes a first control unit 4 composed of a general terminal, a second control unit 5 composed of an on-board ECU group, and an input / output signal processing unit 6. The first control unit 4 has functions such as generating a driving route for automatic driving, providing the driver's control instructions to the second control unit 5, managing automatic driving, and exchanging data with a cloud system constructed in a remote place. In addition to the functional unit for performing normal working driving, the second control unit 5 is also constructed with a functional unit for performing obstacle collision avoidance while using the detection results of the obstacle sensor group 7. The input / output signal processing unit 6 is constructed with a functional unit for processing input / output signals used in the working driving of the tractor. The first control unit 4, the second control unit 5, and the input / output signal processing unit 6 are connected to each other through the on-board LAN. Moreover, the satellite positioning module 80 is also connected to the same on-board LAN. The first control unit 4 is a general terminal composed of a tablet computer, etc., so it can also be taken out of the tractor and wirelessly connected to the on-board LAN via the input / output signal processing unit 6.

[0040] The obstacle sensor group 7 is connected to the input / output signal processing unit 6. Figure 3In the embodiment, the camera 73 is connected to the image processing unit 70, and the image processing unit 70 performs processing such as generating a monitoring image based on the captured image obtained by the camera 73, and generating data representing the measurement environment based on the captured image. The processing result of the image processing unit 70 is input to the input / output signal processing unit 6. The image processing unit 70 can be constructed in the input / output signal processing unit 6 or in the camera 73. Moreover, the image processing unit 70 can also be constructed in the general-purpose terminal or the second control unit 5 as the first control unit 4.

[0041] In addition, the input / output signal processing unit 6 is also connected to a vehicle travel device group 91, a working device device group 92, a reporting device group 93, an automatic / manual switching operation member 94, a travel state detection sensor group 81, a working state detection sensor group 82, and a measurement environment detector group 83. The vehicle travel device group 91 includes a steering motor 14 (see Figure 1 ) represents the control devices for the transmission mechanism and the engine unit that are controlled for the vehicle to travel. The working device equipment group 92 includes the control devices for driving the working device 30 and the lifting mechanism 31 (refer to Figure 1 ) control device. The reporting device group 93 includes a display, a speaker, a lamp, a buzzer, etc. that reports the vehicle speed, engine speed, remaining fuel, etc., and issues reports to the driver and the monitor to urge them to pay attention to the operation driving. The automatic / manual switching operation member 94 is a switch for selecting any mode of the automatic driving mode for automatic steering driving and the manual steering mode for manual steering driving. For example, by operating the automatic / manual switching operation member 94 during driving in the automatic steering mode, the driving is switched to the manual steering driving, and by operating the automatic / manual switching operation member 94 during the manual steering driving, the driving is switched to the automatic steering driving. In addition, in this embodiment, there is also an operation switch 95 as a human operating member. When the driver and the monitor recognize that the measurement environment has deteriorated by using the human cognition of the driver, the monitor, etc. on the measurement environment, it is used to provide an operation signal indicating that the measurement environment has deteriorated to the control system of the tractor. The operation switch 95 is also connected to the input / output signal processing unit 6. The operation switch 95 can also be configured as a software switch in the first control unit 4.

[0042] The driving state detection sensor group 81 includes sensors for detecting driving states such as steering angle, engine speed, and gear shifting state. The working state detection sensor group 82 includes a use state detection sensor for detecting the working state of the working device 30 such as posture, ground clearance, and use width. The measurement environment detection sensor group 83 is a general term for detectors for detecting the measurement environment of the laser radar unit 71. Figure 3, a raindrop detector 831 for detecting raindrops and a dust detector 832 for detecting sand (dust) are shown.

[0043] The input / output signal processing unit 6 also includes a communication function unit for exchanging data with an external computer through a wireless communication standard or a wired communication standard, so that the control system of the tractor can exchange data with a management computer of a remote management center, a tablet computer, a smart phone (mobile phone), etc. carried by a driver or a supervisor. In addition, the control system of the tractor can also obtain information that affects the measurement environment, such as weather information, from an external server.

[0044] The universal terminal serving as the first control unit 4 is a tablet computer having a touch panel 40 functioning as a graphical user interface, and is installed with an obstacle sensor determination unit 41 for performing sensor determination processing to determine whether the obstacle sensor group 7 is normal or abnormal, and a display information generation unit 42 for generating display information for various purposes, etc. as application programs.

[0045] The touch panel 40 functions as a graphical user interface, and can report information related to work travel and information related to obstacles to the driver or supervisor in a graphical form.

[0046] The second control unit 5 includes a work travel control unit 50, a travel route setting unit 53, a vehicle position calculation unit 54, a vehicle speed management unit 55, an obstacle detection processing unit 56, and a measurement environment determination unit 57. The travel route setting unit 53 develops a travel route that becomes a travel target route for automatic travel in a memory so that it can be read. The travel route can be generated by the first control unit 4, or a travel route generated on another computer can be downloaded to the second control unit 5 through the input / output signal processing unit 6. The vehicle position calculation unit 54 calculates the coordinate position of the vehicle body 1 on the map based on the positioning data from the satellite positioning module 80 using GPS or the like.

[0047] The work driving control unit 50 includes a driving control unit 51 and a work control unit 52. The driving control unit 51 has an automatic driving control function (automatic driving mode) and a manual driving control function (manual driving mode). If the automatic driving mode is selected, the driving control unit 51 calculates the deviation between the vehicle position from the vehicle position calculation unit 54 and the driving path set by the driving path setting unit 53 during automatic driving, and calculates the steering command and vehicle speed command for reducing the deviation. The work control unit 52 provides the necessary control signals to the work device equipment group 92 according to the vehicle position. If the manual driving mode is selected, the work control unit 52 performs manual driving based on the driver's operation of the steering wheel 22, and the work control unit 52 controls the work device equipment group 92 based on the operation of various operating parts.

[0048] The obstacle detection processing unit 56 includes a first obstacle detection unit 561 that detects an obstacle based on a radar signal from the laser radar unit 71 and a second obstacle detection unit 562 that detects the obstacle based on a sensor signal from the ultrasonic sensor unit 72 .

[0049] The measurement environment determination unit 57 determines the quality of the measurement environment of the laser radar unit 71 based on the detection signals from the measurement environment detector group 83 such as the raindrop detector 831 and the dust detector 832. In addition, if an image recognition function for identifying raindrops, dust, etc. is added to the image processing unit 70, the quality of the measurement environment of the laser radar unit 71 can be determined based on the image recognition result output from the image processing unit 70, that is, the evaluation data related to the measurement environment. The so-called poor measurement environment of the laser radar unit 71 refers to the measurement environment state in which raindrops, water droplets, dust, etc. reflect the laser beam and are mistakenly detected as obstacles.

[0050] When the measurement environment of the laser radar unit 71 becomes bad, it is necessary to rely only on the ultrasonic sensor unit 72 to detect obstacles in front of the vehicle body 1 in the driving direction, but the detection range of the ultrasonic sensor unit 72 is a short distance of about several meters. Therefore, even if an obstacle is detected, the vehicle body 1 cannot stop in front of the obstacle or avoid the obstacle unless the vehicle speed is low. Therefore, the vehicle speed management unit 55 manages the first vehicle speed and the second vehicle speed, the first vehicle speed is the vehicle speed that can stop the vehicle body 1 in front of the obstacle in response to the obstacle detected by the first obstacle detection unit 561, and the second vehicle speed is the vehicle speed that can stop the vehicle body 1 in front of the obstacle in response to the obstacle detected by the second obstacle detection unit 562. The second vehicle speed is set to be lower than the first vehicle speed. In this embodiment, the first vehicle speed during automatic driving is set to 5km / h, and the second vehicle speed is set to 2km / h. In addition, during manual driving, the first vehicle speed is a vehicle speed arbitrarily set within the range below the upper limit suitable for working driving, and the second vehicle speed is a vehicle speed arbitrarily set with 2km / h as the upper limit.

[0051] When the measurement environment determination unit 57 determines that the measurement environment is bad while the vehicle body 1 is traveling at the first vehicle speed, the travel control unit 51 controls the vehicle travel equipment group 91 so that the vehicle body 1 travels at the second vehicle speed.

[0052] During the automatic driving by the driving control unit 51, if an obstacle is detected in the driving direction of the vehicle body 1 by the obstacle detection processing unit 56 during driving, and the distance between the vehicle body 1 and the obstacle falls within a predetermined range, the vehicle body 1 is decelerated and stopped. In principle, the laser radar unit 71 is used to detect obstacles in the driving direction of the vehicle body 1, but when the measurement environment becomes bad as described above, the obstacle is detected by the ultrasonic sensor unit 72 instead of the laser radar unit 71. Since the obstacle detection distance of the ultrasonic sensor unit 72 is short, if the obstacle is detected by the ultrasonic sensor unit 72, the vehicle body 1 is decelerated and stopped immediately.

[0053] Next, use Figure 4 , the obstacle collision avoidance driving process and the measurement environment determination process executed simultaneously with the driving process are described. In this embodiment, when the tractor is started, the obstacle collision avoidance driving control and the measurement environment determination process are also started.

[0054] In the measurement management judgment process, first, the measurement environment judgment is performed by the measurement environment judgment unit 57 (#11). If the judgment result of the measurement environment judgment unit 57 is "good", there is no problem with the obstacle detection of the laser radar unit 71 (#12 "good" branch), then the first vehicle speed is read from the vehicle speed managed by the vehicle speed management unit 55 (#13). If the judgment result of the measurement environment judgment unit 57 is "bad", there is difficulty in obstacle detection of the laser radar unit 71 (#12 "bad" branch), then the second vehicle speed slower than the first vehicle speed is read from the vehicle speed managed by the vehicle speed management unit 55 (#14). The read vehicle speed (first vehicle speed or second vehicle speed) is written to the vehicle speed memory (#15). If the end request of the measurement environment judgment process is issued by turning off the ignition switch of the tractor or by issuing an instruction by the driver to forcibly interrupt the measurement environment judgment process (#16 "yes" branch), the measurement environment judgment process ends. Unless a termination request is issued (#16 "No" branch), the process returns to step #11 and the measurement environment determination process is repeated.

[0055] In the obstacle collision avoidance driving control, first, check whether a driving instruction has been issued (#21), and wait until the driving instruction is issued (#21 "No" branch). If a driving instruction has been issued (#21 "Yes" branch), the vehicle speed is set (#22). In the vehicle speed setting, the vehicle speed (first vehicle speed or second vehicle speed) written to the vehicle speed memory in step #15 of the measurement environment determination process is read, and driving starts with the read vehicle speed as the used vehicle speed (#23). Check whether an obstacle is detected in front of the vehicle body 1 in the direction of travel (#24). If an obstacle is detected (#24 "Yes" branch), obstacle avoidance processing is performed (#25). In the obstacle avoidance processing, the vehicle body 1 is decelerated and stopped, and a warning that an obstacle has occurred is also issued. Moreover, if the obstacle is an animal or a person, the obstacle avoidance processing can be ended by making it move away from the front of the vehicle body 1 in the direction of travel and return to normal driving. If the obstacle is a fixed object, the vehicle can complete the obstacle avoidance process and return to normal driving by performing driving around the obstacle.

[0056] When the obstacle avoidance process is completed, or when no obstacle is detected in the check of step #24 (#24 "No" branch), check whether the driving instruction is still valid (#26). If the driving instruction is still valid (#26 "Yes" branch), return to step #22 and continue the obstacle collision avoidance driving again. If the driving instruction is cancelled (#26 "No" branch), the obstacle collision avoidance driving ends (#27)

[0057] [Other Implementation Methods]

[0058] (1) In the above embodiment, the laser radar unit 71 is composed of two laser radars arranged at the front and rear of the vehicle body 1, and the ultrasonic sensor unit 72 is composed of eight ultrasonic sensors arranged at the front, rear, left and right of the vehicle body 1. This arrangement is an example, and it is sufficient as long as at least one laser radar and one ultrasonic sensor are arranged in the direction of travel of the vehicle body 1.

[0059] (2) In the above embodiment, the first control unit 4 as a universal terminal is fixed to the tractor, but it may be able to be taken out of the tractor. At least one of the vehicle position calculation unit 54, the vehicle speed management unit 55, the obstacle detection processing unit 56, and the measurement environment determination unit 57 may be installed in the first control unit 4 as an application program executed by the first control unit 4.

[0060] (3) In the above embodiment, the raindrop detector 831 and the dust detector 832 are shown as the measurement environment detector group 83, but other detectors such as a fog detector and a grass dust detector may be used. In addition, the measurement environment detector group 83 may be composed of a measurement environment unit composed of a camera and an image recognition device. The measurement environment unit may be used as both the camera 73 and the image processing unit 70 for surrounding monitoring, or may be only an image recognition device as a dedicated device.

[0061] (4) In the above embodiment, a tractor equipped with a tilling device is mentioned as a working vehicle, but the present invention can also be applied to a tractor equipped with a working device 30 other than a tilling device, a combine harvester, a rice transplanter and other agricultural working machines, a construction machine, etc. Furthermore, the above tractor can be driven automatically and manually, but the present invention can also be applied to a tractor that can only be driven manually.

[0062] (5) Figure 3 The division of each functional unit in the functional block diagram is an example for easy understanding of the description, and various functional units can be freely integrated or a single functional unit can be divided into multiple units.

[0063] Industrial Applicability

[0064] The present invention can be applied to a work vehicle equipped with various obstacle sensors.

Claims

1. A working vehicle, characterized in that: have: Car body; a first obstacle detection unit that detects an obstacle based on a radar signal from the laser radar unit; a second obstacle detection section that detects the obstacle based on a sensor signal from the ultrasonic sensor unit; A measurement environment determination unit that determines the quality of the measurement environment of the laser radar unit; a vehicle speed management unit configured to manage a first vehicle speed and a second vehicle speed, wherein the first vehicle speed is a vehicle speed at which the vehicle body can be stopped in front of the obstacle in response to the obstacle being detected by the first obstacle detection unit, and the second vehicle speed is a vehicle speed slower than the first vehicle speed at which the vehicle body can be stopped in front of the obstacle in response to the obstacle being detected by the second obstacle detection unit; a travel control unit configured to, while the vehicle body is being traveled at the first vehicle speed, cause the vehicle body to travel at the second vehicle speed if the measurement environment determination unit determines that the measurement environment is bad; The measurement environment determination unit determines whether the measurement environment is good or bad based on a detection signal from the first obstacle detection unit or the second obstacle detection unit.

2. The work vehicle according to claim 1, characterized in that: When the measurement environment determination unit determines that the measurement environment is bad, the detection of an obstacle by the first obstacle detection unit is interrupted.

3. The working vehicle according to claim 1 or 2, characterized in that: The measurement environment determination unit determines whether the measurement environment is good or bad based on a detection signal from the first obstacle detection unit or the second obstacle detection unit functioning as a dust detector for detecting dust.

4. The working vehicle according to any one of claims 1 to 3, characterized in that: The measurement environment determination unit determines whether the measurement environment is good or bad based on a detection signal from the first obstacle detection unit or the second obstacle detection unit functioning as a raindrop detector for detecting raindrops.

5. The working vehicle according to any one of claims 1 to 4, characterized in that: The measurement environment determination unit determines whether the measurement environment is bad based on an operation signal generated by a human operating a human operating element.

6. The working vehicle according to any one of claims 1 to 5, characterized in that: The work vehicle includes an image processing unit that outputs evaluation data related to the measurement environment based on an image obtained by photographing the measurement environment of the laser radar unit, and the measurement environment determination unit determines the quality of the measurement environment based on the evaluation data.

Citation Information

Patent Citations

  • Warning device of distance between two cars

    JP1996184675A

  • Work vehicle

    JP2018014554A

  • Collimating and beam expanding device for semiconductor laser sources of laser radar

    CN103633557A

  • Forklift automated guided vehicle, control method and control apparatus therefor

    CN104914860A

  • Laser radar apparatus for unmanned aerial vehicle ranging and obstacle avoidance and unmanned aerial vehicle

    CN107367725A