Work vehicles
The work vehicle employs multiple obstacle sensors and tailored control strategies to minimize false detections, ensuring efficient operation by combining sensor strengths and weaknesses, particularly in adverse weather conditions.
Patent Information
- Application Number
- JP2025077809
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2025-05-08
- Publication Date
- 2026-11-19
AI Technical Summary
Existing work vehicles face erroneous obstacle detection due to radio wave reflections from fog droplets or raindrops during heavy weather conditions, leading to inefficient operation.
The work vehicle is equipped with multiple obstacle sensors, including a first and second sensor detecting obstacles in overlapping ranges, with the control unit implementing specific control strategies based on sensor overlap and weather conditions to suppress false detections and ensure efficient operation.
The system effectively reduces false obstacle detections, enhancing safety and efficiency by combining sensor types and control strategies, allowing the vehicle to operate accurately even in adverse weather.
Smart Images

Figure 2026181960000001_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to a work vehicle.
Background Art
[0002] Conventionally, a vehicle in which a target detection means (obstacle sensor) is provided on a machine body is known (refer to Patent Document 1). The vehicle detects an obstacle present in front of the machine body by the obstacle sensor. A lane departure prevention device (control unit) executes steering control based on obstacle detection information. As the obstacle sensor, one using a laser radar has been proposed.
Prior Art Documents
Patent Documents
[0003]
Patent Document 1
Summary of Invention
Problems to be Solved by the Invention
[0004] There is a work vehicle that detects an obstacle present in the vicinity of a traveling vehicle body by an obstacle sensor, and executes deceleration, stopping of the traveling vehicle body, or steering for avoiding the obstacle based on the detected information. Similar to the above-described conventional art, the work vehicle can detect a distant obstacle by using a laser radar or the like as the obstacle sensor. However, since radio waves and the like emitted from the obstacle sensor are also reflected by fog droplets, when the weather is heavy fog or rain, erroneous detection that fog droplets or raindrops are detected as obstacles may occur. Accordingly, there has been a demand for a work vehicle that can suppress erroneous detection of obstacles and perform work efficiently.
[0005] The present invention has been made in view of the above, and an object of the present invention is to provide a work vehicle that can suppress erroneous detection of obstacles and perform work efficiently.
Means for Solving the Problems
[0006] To solve the above-mentioned problems and achieve the objective, the work vehicle (1) according to the embodiment includes a vehicle body (2), a control unit (40) that causes the vehicle body (2) to automatically travel along a travel path, and an obstacle sensor that detects obstacles around the vehicle body (2). The obstacle sensor includes a first obstacle sensor (20) that detects obstacles in a first predetermined range (R1) and a second obstacle sensor (21) that detects obstacles in a second predetermined range (R2). If an obstacle is detected by only one of the first obstacle sensor (20) or the second obstacle sensor (21) in an overlapping range (R3) where the first predetermined range (R1) and the second predetermined range (R2) overlap, the control unit (40) slows down the vehicle body (2) or issues a warning. [Effects of the Invention]
[0007] According to the embodiment of the work vehicle, false detection of obstacles can be suppressed and work can be performed efficiently. [Brief explanation of the drawing]
[0008] [Figure 1] Figure 1 is a schematic left side view of a work vehicle according to this embodiment. [Figure 2] Figure 2 is a block diagram showing an example of a tractor control system. [Figure 3] Figure 3 is a schematic plan view showing the detection range of the obstacle sensor. [Figure 4] Figure 4 is a schematic plan view showing the detection range of the obstacle sensor. [Figure 5] Figure 5 is a schematic plan view showing the detection range of the obstacle sensor. [Figure 6] Figure 6 is a schematic plan view showing the detection range of the obstacle sensor. [Figure 7] Figure 7 is an explanatory diagram of control based on obstacle detection by an obstacle sensor. [Figure 8] Figure 8 is an explanatory diagram of control based on obstacle detection by an obstacle sensor. [Figure 9] Figure 9 is an explanatory diagram of control based on obstacle detection by an obstacle sensor. [Figure 10]Figure 10 is an explanatory diagram of control based on obstacle detection by an obstacle sensor. [Figure 11] Figure 11 is an explanatory diagram of control based on obstacle detection by an obstacle sensor. [Figure 12] Figure 12 is an explanatory diagram of control based on obstacle detection by an obstacle sensor. [Modes for carrying out the invention]
[0009] The embodiments of the work vehicle disclosed herein will be described in detail below with reference to the attached drawings. However, the present invention is not limited to the embodiments described below.
[0010] First, the overall configuration of the work vehicle according to this embodiment will be described with reference to Figure 1. Figure 1 is a schematic left side view of the work vehicle according to this embodiment. In this embodiment, a tractor 1 will be used as an example of the work vehicle.
[0011] The tractor 1, which is a work vehicle, is an agricultural tractor that performs work in fields while moving under its own power. Alternatively, the tractor 1 can be driven by an operator and perform predetermined tasks while moving within the field. The tractor 1 can perform predetermined tasks while automatically moving within the field through the control system, which is centered around the control unit 40 (see Figure 2), described later. In other words, the tractor 1 may be a so-called robotic tractor that can automatically move along a travel path.
[0012] Furthermore, in this embodiment, the front-rear direction refers to the direction of travel when the tractor 1 is moving straight, with the front side of the direction of travel defined as "front" and the rear side as "rear." The direction of travel of the tractor 1 is the direction from the driver's seat 8 (described later) toward the steering wheel 9 when moving straight.
[0013] The left-right direction is the direction perpendicular to the front-back direction. In the following, left and right are defined with respect to the "front" side. That is, with the operator of tractor 1 seated in the driver's seat 8 and facing forward, the left side is "left" and the right side is "right".
[0014] The up-down direction is a direction parallel to the vertical direction. The front-rear direction, the left-right direction, and the up-down direction are mutually orthogonal. Note that each direction is defined for convenience of description, and the present invention is not limited by these directions. Further, in the present embodiment, the tractor 1 may be referred to as the "machine body".
[0015] As shown in Figure 1, the tractor 1 includes a traveling vehicle body 2 and a work machine W. The traveling vehicle body 2 includes a vehicle body frame 3, front wheels 4, rear wheels 5, a hood 6, an engine E, a control section 7, and a transmission case 10. The vehicle body frame 3 is the main frame of the traveling vehicle body 2.
[0016] The front wheels 4 are a pair of left and right wheels, and mainly serve as steering wheels. The rear wheels 5 are a pair of left and right wheels, and mainly serve as drive wheels. The tractor 1 may be configured to be switchable between two-wheel drive (2WD) in which the rear wheels 5 are driven, and four-wheel drive (4WD) in which both the front wheels 4 and the rear wheels 5 are driven. In this case, the drive wheels are both the front wheels 4 and the rear wheels 5. Note that the traveling vehicle body 2 may be provided with crawler devices instead of the wheels (the front wheels 4 and the rear wheels 5). In this case, the traveling crawlers are the drive wheels.
[0017] The hood 6 is provided at the front portion of the traveling vehicle body 2 so as to be openable and closable. The hood 6 can be rotated (opened and closed) in the up-down direction with its rear portion as the rotation center. In the closed state, the hood 6 covers the engine E mounted on the vehicle body frame 3. The engine E is a drive source of the tractor 1, and is a heat engine such as a diesel engine or a gasoline engine.
[0018] The control section 7 is provided at the upper portion of the traveling vehicle body 2, and includes a driver's seat 8, a steering wheel 9, and the like. The control section 7 may be formed by being covered with a cabin 7a provided at the upper portion of the traveling vehicle body 2. The driver's seat 8 is a seat for the operator. The steering wheel 9 is operated by the operator when steering the front wheels 4 which are steering wheels. Note that the control section 7 is provided with a display unit (meter panel) for displaying various types of information in front of the steering wheel 9.
[0019] The control unit 7 is also equipped with various operating levers such as forward / reverse levers, accelerator levers, main transmission levers, and sub-transmission levers, as well as various operating pedals such as accelerator pedals, brake pedals, and clutch pedals.
[0020] The transmission case 10 houses the transmission (speed change mechanism). The transmission appropriately reduces the power (rotational power) transmitted from the engine E and transmits it to the drive wheels, the rear wheels 5, and the PTO (Power Take-off) shaft.
[0021] A work implement W for use in the field is mounted on the rear of the vehicle body 2, and a PTO shaft that transmits power to drive the work implement W protrudes rearward from the transmission case 10. The PTO shaft transmits rotational power, which has been appropriately reduced by the transmission, to the work implement W mounted at least at the rear of the vehicle body 2.
[0022] Furthermore, a lifting device 12 for raising and lowering the work implement W is provided at the rear of the vehicle body 2. The lifting device 12 moves the work implement W to a non-working position by raising it. The non-working position is, for example, the position in which the work implement W is raised when the vehicle body 2 is moving backward or when the vehicle body 2 is turning. The lifting device 12 also moves the work implement W to a ground-level working position by lowering it. The lifting device 12 comprises a hydraulic lifting cylinder 121, a lift arm 122, a lift rod 123, a lower link 124, and a top link 125.
[0023] When hydraulic fluid is supplied to the lifting cylinder 121, the lift arm 122 rotates around the pivot point axis AX to raise the work implement W, and when the hydraulic fluid is discharged from the lifting cylinder 121, it rotates around axis AX to lower the work implement W. A lift arm sensor 26 is provided at the base of the lift arm 122 (near axis AX) to detect the rotation angle of the lift arm 122. The height of the work implement W is calculated based on the detection results of the lift arm sensor 26 and the work implement W.
[0024] Furthermore, the lift arm 122 is connected to the lower link 124 via the lift rod 123. In this way, the lifting device 12 connects the work equipment W to the vehicle body 2 via the lower link 124 and the top link 125 so that it can be raised and lowered.
[0025] The implement W is a machine that performs work in the field. In the example shown in Figure 1, implement W is a rotary tiller that performs tilling work in the field. The rotary tiller tills the field surface by rotating the tilling tines 61 with power transmitted from the PTO shaft.
[0026] Furthermore, the tractor 1 is equipped with a control unit 40 (see Figure 2). The control unit 40 controls the engine E and the travel speed of the vehicle body 2. The control unit 40 also controls the implement W.
[0027] Furthermore, the tractor 1 is equipped with a satellite positioning device 30. The satellite positioning device 30 is mounted on the upper part of the vehicle body 2 and measures the vehicle position (latitude and longitude), which is the position of the vehicle body 2. The satellite positioning device 30 is, for example, a GNSS (Global Navigation Satellite System) and can perform positioning and timing by receiving radio waves from navigation satellites S orbiting in the sky.
[0028] Furthermore, the tractor 1 is equipped with obstacle sensors that detect obstacles around the vehicle body 2. For example, the tractor 1 is equipped with a first obstacle sensor 20 and a second obstacle sensor 21 (see Figure 2) as obstacle sensors. The first obstacle sensor 20 and the second obstacle sensor 21 are provided at the front end of the vehicle body 2, on one and the other sides in the left-right direction. The first obstacle sensor 20 and the second obstacle sensor 21 are positioned symmetrically on either side of the center of the vehicle body 2 in the left-right direction. The first obstacle sensor 20 and the second obstacle sensor 21 may be, for example, millimeter-wave sensors. A millimeter-wave sensor detects obstacles by emitting millimeter waves and receiving radio waves reflected from the obstacle.
[0029] Furthermore, the tractor 1 may also be equipped with a third obstacle sensor 22. The third obstacle sensor 22 is located at the front end of the vehicle body 2, below the first obstacle sensor 20 and the second obstacle sensor 21. The third obstacle sensor 22 may be, for example, an infrared sensor. An infrared sensor detects obstacles by irradiating them with infrared laser light and receiving the reflected light.
[0030] Next, the control system of the tractor 1, centered on the control unit 40, will be described with reference to Figure 2. Figure 2 is a block diagram showing an example of the control system of the tractor 1. As shown in Figure 2, the control unit 40 includes an engine ECU (Electronic Control Unit) 41, a travel system ECU 42, and a work implement lifting system ECU 43. The engine ECU 41 controls the rotational speed of the engine E. The travel system ECU 42 controls the travel speed of the vehicle body 2 (see Figure 1) by controlling the rotation of the drive wheels. The work implement lifting system ECU 43 controls the lifting device 12 to raise and lower the work implement W.
[0031] The control unit 40 is capable of controlling each part by electronic control and includes a processing unit having a CPU (Central Processing Unit), as well as a storage unit that stores necessary data such as various programs and the travel routes of the vehicle 2 that are set in advance for each field.
[0032] As shown in Figure 2, the control unit 40 is connected to various sensors, including a Global Navigation Satellite System (GNSS) 30, an engine speed sensor 23, a vehicle speed sensor 24, a steering angle sensor 25, a first obstacle sensor 20, a second obstacle sensor 21, a third obstacle sensor 22, and a lift arm sensor 26. The engine speed sensor 23 detects the rotational speed of the engine E. The vehicle speed sensor 24 detects the travel speed (vehicle speed) of the vehicle body 2 (see Figure 1). The steering angle sensor 25 detects the steering angle of the front wheels 4 (see Figure 1), which are the steering wheels. The steering angle sensor 25 also detects the turning of the vehicle. The first obstacle sensor 20 detects obstacles in a first predetermined range R1 (see Figures 3 to 5). The second obstacle sensor 21 detects obstacles in a second predetermined range R2 (see Figures 3 and 4). The third obstacle sensor 22 detects obstacles within a third predetermined range R3 (see Figures 4 and 5).
[0033] The control unit 40 receives the following inputs: position information of the vehicle body 2 in a field, etc., from the satellite positioning device 30; engine speed from the engine rotation sensor 23; vehicle speed from the vehicle speed sensor 24; steering angle of the front wheels 4 from the steering angle sensor 25; presence or absence of obstacles from the first obstacle sensor 20; presence or absence of obstacles from the second obstacle sensor 21; presence or absence of obstacles from the third obstacle sensor 22; and height of the implement W from the lift arm sensor 26. When the tractor 1 is to move autonomously, the control unit 40 uses the detection result of the steering angle sensor 25 to automatically steer the steering wheel 9 by controlling the steering cylinder connected to the steering wheel 9 while feeding back the steering angle of the front wheels 4.
[0034] Furthermore, the control unit 40 has an engine ECU 41 connected to the engine E, a drive system ECU 42 connected to the steering system 51, transmission 52, and braking system 53, and a work equipment lifting system ECU 43 connected to the lifting device 12.
[0035] Of these, the work equipment lifting system ECU43 outputs a work equipment lifting signal to the lifting device 12. The lifting device 12 drives the work equipment W up and down based on the work equipment lifting signal output from the work equipment lifting system ECU43.
[0036] Furthermore, the control unit 40 can automatically drive the vehicle body 2 while the implement W performs its work. For example, the control unit 40 has a field map for each field pre-stored in its memory. Also, the control unit 40 has a planned driving route predetermined on the field map according to the work performed by the implement W, which is then digitized and stored in its memory. Based on the measurement results of the satellite positioning device 30, the control unit 40 controls each part, such as the engine E, steering device 51, transmission 52, braking device 53, and lifting device 12, to drive along the stored planned driving route. As a result, the tractor 1 automatically drives along the planned driving route.
[0037] Next, we will explain in detail the obstacle sensors equipped on tractor 1 using Figures 3 to 6. Figures 3 to 6 are schematic plan views showing the detection range of the obstacle sensors.
[0038] As shown in Figure 3, a first predetermined range R1 is located to the left front of the vehicle body 2. The first obstacle sensor 20 detects obstacles within the first predetermined range R1. For example, the first predetermined range R1 has a fan-shaped form in a plan view, extending from the position of the first obstacle sensor 20, centered on the left front.
[0039] A second predetermined range R2 is located to the right front of the moving vehicle body 2. The second obstacle sensor 21 detects obstacles within the second predetermined range R2. For example, in a plan view, the second predetermined range R2 has a fan-shaped form that extends from the position of the second obstacle sensor 21, centered on the right front.
[0040] As shown in Figure 4, a third predetermined range R3 is located in front of the vehicle body 2. The third obstacle sensor 22 detects obstacles in the third predetermined range R3. For example, the third predetermined range R3 is a fan-shaped area that extends from the position of the third obstacle sensor 22 in a plan view, centered on the front. The third predetermined range R3 may also extend to approximately the width of the vehicle body 2 in the left-right direction.
[0041] The first obstacle sensor 20 is installed facing diagonally to the left, not directly in front. The second obstacle sensor 21 is installed facing diagonally to the right, not directly in front. The third obstacle sensor 22 is installed facing directly in front. This allows the tractor 1 to have a wider obstacle detection range and to reduce blind spots in the obstacle detection range.
[0042] Conventionally, to ensure safety ahead, some tractors are equipped with ultrasonic sensors facing forward as obstacle sensors for short-range detection, and infrared sensors or millimeter-wave radar sensors facing forward as obstacle sensors for long-range detection. In such tractors, the area diagonally in front of the front four wheels becomes a blind spot because the obstacle sensors are positioned facing forward. Infrared sensors are highly accurate but susceptible to dust and rain. On the other hand, millimeter-wave radar is resistant to dust and rain but has lower accuracy. Infrared sensors detect obstacles using light, so they cannot detect objects that transmit light, but millimeter-wave radar can sometimes detect objects that transmit light.
[0043] According to the tractor 1 of this invention, the first obstacle sensor 20 and the second obstacle sensor 21 are installed facing diagonally to the left and right forward, rather than facing straight ahead. This reduces blind spots in the obstacle detection range, even with limited installation space. Furthermore, by combining the strengths and weaknesses of obstacle detection from multiple types of sensors, detection accuracy is improved, and safety is enhanced.
[0044] As described above, the tractor 1 may be configured to use millimeter-wave radar sensors for the first obstacle sensor 20 and the second obstacle sensor 21, and an infrared sensor for the third obstacle sensor 22. This allows the tractor 1 to detect obstacles in front (direction of travel) with a more accurate infrared sensor. Furthermore, by using millimeter-wave radar sensors that are less susceptible to noise such as dust in a wide area diagonally to the left and right in front of the tractor 1, the detection range for obstacles can be expanded and detection accuracy can be improved.
[0045] As shown in Figure 4, the tractor 1 may be configured such that the detection ranges of the first obstacle sensor 20, the second obstacle sensor 21, and the third obstacle sensor 22 overlap. The tractor 1 may be configured such that the overlapping detection range of the first obstacle sensor 20 and the third obstacle sensor 22 is defined as overlapping range r1, the overlapping detection range of the second obstacle sensor 21 and the third obstacle sensor 22 is defined as overlapping range r2, the range that only the first obstacle sensor 20 can detect is defined as range r3, the range that only the second obstacle sensor 21 can detect is defined as range r4, and the overlapping range of overlapping range r1 and overlapping range r2 is defined as overlapping range r5. Note that overlapping range r5 is the overlapping range where the first predetermined range R1, the second predetermined range R2, and the third predetermined range R3 overlap.
[0046] As shown in Figure 5, the tractor 1 may be configured to include one of the first obstacle sensor 20 and the second obstacle sensor 21 (for example, the first obstacle sensor 20) and a third obstacle sensor 22. The first obstacle sensor 20 may be configured to face forward. The third predetermined range R3 may be positioned so that it is entirely contained within the first predetermined range R1.
[0047] As shown in Figure 6, the detection range of the obstacle sensor is not particularly limited and may be triangular in plan view. The tractor 1 may be configured such that the detection ranges of the first obstacle sensor 20 and the second obstacle sensor 21 do not overlap. That is, the first predetermined range R1 and the second predetermined range R2 may not overlap.
[0048] Next, using Figures 3, 4, 7, and 12, we will explain the control performed by the control unit 40 when an obstacle is detected. Figures 7 and 12 are explanatory diagrams of the control based on the detection of an obstacle by the obstacle sensor.
[0049] The control unit 40 has three types of control when an obstacle is detected: "hazard detection control," which immediately stops the vehicle 2; "warning detection control," which slows down the vehicle 2 and prepares it to stop at any time; and "warning detection control," which only alerts the surroundings to the danger. The control unit 40 may also issue a warning in the "warning detection control" and "warning detection control."
[0050] Conventionally, there are tractors equipped only with "hazard detection control" and "warning detection control." With the tractor 1 of the present invention, the control unit 40 is equipped with "warning detection control," so instead of immediately executing "hazard detection control," it is possible to decelerate the vehicle body 2 before stopping it with "hazard detection control," thereby shortening the braking distance during emergency stops.
[0051] As shown in Figure 3, an overlapping area R4 is located in front of the vehicle body 2 where the first predetermined area R1 and the second predetermined area R2 overlap. If an obstacle is detected in the overlapping area R4 by only one of the first obstacle sensor 20 or the second obstacle sensor 21, the control unit 40 slows down the vehicle body 2 or issues a warning.
[0052] Specifically, as shown in Figure 7, the control unit 40 may execute "warning detection control" if an obstacle is detected by the first obstacle sensor 20 and no obstacle is detected by the second obstacle sensor 21 in the overlapping range R4. Alternatively, the control unit 40 may execute "warning detection control" if no obstacle is detected by the first obstacle sensor 20 and no obstacle is detected by the second obstacle sensor 21 in the overlapping range R4. As a warning, a warning sound may be output from the audio output unit (not shown) provided in the vehicle body 2.
[0053] With the tractor 1 configured in this way, by performing control specifically for the overlapping detection ranges of the obstacle sensors, it is possible to suppress control such as stopping caused by false detections, and work can be performed efficiently.
[0054] The control unit 40 stops the vehicle 2 if an obstacle is detected by the first obstacle sensor 20 and an obstacle is detected by the second obstacle sensor 21 within the overlapping range R4.
[0055] Specifically, as shown in Figure 7, the control unit 40 may execute "hazard detection control" if an obstacle is detected by the first obstacle sensor 20 and an obstacle is detected by the second obstacle sensor 21 in the overlapping range R4.
[0056] With the tractor 1 configured in this way, it is possible to use only inexpensive sensors (sensors that can detect the presence or absence of obstacles) compared to sensors that can also detect the direction of obstacles, thereby suppressing control such as stopping caused by false detections and enabling efficient work. In addition, the computational load on the control unit 40 can be reduced compared to the case where sensors that can also detect the direction of obstacles are used.
[0057] The first obstacle sensor 20 and the second obstacle sensor 21 may be sensors that detect obstacles using the same detection method. That is, the first obstacle sensor 20 and the second obstacle sensor 21 may be sensors of the same type. As described above, the first obstacle sensor 20 and the second obstacle sensor 21 may be millimeter-wave radar.
[0058] The third obstacle sensor 22 may detect obstacles using a different detection method than the first obstacle sensor 20 and the second obstacle sensor 21. That is, the third obstacle sensor 22 may be a different type of sensor from the first obstacle sensor 20 and the second obstacle sensor 21. As described above, the third obstacle sensor 22 may be an infrared sensor.
[0059] If, within the overlapping range r5, an obstacle is detected by at least one of the first obstacle sensor 20 and the second obstacle sensor 21, and no obstacle is detected by the third obstacle sensor 22, the control unit 40 will decelerate the vehicle 2 or issue a warning.
[0060] Specifically, as shown in Figure 12, the control unit 40 may execute "warning detection control" if, in the overlapping range r5, an obstacle is detected by only one of the first obstacle sensor 20 and the second obstacle sensor 21, and no obstacle is detected by the third obstacle sensor 22. Alternatively, the control unit 40 may execute "warning detection control" if, in the overlapping range r5, an obstacle is detected by both the first obstacle sensor 20 and the second obstacle sensor 21, and no obstacle is detected by the third obstacle sensor 22.
[0061] With the tractor 1 configured in this way, by performing control specifically for the overlapping detection ranges of the obstacle sensors, the strengths and weaknesses of each sensor are combined, suppressing deceleration and stopping due to false detections, and enabling efficient work.
[0062] For example, infrared sensors can detect the shape and position of objects in detail, but they can also react to dust. Millimeter-wave sensors recognize objects ahead by reflecting off objects containing moisture, so they do not react to dust, but they do react to objects containing moisture such as rain. By combining both types of sensors in this way, their weaknesses can be compensated for, enabling more accurate obstacle detection.
[0063] The types of the first obstacle sensor 20 and the second obstacle sensor 21 are not particularly limited, and they may be different types of sensors.
[0064] As shown in Figure 4, the overlapping area r5 is located in front of the vehicle body 2. The width of the overlapping area r5 may be within the range of the width of the vehicle body 2 in the left-right direction.
[0065] With the tractor 1 configured in this way, the accuracy of the front obstacle sensor can be maintained by setting the overlapping range r5 to the front of the vehicle body 2. On the other hand, if an obstacle is detected to the side of the vehicle body 2 (outside the width range of the vehicle body 2 in the left-right direction) by the first obstacle sensor 20 and the second obstacle sensor 21, there is a possibility of false detection due to dust, etc. Therefore, the control unit 40 can decelerate or issue a warning without stopping the vehicle body 2 and prompt the supervisor to confirm, thus enabling efficient work.
[0066] The control unit 40 stops the vehicle body 2 if the vehicle body 2 continues to decelerate for a predetermined period of time. With the tractor 1 configured in this way, if the vehicle body 2 continues to decelerate for a predetermined period of time, it is highly likely that this is not a false detection, and safety can be ensured by stopping the vehicle body 2.
[0067] Specifically, the control unit 40 may switch from "warning detection control" to "danger detection control" if it detects an obstacle by only one of the first obstacle sensor 20 and the second obstacle sensor 21 within the overlapping range R4 for a predetermined period of time. With the tractor 1 configured in this way, the control unit 40 can ensure safety by raising the control level to the safer side, even when there is a high probability that the detection is not a false positive.
[0068] The control unit 40 shortens the predetermined time as the vehicle speed of the vehicle body 2 increases, and lengthens the predetermined time as the vehicle speed of the vehicle body 2 decreases. In other words, the control unit 40 may link the vehicle speed of the vehicle body 2 with the predetermined time. With the tractor 1 configured in this way, it is possible to respond to the fact that the degree of approach to obstacles differs depending on the vehicle speed of the vehicle body 2, and thus control can be performed according to the vehicle speed of the vehicle body 2.
[0069] Next, using Figures 8 to 12, we will explain other controls performed by the control unit 40 when an obstacle is detected. Figures 8 to 12 are explanatory diagrams of the controls based on the detection of an obstacle sensor.
[0070] As shown in Figures 8, 9, and 12, the control unit 40 may execute "warning detection control" if an obstacle is detected only by the third obstacle sensor 22 in the overlapping range r1, r2, r5. Since the infrared sensor used as the third obstacle sensor 22 is more prone to false detections due to dust and other particles than the millimeter-wave radar sensors used as the first obstacle sensor 20 and the second obstacle sensor 21, issuing only a warning (deceleration) instead of stopping the vehicle can reduce the likelihood of the vehicle stopping due to false detections.
[0071] The control unit 40 may switch from "warning detection control" to "danger detection control" if the state in which an obstacle is detected only by the third obstacle sensor 22 in the overlapping range r1, r2, R5 continues for a certain period of time.
[0072] As shown in Figure 10, the control unit 40 may execute "alert detection control" if an obstacle is detected by the first obstacle sensor 20 in range r3 and an obstacle is detected by the third obstacle sensor 22 in overlapping range r1. Also, as shown in Figure 11, the control unit 40 may execute "alert detection control" if an obstacle is detected by the second obstacle sensor 21 in range r4 and an obstacle is detected by the third obstacle sensor 22 in overlapping range r2.
[0073] The control unit 40 may switch from "warning detection control" to "danger detection control" if an obstacle is detected by the first obstacle sensor 20 in range r3 and an obstacle is detected by the third obstacle sensor 22 in the overlapping range r1 for a predetermined period of time. The control unit 40 may also switch from "warning detection control" to "danger detection control" if an obstacle is detected by the second obstacle sensor 21 in range r4 and an obstacle is detected by the third obstacle sensor 22 in the overlapping range r2 for a predetermined period of time.
[0074] As shown in Figures 10 and 11, the control unit 40 may execute "warning detection control" if an obstacle is detected by only the first obstacle sensor 20 or the second obstacle sensor 21 in range r3 or range r4. The control unit 40 may switch from "warning detection control" to "alert detection control" if the state in which an obstacle is detected by only the first obstacle sensor 20 or the second obstacle sensor 21 in range r3 or range r4 continues for a certain period of time.
[0075] As shown in Figure 12, the control unit 40 may execute "hazard detection control" if both types of sensors (millimeter-wave radar sensor and infrared sensor) detect an obstacle in the overlapping range r5.
[0076] The control unit 40 may execute "hazard detection control" if, in the overlapping range r5, an obstacle is detected by both types of sensors (millimeter-wave radar sensor and infrared sensor), and the obstacle is detected by both the first obstacle sensor 20 and the second obstacle sensor 21.
[0077] The control unit 40 may perform "warning detection control" if an obstacle is detected by the third obstacle sensor 22 in the overlapping range r5, and the obstacle is detected by only one of the first obstacle sensor 20 and the second obstacle sensor 21. The control unit 40 may transition from "warning detection control" to "danger detection control" if the state in which an obstacle is detected by the third obstacle sensor 22 in the overlapping range r5, and the obstacle is detected by only one of the first obstacle sensor 20 and the second obstacle sensor 21, continues for a predetermined time.
[0078] As described above, the tractor 1 comprises a vehicle body 2, a control unit 40 that automatically drives the vehicle body 2 along a travel path, and an obstacle sensor that detects obstacles around the vehicle body 2. The obstacle sensor includes a first obstacle sensor 20 that detects obstacles in a first predetermined range R1 and a second obstacle sensor 21 that detects obstacles in a second predetermined range R2. In the overlapping range R4 where the first predetermined range R1 and the second predetermined range R2 overlap, if an obstacle is detected by only one of the first obstacle sensor 20 or the second obstacle sensor 21, the control unit 40 slows down the vehicle body 2 or issues a warning. This allows the tractor 1 to suppress false detection of obstacles and perform work efficiently.
[0079] Furthermore, the control unit 40 stops the vehicle body 2 if an obstacle is detected by the first obstacle sensor 20 and an obstacle is detected by the second obstacle sensor 21 in the overlapping range R4 where the first predetermined range R1 and the second predetermined range R2 overlap. As a result, the tractor 1 can use only inexpensive sensors capable of detecting the presence or absence of obstacles, suppress control such as stopping caused by false detections, and perform work efficiently.
[0080] Furthermore, the first obstacle sensor 20 and the second obstacle sensor 21 are sensors that detect obstacles using the same detection method, and the obstacle sensor includes a third obstacle sensor 22 that detects obstacles in a third predetermined range R3 using a different detection method than the first obstacle sensor 20 and the second obstacle sensor 21. The control unit 40 slows down the vehicle body 2 or issues a warning if, in the overlapping range r5 where the first predetermined range R1, the second predetermined range R2, and the third predetermined range R3 overlap, an obstacle is detected by at least one of the first obstacle sensor 20 and the second obstacle sensor 21, and no obstacle is detected by the third obstacle sensor 22. As a result, the tractor 1 can suppress control due to false detections by performing control specifically for the overlapping range of the obstacle sensor detection ranges, and can perform work efficiently.
[0081] Furthermore, the overlapping range r5 where the first predetermined range R1, the second predetermined range R2, and the third predetermined range R3 overlap is located in front of the vehicle body 2, and the third obstacle sensor 22 detects obstacles in front of the vehicle body 2. As a result, the tractor 1 can maintain the accuracy of the front obstacle sensor by setting the overlapping range r5 in front of the vehicle body 2. On the other hand, if an obstacle is detected to the side of the vehicle body 2 by the first obstacle sensor 20 and the second obstacle sensor 21, there is a possibility of false detection due to dust, etc. Therefore, the control unit 40 can decelerate or issue a warning without stopping the vehicle body 2 and prompt the supervisor to confirm, thus enabling efficient work.
[0082] Furthermore, the control unit 40 stops the vehicle body 2 if the deceleration state of the vehicle body 2 continues for a predetermined period of time. Since it is highly likely that the deceleration state of the vehicle body 2 is not a false detection when it continues for a predetermined period of time, safety can be ensured by stopping the vehicle body 2.
[0083] Furthermore, the control unit 40 shortens the predetermined time as the vehicle speed of the traveling vehicle 2 increases, and lengthens the predetermined time as the vehicle speed of the traveling vehicle 2 decreases. As a result, the tractor 1 can respond to the different degrees of approach to obstacles depending on the vehicle speed of the traveling vehicle 2, and can perform control according to the vehicle speed of the traveling vehicle 2.
[0084] Further effects and modifications can be readily derived by those skilled in the art. Therefore, broader aspects of the present invention are not limited to the specific details and representative embodiments expressed and described above. Accordingly, various modifications are possible without departing from the spirit or scope of the overall concept of the invention as defined by the appended claims and their equivalents. [Explanation of symbols]
[0085] 1 tractor 2. Running vehicle 20. First obstacle sensor 21. Second Obstacle Sensor 22 Third Obstacle Sensor 40 Control Unit R1 First predetermined range R2 Second predetermined range R3 Third predetermined range R4 Overlap range r1 overlapping range r2 overlapping range r3 range r4 range r5 Overlap range
Claims
1. The vehicle body and A control unit that causes the vehicle to automatically travel along a travel path, An obstacle sensor that detects obstacles around the vehicle body, Equipped with, The aforementioned obstacle sensor is A first obstacle sensor that detects the obstacles within a first predetermined range, A second obstacle sensor that detects the obstacles within a second predetermined range, Includes, The control unit, A work vehicle that, in an overlapping area where the first predetermined range and the second predetermined range overlap, slows down the vehicle or issues a warning if an obstacle is detected by only one of the first obstacle sensor or the second obstacle sensor.
2. The control unit, The work vehicle according to claim 1, wherein if an obstacle is detected by the first obstacle sensor and the second obstacle sensor in an overlapping area where the first predetermined range and the second predetermined range overlap, the vehicle body is stopped.
3. The first obstacle sensor and the second obstacle sensor are sensors that detect the obstacle using the same detection method. The obstacle sensor includes a third obstacle sensor that detects obstacles in a third predetermined range by a detection method different from that of the first obstacle sensor and the second obstacle sensor. The control unit, The work vehicle according to claim 2, wherein in an overlapping area where the first predetermined range, the second predetermined range, and the third predetermined range overlap, if an obstacle is detected by at least one of the first obstacle sensor and the second obstacle sensor, and the obstacle is not detected by the third obstacle sensor, the vehicle slows down or issues a warning.
4. The overlapping area where the first predetermined range, the second predetermined range, and the third predetermined range overlap is located in front of the vehicle body. The work vehicle according to claim 3, wherein the third obstacle sensor detects an obstacle in front of the vehicle body.
5. The work vehicle according to any one of claims 1 to 4, wherein the control unit stops the vehicle if the state of decelerating the vehicle continues for a predetermined time.
6. The work vehicle according to claim 5, wherein the control unit shortens the predetermined time in accordance with the speed of the vehicle body and lengthens the predetermined time in accordance with the speed of the vehicle body.
Citation Information
Patent Citations
Lane departure prevention apparatus
JP2014085805A
