Work vehicle control device and work vehicle control method
The work vehicle control system addresses safety and efficiency challenges by adjusting speed based on worker proximity, preventing accidents and stops, thus ensuring safe and efficient operation.
Patent Information
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- NAT AGRI & FOOD RES ORG
- Filing Date
- 2022-10-12
- Publication Date
- 2026-04-20
AI Technical Summary
Existing safety systems for agricultural robots struggle to balance safety and efficiency, as widening the contact hazard area leads to frequent stops due to workers getting too close, while narrowing it compromises safety, and current systems fail to prevent accidents with workers having high safety awareness.
A work vehicle control system that detects changes in the position of workers relative to the vehicle and adjusts the travel speed to prevent contact accidents and frequent stops by increasing or decreasing speed based on worker proximity.
Prevents contact accidents and frequent stops while ensuring safety, allowing for efficient operation by maintaining coordinated speed with worker activity.
Smart Images

Figure 0007847844000001 
Figure 0007847844000002 
Figure 0007847844000003
Abstract
Description
[Technical Field]
[0001] The present invention relates to a work vehicle control device and a work vehicle control method, and is particularly suitable for use in a device and method for controlling the travel and operation of a work machine when a work vehicle equipped with a work machine at the rear automatically travels along a target route. [Background technology]
[0002] In recent years, with the decline in the farming population, there has been a growing demand for highly productive agricultural techniques. In response to this, for example, the development and widespread adoption of autonomous vehicles (hereinafter referred to as robots) that perform predetermined tasks using machinery while autonomously navigating are progressing. Agricultural work includes tasks that are performed solely by robots, as well as tasks that are performed in cooperation with robots and humans. An example of the latter is the task of a worker picking up crops after a robot has dug them up.
[0003] When workers perform tasks in close proximity to a robot in coordination with it, there is a possibility of contact accidents occurring due to the worker getting too close to the robot. Therefore, it is necessary to equip robots with safety features that detect when a worker approaches an area within a predetermined distance from the robot (hereinafter referred to as the "contact hazard area") and stop the work machine. Here, determining the size of the contact hazard area is one of the important considerations from the perspective of both safety and work efficiency.
[0004] However, if the contact hazard area is widened from a safety perspective, frequent stops of the work machine due to workers getting too close to the robot will occur, reducing work efficiency. Also, if the robot and worker are too far apart, it becomes difficult for the worker to check the robot's operation, and if robot malfunctions or work errors are not detected promptly, work efficiency will decrease. On the other hand, if the contact hazard area is narrowed from a work efficiency perspective, there is a risk that sufficient safety cannot be guaranteed.
[0005] Furthermore, a safety system is known that improves the safety of people other than specific workers while preventing the occurrence of excessive warnings and improving the work efficiency of work vehicles (see, for example, Patent Document 1). In the safety system described in Patent Document 1, specific workers (workers with high safety awareness who have received safety training) working within a warning area around the work vehicle are identified, these identified specific workers are set as exempt from warnings, and when a person subject to warning (a worker or visitor with low safety awareness) is detected within the warning area, a warning is issued to the driver of the work vehicle.
[0006] The safety system described in Patent Document 1 allows for the warning of the driver of a work vehicle when a worker or visitor with low safety awareness enters the warning area, enabling the driver to take hazard avoidance measures such as manually stopping the work equipment. However, if the warning area is widened to prioritize safety, there is a risk that warnings will occur frequently, reducing work efficiency. On the other hand, if the warning area is narrowed to prioritize work efficiency, there is a risk that sufficient safety cannot be guaranteed. Furthermore, the safety system described in Patent Document 1 does not warn workers with high safety awareness, so it cannot prevent contact accidents caused by workers with high safety awareness getting too close to work vehicles. [Prior art documents] [Patent Documents]
[0007] [Patent Document 1] Japanese Patent Publication No. 2020-125171 [Overview of the project] [Problems that the invention aims to solve]
[0008] This invention was made to solve the problems described above, and aims to improve work efficiency by preventing frequent stopping of work equipment due to workers approaching the work vehicle, while ensuring sufficient safety. [Means for solving the problem]
[0009] In order to solve the above problems, in the present invention, a change in the distance or relative position state of an operator working behind a work vehicle from the work vehicle is detected, and the traveling speed of the work vehicle is controlled according to the detected change in state.
Effects of the Invention
[0010] According to the present invention configured as described above, when an operator approaches a contact risk area (an area where the work machine stops when the operator enters), the traveling speed can be controlled so that the work vehicle moves away from the operator. Therefore, even if the contact risk area is not widened, it is possible to prevent the occurrence of contact accidents caused by the operator approaching the work vehicle too closely. In addition, it is possible to prevent the work machine from frequently stopping due to the operator entering the contact risk area. Thus, according to the present invention, while ensuring sufficient safety, it is possible to prevent the work machine from frequently stopping due to the operator approaching the work vehicle and improve work efficiency.
Brief Description of the Drawings
[0011] [Figure 1] It is a diagram showing a work vehicle equipped with a work vehicle control device according to the first embodiment and an operator working behind it. [Figure 2] It is a block diagram showing a functional configuration example of a work vehicle control device according to the first embodiment. [Figure 3] It is a diagram for explaining an area and an operation example in the first embodiment. [Figure 4] It is a diagram showing a modified example of the area in the first embodiment. <000UUI08> [Figure 5] It is a block diagram showing a functional configuration example of a work vehicle control device according to a second modified example with respect to the first embodiment. [Figure 6] It is a diagram for explaining an area and an operation example according to a second modified example with respect to the first embodiment. [Figure 7] It is a diagram for explaining an area and an operation example in the second embodiment. It should be noted that in the above translation, for item 14, since the original text is " ", it is directly retained in the translation as " " as required. And for item 28, the original text is " ", but in the translation, it is written as "<000UUI08>" which seems to be a misrepresentation. It should be corrected to " ". [Figure 8] This block diagram shows an example of the functional configuration of a work vehicle control device according to the second embodiment. [Figure 9] This is a block diagram showing an example of the functional configuration of a work vehicle control device according to a second modification of the second embodiment. [Figure 10] This figure illustrates an area and operation example according to a second modification of the second embodiment. [Figure 11] This is a block diagram showing an example of the functional configuration of a work vehicle control device according to a third modification of the second embodiment. [Figure 12] This is a block diagram showing an example of the functional configuration of a work vehicle control device according to a fourth modification of the second embodiment. [Figure 13] This figure illustrates an area and operation example according to a fourth modification of the second embodiment. [Figure 14] This figure shows a modified area according to a fourth modification of the second embodiment. [Figure 15] This is a block diagram showing an example of the functional configuration of a work vehicle control device according to the third embodiment. [Figure 16] This is a diagram illustrating an example of operation according to the third embodiment. [Figure 17] This flowchart shows an example of the process from start to finish. [Modes for carrying out the invention]
[0012] (First Embodiment) Hereinafter, a first embodiment of the present invention will be described with reference to the drawings. Figure 1 shows a work vehicle 100 equipped with a work vehicle control device 10 according to the first embodiment, and a worker 200 working behind it.
[0013] As shown in Figure 1, the work vehicle 100 is equipped with a work implement 102 at the rear of the vehicle body 101, and a work vehicle control device 10, a rear camera 103, and a front camera 104 are mounted on the vehicle body 101. The work performed by the work implement 102 can be any type of work, as long as it is carried out in coordination with the work performed by the worker 200 at the rear. For example, the work performed by the work implement 102 may be harvesting or sowing in a field.
[0014] The rear camera 103 is a camera that photographs the area behind the work vehicle 100, including the area where the worker 200 would normally be located during work. The images acquired by the rear camera 103 are supplied to the work vehicle control device 10 and used to detect the distance from the work vehicle 100 to the worker 200 or the relative position of the worker 200 with respect to the work vehicle 100. Although the rear camera 103 is used as a means of detecting distance or relative position, it is not limited to this. For example, a laser radar such as LiDAR, millimeter-wave radar, etc. may be used instead of or in addition to the rear camera 103.
[0015] The front camera 104 is a camera that photographs the area in front of the work vehicle 100. The images captured by the front camera 104 are supplied to the work vehicle control device 10 and used to detect obstacles in front of the work vehicle 100.
[0016] The work vehicle control device 10 controls the movement of the work vehicle 100 and the operation of the work implement 102 when the work vehicle 100 is automatically driven along a pre-set target route in the field. For example, the work vehicle control device 10 is equipped with a function to detect the current position and orientation of the work vehicle 100, and based on the continuously detected current position and orientation, it automatically drives the work vehicle 100 along a pre-set target route in the field. The work vehicle control device 10 also controls the operation of the work implement 102 according to the work position on the target route.
[0017] In this embodiment, the work vehicle control device 10 performs a characteristic process in which it controls the travel speed of the work vehicle 100 in accordance with changes in the distance or relative position of the worker 200 working behind the work vehicle 100. The details of this characteristic process will be described sequentially below.
[0018] Figure 2 is a block diagram showing an example of the functional configuration of the work vehicle control device 10 according to the first embodiment. As shown in Figure 2, the work vehicle control device 10 according to the first embodiment includes a state change detection unit 11, a travel speed control unit 12, and a notification unit 13 as its functional configuration. Here, only the functional configuration related to the characteristic processing described above is shown, and the functional configuration related to the automatic travel of the work vehicle 100 and the automatic control of the work machine 102 is not shown. This is also the case for each embodiment and each modification described below.
[0019] The functional blocks 11-13 shown in Figure 2 can be configured using hardware, a DSP (Digital Signal Processor), or software. For example, when configured using software, functional blocks 11-13 are actually configured using a computer's CPU, RAM, ROM, etc., and are realized by the operation of programs stored in storage media such as RAM, ROM, hard disk, or semiconductor memory.
[0020] The state change detection unit 11 detects changes in the distance or relative position of the worker 200 working behind the work vehicle 100. In this embodiment, the state change detection unit 11 detects changes in the relative position of the worker 200 with respect to the work vehicle 100 (more precisely, the rear camera 103 mounted on the work vehicle 100) (hereinafter simply referred to as "the position of the worker 200"). That is, the state change detection unit 11 sequentially detects the position of the worker 200 at predetermined time intervals based on the captured images input from the rear camera 103 at predetermined time intervals, and detects the change in the state of the position detected at each predetermined time interval.
[0021] In this embodiment, the position state refers to the state of where the worker 200 is located within the area described later. A change in the position state means a change in the area in which the worker 200 is located. Figure 3 is a diagram illustrating the area and operation example in the first embodiment. As shown in Figure 3, in the first embodiment, the contact hazard area 301 and the work area 302 are set in order from the side closest to the work vehicle 100. The contact hazard area 301 and the work area 302 are rectangular areas set behind the work vehicle 100.
[0022] The contact hazard area 301 is the area in which the work vehicle control device 10 stops the work machine 102 when it detects that a worker 200 has entered, and it is set to be the area in contact with the work machine 102. In the example in Figure 3, the contact hazard area 301 is set to be a rectangular area that is wider than the width of the work machine 102, and the distance from the rear end of the work machine 102 to the rear of the work vehicle 100 is the first distance d1. In the following explanation, when referring to the distance from the work vehicle 100, it means the distance from the work vehicle 100 to the rear (in a direction parallel to the direction of travel).
[0023] The work area 302 is an area where the worker 200 is expected to be able to work safely behind the work vehicle 100, and is set further away from the contact hazard area 301. In the example in Figure 3, the work area 302 is set as the range of the rectangular area set from the rear end of the work machine 102 to the rear of the work vehicle 100, excluding the contact hazard area 301, in a manner that is wider than the contact hazard area 301. In other words, the work area 302 is set further away from the contact hazard area 301 in a manner that surrounds the contact hazard area 301.
[0024] The work area 302 includes an approach area 302A, a normal area 302S, and a retreat area 302R. In this embodiment, the area of the work area 302 that is farther away from the contact hazard area 301 and adjacent to the contact hazard area 301 (in the example of Figure 3, the area where the distance from the work vehicle 100 is 1st distance d1 or more and less than 2nd distance d2) is designated as the approach area 302A, the area that is farther away from the approach area 301A and adjacent to the approach area 301A (in the example of Figure 3, the area where the distance from the work vehicle 100 is 2nd distance d2 or more and less than 3rd distance d3) is designated as the normal area 302S, and the area that is farther away from the approach area 302A, separated by the normal area 302S (in the example of Figure 3, the area where the distance from the work vehicle 100 is 3rd distance d3 or more) is designated as the retreat area 302R.
[0025] The approach area 302A is an area for detecting when worker 200 is approaching the contact hazard area 301. The normal area 302S is an area where worker 200 is assumed to be performing work normally. The reverse area 302R is an area for detecting when worker 200 is unable to keep up with the work vehicle 100 and is reversing.
[0026] Note that Figure 3 shows an example where the boundaries of the contact risk area 301, approach area 302A, normal area 302S, and retreat area 302R are set in a straight line, but the example is not limited to this. For example, as shown in Figure 4, the boundaries may be set in an arc shape.
[0027] The travel speed control unit 12 controls the travel speed of the work vehicle 100 in accordance with the state change of relative position detected by the state change detection unit 11. In this embodiment, as shown by arrow Y1 in Figure 3, when the state change detection unit 11 detects a state change in the worker 200 from being in the normal area 302S to being in the approach area 302A, the travel speed control unit 12 increases the travel speed of the work vehicle 100. For example, the amount of increase in travel speed may be set in advance, and the travel speed control unit 12 increases the travel speed of the work vehicle 100 by that amount.
[0028] Furthermore, in this embodiment, the travel speed control unit 12 reduces the travel speed of the work vehicle 100 when the state change detection unit 11 detects a state change in which the worker 200 changes from being in the normal area 302S to being in the reverse area 302R, as shown by the arrow Y2 in Figure 3. For example, the amount of reduction in travel speed may be set in advance, and the travel speed control unit 12 reduces the travel speed of the work vehicle 100 by that amount.
[0029] Here, the travel speed control unit 12 changes the travel speed of the work vehicle 100 in response to the worker 200 changing from being in the normal area 302S to being in the approach area 302A or the reverse area 302R, and then maintains the changed travel speed. That is, after changing the travel speed as described above, even if the state change detection unit 11 detects a state change in which the worker 200 returns from being in the approach area 302A or the reverse area 302R to being in the normal area 302S (a state change in the opposite direction of arrow Y1 or arrow Y2), the travel speed control unit 12 does not change the travel speed at that time, but maintains the travel speed that was changed according to the state changes of arrows Y1 and Y2 as described above.
[0030] The notification unit 13 notifies the worker 200 when the speed control unit 12 changes the speed of the work vehicle 100. For example, when the speed control unit 12 increases the speed of the work vehicle 100, the notification unit 13 makes an audible notification to inform the worker that the speed will be increased. In addition to the audible notification, the unit may also illuminate a lamp or the like in a manner corresponding to the increase in speed. Similarly, when the speed control unit 12 decreases the speed of the work vehicle 100, the notification unit 13 makes an audible notification to inform the worker that the speed will be decreased. In addition to the audible notification, the unit may also illuminate a lamp or the like in a manner corresponding to the decrease in speed.
[0031] As described above, in the first embodiment, a change in the relative position of a worker 200 working behind the work vehicle 100 is detected, and the travel speed of the work vehicle is controlled according to the detected change in state. Specifically, when the state change detection unit 11 detects that the worker 200 has entered the approach area 302A, the travel speed control unit 12 increases the travel speed of the work vehicle 100.
[0032] With this embodiment configured, when a worker 200 enters the approach area 302A adjacent to the contact hazard area 301, that is, when the worker 200 approaches the contact hazard area 301, the work vehicle 100 can increase its speed and move away from the worker 200. Therefore, even without widening the contact hazard area 301, it is possible to prevent contact accidents caused by the worker 200 getting too close to the work vehicle 100. In addition, it is possible to prevent frequent stopping of the work machine 102 due to the worker 200 entering the contact hazard area 301. Thus, with this embodiment, it is possible to improve work efficiency by preventing frequent stopping of the work machine 102 due to the worker 200 approaching the work vehicle 100 while ensuring sufficient safety.
[0033] Furthermore, in this embodiment, when the state change detection unit 11 detects that the worker 200 has entered the reversing area 302R, the travel speed control unit 12 reduces the travel speed of the work vehicle 100. With this configuration, if the work performed by the worker 200 lags behind the travel speed of the work vehicle 100 and the worker 200 enters the reversing area 302R, the travel speed can be reduced to prevent the work vehicle 100 from moving any further away from the worker 200. This makes it possible to coordinate the work performed by the work machine 102 and the work performed by the worker 200 in a good manner.
[0034] In this context, in this embodiment, after changing the travel speed of the work vehicle 100 in response to the state changes indicated by arrows Y1 and Y2 in Figure 3, the travel speed after the change is maintained. This ensures that the work vehicle 100 travels at a speed that is coordinated with the work speed of the worker 200. For example, if the travel speed of the work vehicle 100 is increased by one level in response to the worker 200 entering the approach area 302A, and then the worker 200 returns to the normal area 302S, and then the worker 200 enters the approach area 302A again, the travel speed of the work vehicle 100 is increased by another level. If the worker 200 remains in the normal area 302S in this state, the travel speed increased by two levels is maintained. This travel speed can be said to be a speed that is coordinated with the work speed of the worker 200, and a travel speed that is easy for the worker 200 to work at is maintained.
[0035] The following describes some variations related to the first embodiment.
[0036] (First variation) In the first embodiment described above, a reversing area 302R is set within the work area 302, and an example is shown in which the travel speed of the work vehicle 100 is reduced when the worker 200 enters the reversing area 302R. However, this process may be omitted. It is preferable to perform this process in order to coordinate the travel speed of the work vehicle 100 with the work speed of the worker 200. However, even without performing this process, it is possible to prevent contact accidents between the work vehicle 100 and the worker 200, and to prevent the work machine 102 from frequently stopping due to the worker 200 entering the contact hazard area 301.
[0037] (Second variation) Figure 5 shows a work vehicle control device 10 according to a second modified example. -2 This is a block diagram showing an example of the functional configuration. In Figure 5, components with the same reference numerals as those shown in Figure 2 have the same function, so redundant explanations are omitted here. As shown in Figure 5, the work vehicle control device 10 according to the second modified example -2As a functional configuration, instead of the state change detection unit 11, the traveling speed control unit 12, and the notification unit 13, it includes the state change detection unit 11 -2 , the traveling speed control unit 12 -2 and the notification unit 13 -2 .
[0038] FIG. 6 is a diagram for explaining an area and an operation example according to a second modification. As shown in FIG. 6, in the second modification, the work area 302 further includes a work delay area 302L in addition to the approach area 302A, the normal area 302S, and the retreat area 302R. In the example shown in FIG. 6, the retreat area 302R is an area where the distance from the work vehicle 100 is equal to or greater than the third distance d3 and less than the fourth distance d4. The work delay area 302L is an area further away from the retreat area 302R (an area where the distance from the work vehicle 100 is equal to or greater than the fourth distance d4).
[0039] The traveling speed control unit 12 -2 increases the traveling speed of the work vehicle 100 when a state change in which the operator 200 changes from being in the normal area 302S to being in the approach area 302A is detected by the state change detection unit 11 -2 . Also, the traveling speed control unit 12 decreases the traveling speed of the work vehicle 100 when a state change in which the operator 200 changes from being in front of the retreat area 302R within the work area 302 to being in the retreat area 302R is detected by the state change detection unit 11 -2 . The above control is the same as that in the first embodiment.
[0040] Furthermore, the traveling speed control unit 12 -2 increases the traveling speed of the work vehicle 100 when a state change in which the operator 200 changes from being in the retreat area 302R to being in the work delay area 302L is detected by the state change detection unit 11 -2When detected, the work vehicle 100 is stopped (the work vehicle 100's speed is reduced to zero). In other words, if worker 200 has moved backward to the work delay area 302L, there is a possibility that work is delayed, so the work vehicle 100 is stopped. With this configuration, if worker 200 is actually behind schedule, the work vehicle 100 can be stopped, and after worker 200 has made some progress on their work, the work vehicle 100 can resume moving.
[0041] Hochi Department 13 -2 The driving speed control unit 12 -2 In addition to increasing and decreasing the speed of the work vehicle 100, the system also provides notification when the vehicle stops moving. For example, notification unit 13 -2 The driving speed control unit 12 -2 When the vehicle 100 stops moving, it provides an audio notification to indicate that it is stopping. In addition to the audio, it may also provide illumination of a lamp or the like in a manner corresponding to the stopping of movement.
[0042] (Second embodiment) Next, a second embodiment of the present invention will be described with reference to the drawings. In the first embodiment described above, an example was described in which one work area 302 is set up. In contrast, in the second embodiment, two work areas are set up: one for skilled workers and one for beginners. That is, the second embodiment is based on the premise that skilled workers and beginners work together.
[0043] Figure 7 is a diagram illustrating the areas and operation examples in the second embodiment. As shown in Figure 7, in the second embodiment, the contact hazard area 301, the skilled worker area 303, and the novice worker area 304 are set up in order from the side closest to the work vehicle 100. The contact hazard area 301, the skilled worker area 303, and the novice worker area 304 are rectangular areas set up behind the work vehicle 100. Of these, the contact hazard area 301 is the same as that shown in Figure 3.
[0044] The skilled worker area 303 is an area where skilled workers 201 are expected to be able to work safely behind the work vehicle 100, and is set further away from the contact hazard area 301. The skilled worker area 303 includes the skilled worker approach area 303A, the skilled worker normal area 303S, and the skilled worker retreat area 303R. These are the same as the approach area 302A, normal area 302S, and retreat area 302R shown in Figure 6.
[0045] Specifically, the area adjacent to the contact hazard area 301, but at a distance from the contact hazard area 301 (in the example in Figure 7, the area where the distance from the work vehicle 100 is 1st distance d1 or more and less than 2nd distance d2), is the skilled worker approach area 303A. Also, the area adjacent to the skilled worker approach area 303A, but at a distance from the skilled worker approach area 303A (in the example in Figure 7, the area where the distance from the work vehicle 100 is 2nd distance d2 or more and less than 3rd distance d3), is the skilled worker normal area 303S. Furthermore, the area at a distance from the skilled worker approach area 303A, separated by the skilled worker normal area 303S (in the example in Figure 7, the area where the distance from the work vehicle 100 is 3rd distance d3 or more and less than 4th distance d4), is the skilled worker retreat area 303R.
[0046] The skilled worker approach area 303A is an area for detecting when a skilled worker 201 is approaching the contact hazard area 301. The skilled worker normal area 303S is an area where it is assumed that the skilled worker 201 is performing work normally. The skilled worker retreat area 303R is an area for detecting when the skilled worker 201 is unable to keep up with the work vehicle 100 and is retreating.
[0047] The beginner work area 304 is an area where it is assumed that a novice worker 202 can safely perform work behind the work vehicle 100, and is set behind the skilled worker work area 303. The beginner work area 304 includes a beginner approach area 304A, a beginner normal area 304S, and a beginner retreat area 304R. In this embodiment, the beginner approach area 304A is defined as the area of the beginner work area 304 that is further away from the skilled worker work area 303 and adjacent to the skilled worker work area 303 (in the example in Figure 7, the area where the distance from the work vehicle 100 is 4th distance d4 or more and less than 5th distance d5). The beginner normal area 304S is defined as the area further away from the beginner approach area 304A and adjacent to the beginner approach area 304A (in the example in Figure 7, the area where the distance from the work vehicle 100 is 5th distance d5 or more and less than 6th distance d6). Furthermore, the area located further away from the beginner approach area 304A, separated from the beginner normal area 304S (in the example in Figure 7, the area where the distance from the work vehicle 100 is 6th distance d6 or more), is designated as the beginner retreat area 304R.
[0048] The beginner approach area 304A is an area for detecting when a novice worker 202 is approaching the skilled worker area 303. The beginner normal area 304S is an area where it is assumed that the novice worker 202 is performing work normally. The beginner reverse area 304R is an area for detecting when the novice worker 202 is unable to keep up with the work vehicle 100 and is reversing.
[0049] Note that while Figure 7 shows an example where the boundaries of each area are set as straight lines, this is not the only option. For example, the boundaries may be set as arcs, similar to Figure 4.
[0050] Figure 8 is a block diagram showing an example of the functional configuration of the work vehicle control device 20 according to the second embodiment. The work vehicle control device 20 according to the second embodiment is mounted on the work vehicle 100 in place of the work vehicle control device 10 shown in Figure 1. As shown in Figure 8, the work vehicle control device 20 according to the second embodiment has a functional configuration that includes a state change detection unit 21, a travel speed control unit 22, and a notification unit 23.
[0051] These functional blocks 21-23 can be configured using hardware, a DSP, or software. For example, when configured using software, functional blocks 21-23 are actually configured using a computer's CPU, RAM, ROM, etc., and are realized by the operation of programs stored in storage media such as RAM, ROM, hard disk, or semiconductor memory.
[0052] The state change detection unit 21 detects changes in the distance or relative position of the skilled worker 201 and the novice worker 202, who are working behind the work vehicle 100. In this embodiment, the state change detection unit 21 detects changes in the relative position of the workers 201 and 202 with respect to the work vehicle 100.
[0053] The travel speed control unit 22 controls the travel speed of the work vehicle 100 in accordance with the state change of relative position detected by the state change detection unit 21. In this embodiment, as shown by arrow Y1 in Figure 7, when the state change detection unit 21 detects a state change in which the skilled worker 201 changes from being in the skilled worker normal area 303S to being in the skilled worker approach area 303A, or when the state change detection unit 21 detects a state change in which the novice worker 202 changes from being in the beginner normal area 304S to being in the beginner approach area 304A, the travel speed control unit 22 increases the travel speed of the work vehicle 100 by a predetermined amount.
[0054] Furthermore, in this embodiment, as shown by arrow Y2 in Figure 7, when the state change detection unit 21 detects a change in the state of skilled worker 201 from being in the skilled worker normal area 303S to being in the skilled worker reverse area 303R, or when the state change detection unit 21 detects a change in the state of novice worker 202 from being in the beginner normal area 304S to being in the beginner reverse area 304R, the travel speed control unit 22 reduces the travel speed of the work vehicle 100 by a predetermined reduction amount.
[0055] In the second embodiment, since the skilled worker 201 and the novice worker 202 perform the work simultaneously, it is possible that a change in state that causes an increase in the travel speed of the work vehicle 100 (a change in state indicated by arrow Y1 in Figure 7) and a change in state that causes a decrease in the travel speed of the work vehicle 200 (a change in state indicated by arrow Y2 in Figure 7) may occur simultaneously. In this case, the travel speed control unit 22 prioritizes increasing the travel speed of the work vehicle 100 from the viewpoint of prioritizing safety.
[0056] Furthermore, if a change in state occurs simultaneously in the skilled worker area 303 and the novice worker area 304, the travel speed of the work vehicle 100 may be controlled by prioritizing the change in state that occurred in the skilled worker area 303.
[0057] In this embodiment as well, after the travel speed control unit 22 changes the travel speed of the work vehicle 100 in response to the skilled worker 201 changing from being in the skilled worker normal area 303S to being in the skilled worker approach area 303A or the skilled worker reverse area 303R, even if the state change detection unit 21 detects a change in the skilled worker 201's state from being in the skilled worker approach area 303A or the skilled worker reverse area 303R back to being in the skilled worker normal area 303S, the travel speed control unit 22 does not change the travel speed at that time and maintains the travel speed after the change. Similarly, the travel speed control unit 22 changes the travel speed of the work vehicle 100 in response to a change in the state of the novice worker 202 from being in the beginner normal area 304S to being in the beginner approach area 304A or the beginner reverse area 304R. Even if the state change detection unit 21 detects a change in the state of the novice worker 202 from being in the beginner approach area 304A or the beginner reverse area 304R back to being in the beginner normal area 304S, the control unit maintains the travel speed after the change.
[0058] The notification unit 23 notifies workers 201 and 202 when the travel speed control unit 22 changes the travel speed of the work vehicle 100. The operation of this notification unit 23 is the same as the operation of the notification unit 13 described in the first embodiment.
[0059] As explained above, in the second embodiment, the area adjacent to the contact hazard area 301 is set as the skilled worker work area 303, and the beginner work area 304 is set further away from the skilled worker work area 303, so that the skilled worker 201 works in the skilled worker work area 303 and the beginner worker 202 works in the beginner work area 304. For this reason, the beginner worker 202 will basically be working at a position away from the contact hazard area 301, so it can be said that the possibility of a contact accident occurring due to the beginner worker 202 getting too close to the work vehicle 100 is low. However, when the state change detection unit 21 detects that the beginner worker 202 has entered the beginner approach area 304A, the position of the beginner worker 202 has shifted in a direction that moves closer to the contact hazard area 301, so the travel speed control unit 22 increases the travel speed of the work vehicle 100, ensuring a safer state.
[0060] With respect to the skilled worker 201, as in the first embodiment, when the state change detection unit 21 detects that the skilled worker 201 has entered the skilled worker approach area 303A, the travel speed control unit 22 increases the travel speed of the work vehicle 100. Therefore, when the skilled worker 201 enters the skilled worker approach area 303A, which is adjacent to the contact hazard area 301, that is, when the skilled worker 201 approaches the contact hazard area 301, the travel speed can be increased to move the work vehicle 100 away from the skilled worker 201. As a result, even without widening the contact hazard area 301, it is possible to prevent contact accidents caused by the skilled worker 201 getting too close to the work vehicle 100. In addition, it is possible to prevent frequent stopping of the work machine 102 due to the skilled worker 201 entering the contact hazard area 301.
[0061] As a result, in the second embodiment as well, sufficient safety can be ensured while preventing the work machine 102 from frequently stopping due to workers 201 and 202 approaching the work vehicle 100, thereby improving work efficiency.
[0062] Furthermore, in this embodiment, when the state change detection unit 21 detects a state change in which skilled worker 201 has entered the skilled worker reversal area 303R or a state change in which novice worker 202 has entered the novice worker reversal area 304R, the travel speed control unit 22 reduces the travel speed of the work vehicle 100. With this configuration, if the work performed by workers 201 and 202 lags behind the travel speed of the work vehicle 100 and workers 201 and 202 enter the reversal areas 303R and 304R, the travel speed can be reduced to prevent the work vehicle 100 from moving any further away from workers 201 and 202. This makes it possible to coordinate the work performed by the work machine 102 and the work performed by workers 201 and 202 in a good manner.
[0063] The following describes some modifications related to the second embodiment. In the second embodiment, the first to fourth modifications described in the first embodiment can also be applied.
[0064] (First variation) In the second embodiment described above, a reverse area 303R, 304R was set within the work area 303, 304, and an example was shown in which the travel speed of the work vehicle 100 is reduced when workers 201, 202 enter the reverse area 303R, 304R. However, this process may be omitted.
[0065] (Second variation) In the second embodiment, it is also possible to apply a modified example in which a work delay area is set. Figure 9 shows a work vehicle control device 20 according to the second modified example. -2 This is a block diagram showing an example of the functional configuration. In Figure 9, components with the same reference numerals as those shown in Figure 8 have the same function, so redundant explanations are omitted here. As shown in Figure 9, the work vehicle control device 20 according to the second modified example-2 In terms of functional configuration, instead of the state change detection unit 21, the driving speed control unit 22, and the notification unit 23, the state change detection unit 21 -2 , Driving speed control unit 22 -2 and Hochi Department 23 -2 It is equipped with.
[0066] Figure 10 is a diagram illustrating the area and operation example according to the second modification. As shown in Figure 10, in the second modification, the beginner work area 304 further includes a work delay area 304L in addition to the beginner approach area 304A, the beginner normal area 304S, and the beginner retreat area 304R. In the example shown in Figure 10, the beginner retreat area 304R is the area where the distance from the work vehicle 100 is 6th distance d6 or more and less than 7th distance d7. The work delay area 304L is an area even further away than the beginner retreat area 304R (an area where the distance from the work vehicle 100 is 7th distance d7 or more). Note that in the second modification, the skilled worker work area 303 is the same as in Figure 7.
[0067] Driving speed control unit 22 -2 As shown by arrow Y1 in Figure 10, the state change detection unit 21 detects when the skilled worker 201 changes from being in the skilled worker normal area 303S to being in the skilled worker approach area 303A. -2 When detected by the state change detection unit 21, or when a state change occurs in which the novice worker 202 moves from being in the beginner normal area 304S to being in the beginner approach area 304A, the state change detection unit 21 -2 When detected, the travel speed of the work vehicle 100 is increased. This control is the same as in the second embodiment.
[0068] Also, the driving speed control unit 22 -2 As shown by arrow Y2 in Figure 10, the state change detection unit 21 detects a change in state from when skilled worker 201 is in the skilled worker normal area 303S to when it is in the skilled worker retreat area 303R. -2When detected by the state change detection unit 21, or when a state change occurs in which the novice worker 202 moves from being in the beginner normal area 304S to being in the beginner retreat area 304R, the state change detection unit 21 -2 When detected, the travel speed of the work vehicle 100 is reduced. This control is the same as in the second embodiment.
[0069] Also, the driving speed control unit 22 -2 As shown by arrow Y3 in Figure 10, the state change detection unit 21 detects when the novice worker 202 changes from being in the novice retreat area 304R to being in the work delay area 304L. -2 When detected by the system, the movement of the work vehicle 100 is stopped (the movement speed of the work vehicle 100 is set to zero). With this configuration, if the work of the novice worker 202 is behind schedule, the work vehicle 100 can be stopped, and after the novice worker 202 has made some progress, the movement of the work vehicle 100 can be resumed. In addition, if the skilled worker 201 reverses and enters the work delay area 304L, the movement speed control unit 22 -2 This stops the movement of work vehicle 100.
[0070] Hochi Department 23 -2 The driving speed control unit 22 -2 In addition to increasing and decreasing the speed of the work vehicle 100, the system also provides notification when the vehicle stops moving.
[0071] (Third variation) In the second embodiment described above, the skilled worker 201 performs work in the skilled worker work area 303, and the novice worker 202 performs work in the beginner worker work area 304. However, the work vehicle control device 20 does not identify whether the worker in each work area 303 or 304 is the skilled worker 201 or the novice worker 202. Therefore, even if the skilled worker 201 is in the beginner worker work area 304, or the novice worker 202 is in the skilled worker work area 303, the above-described control is executed in accordance with the state changes of the skilled worker 201 and the novice worker 202.
[0072] In contrast, the third modified example recognizes whether the worker is a skilled worker 201 or a novice worker 202, and controls the travel speed of the work vehicle 100 based on the recognized attribute. Figure 11 shows the work vehicle control device 20 according to the third modified example. -5 This is a block diagram showing an example of the functional configuration. In Figure 11, components with the same reference numerals as those shown in Figure 8 have the same function, so redundant explanations are omitted here.
[0073] As shown in Figure 11, the work vehicle control device 20 according to the third modified example -5 It further includes an attribute recognition unit 25 as part of its functional configuration. Also, the driving speed control unit 22 is replaced with a driving speed control unit 22 -5 It is equipped with the same features as shown in Figure 7.
[0074] The attribute recognition unit 25 recognizes whether the worker performing the work behind the work vehicle 100 is a skilled worker 201 or a novice worker 202. For example, before starting work, skilled workers 201 and novice workers 202 are photographed by the front camera 104 or rear camera 103, and attribute information is added to the captured images and stored in the work vehicle control device 20. After starting work, the attribute recognition unit 25 analyzes the images captured by the rear camera 103 and compares the characteristics of the workers in each work area 303, 304 with the characteristics of the workers in the previously stored captured images to recognize whether the workers in each work area 303, 304 are skilled workers 201 or novice workers 202. Alternatively, instead of analyzing the images captured by cameras 103, 104, the attributes of workers 201, 202 may be recognized based on attribute information transmitted from an electromagnetic storage medium such as an RFID carried by the workers 201, 202.
[0075] Driving speed control unit 22 -5The attribute recognition unit 25 controls the travel speed of the work vehicle 100 when a worker recognized as a skilled worker 201 is in the skilled worker work area 303, and also controls the travel speed of the work vehicle 100 when a worker recognized as a novice worker 202 is in the beginner work area 304. When skilled worker 201 is in the beginner work area 304 and novice worker 202 is in the skilled worker area 303, the travel speed control unit 22 -5 The system does not control the travel speed of the work vehicle 100.
[0076] In this configuration, for example, when a skilled worker 201 retreats to the beginner work area 304 (and passes through the skilled worker retreat area 303R, causing their speed to decrease), their speed remains unchanged when returning to the skilled worker work area 303. Similarly, when a novice worker 202 advances to the skilled worker work area 303 (and passes through the beginner approach area 304A, causing their speed to increase), their speed remains unchanged when returning to the beginner work area 304.
[0077] Furthermore, this control, which prevents workers 201 and 202 from changing their travel speed when returning to their original work areas 303 and 304, can be implemented even without the attribute recognition unit 25. For example, when the travel speed control unit 22, shown in Figure 8, detects a state change in workers 201 and 202 (it is unknown whether worker 201 is a skilled worker or a novice worker 202) from being in the skilled worker work area 303 to being in the novice work area 304, and then returning from being in the novice work area 304 to being in the skilled worker work area 303, the travel speed control unit 22 will not change the travel speed of the work vehicle 100 when they return.
[0078] Furthermore, when the state change detection unit 21 detects a state change in workers 201 and 202 (it is unclear whether worker 201 is a skilled worker or worker 202 is a novice worker) from being in the novice work area 304 to being in the skilled work area 303, and then returning from being in the skilled work area 303 to being in the novice work area 304, the travel speed control unit 22 will not change the travel speed of the work vehicle 100 when returning.
[0079] Furthermore, the third variation can also be applied in combination with the first and second variations.
[0080] (Fourth variation) In the fourth modified example, the attributes of workers 201 and 202 are recognized, such as whether worker 201 is a skilled worker or worker 202 is a novice worker. In the fourth modified example, the control of the travel speed of the work vehicle 100 is changed according to the recognized attributes.
[0081] Figure 12 shows the work vehicle control device 20 according to the fourth modified example. -6 This is a block diagram showing an example of the functional configuration. In Figure 12, components with the same reference numerals as those shown in Figure 11 have the same function, so redundant explanations are omitted here. As shown in Figure 12, the work vehicle control device 20 according to the fourth modified example -6 The functional configuration includes the state change detection unit 21 and the driving speed control unit 22 shown in Figure 11. -5 Instead, state change detection unit 21 -6 and travel speed control unit 22 -6 It is equipped with.
[0082] FIG. 13 is a diagram for explaining an area and an operation example in a fourth modification. In the second embodiment and the first to third modifications, the beginner work area 304 is set behind the expert work area 303, and the two work areas 303 and 304 do not overlap each other. In contrast, in the fourth modification, as shown in FIG. 13, instead of the beginner work area 304, a beginner work area 304' whose front part overlaps with the expert work area 303 is set. In the fourth modification, a contact risk area for experts and a contact risk area for beginners are set as the contact risk areas, and the contact risk area 301' for beginners is set larger than the contact risk area 301 for experts. The term "larger" here means increasing the distance to the rear of the work vehicle 100.
[0083] The expert work area 303 is the same as that shown in FIG. 3 (different from FIG. 7, the rear end of the expert retreat area 303R is not limited to less than the fourth distance d4). The beginner work area 304' basically has the same configuration as the expert work area 303, and the beginner work area 304' is set so as to surround the contact risk area 301' for beginners. Here, the contact risk area 301' for beginners is set larger than the contact risk area 301 for experts. That is, an area from the work vehicle 100 to the beginner's first distance d1' (d1 < d l') is set as the contact risk area 301' for beginners.
[0084] Furthermore, in the fourth modification, the area adjacent to the beginner-friendly contact risk area 301' (in the example in Figure 13, the area where the distance from the work vehicle 100 is greater than or equal to the beginner-friendly first distance d1' and less than the beginner-friendly second distance d2') is set as the beginner approach area 304A'. In addition, the area further away from the beginner approach area 304A' and adjacent to the beginner approach area 304A' (in the example in Figure 13, the area where the distance from the work vehicle 100 is greater than or equal to the beginner-friendly second distance d2' and less than the beginner-friendly third distance d3') is set as the beginner normal area 304S', and the area further away from the beginner approach area 304A', separated by the beginner normal area 304S' (in the example in Figure 13, the area where the distance from the work vehicle 100 is greater than or equal to the beginner-friendly third distance d3') is set as the beginner retreat area 304R'. In the example in Figure 13, the third distance d3' for beginners is set to the same value as the sixth distance d6 shown in Figure 7, but it may be set to a different value from the sixth distance d6.
[0085] State change detection unit 21 -6 The attribute recognition unit 25 applies the skilled worker work area 303 to the skilled worker 201 recognized by the attribute recognition unit 25 and detects changes in state within the skilled worker work area 303. In addition, the state change detection unit 21 -6 The system applies the beginner work area 304' to the novice worker 202 recognized by the attribute recognition unit 25 and detects changes in state within the beginner work area 304'.
[0086] Driving speed control unit 22 -6 As shown by arrow Y1 in Figure 13, the state change detection unit 21 detects when a worker recognized as a skilled worker 201 by the attribute recognition unit 25 changes from being in the skilled worker normal area 303S to being in the skilled worker approach area 303A. -6 When detected by the attribute recognition unit 25, or when a worker is recognized as a novice worker 202, the state change from being in the beginner normal area 304S' to being in the beginner approach area 304A' is detected by the state change detection unit 21. -6 When detected, the travel speed of the work vehicle 100 is increased.
[0087] Also, the driving speed control unit 22 -6 As shown by arrow Y2 in Figure 13, the state change detection unit 21 detects when a worker recognized as a skilled worker 201 by the attribute recognition unit 25 changes from being in the skilled worker normal area 303S to being in the skilled worker retreat area 303R. -6 When detected by the attribute recognition unit 25, or when a worker is recognized as a novice worker 202, the state change from being in the beginner normal area 304S' to being in the beginner retreat area 304R' is detected by the state change detection unit 21. -6 When detected, the travel speed of the work vehicle 100 is reduced.
[0088] In the fourth modified configuration as described above, the skilled worker normal area 303S and the beginner worker normal area 304S' are set in an overlapping area, so that the beginner worker 202 can work near the skilled worker 201. This makes it possible, for example, for the beginner worker 202 to work while receiving guidance from the skilled worker 201. In addition, in the fourth modified configuration, the beginner work area 304' is set so as to surround the beginner contact hazard area 301', but the beginner contact hazard area 301' is set to be larger than the skilled worker contact hazard area 301, so it is possible to suppress the occurrence of accidents in which the beginner worker 202 comes into contact with the work vehicle 100. Note that, as shown in Figure 14, the beginner contact hazard area 301' may be the same size as the skilled worker contact hazard area 301, and the beginner approach area 304A' may be set to be larger than the skilled worker approach area 303A.
[0089] Furthermore, the fourth modification can also be applied in combination with the first to third modifications. Here, in the example of setting the work delay area 302L shown in Figure 10, in addition to setting the work delay area behind the beginner retreat area 304R', the work delay area may also be set behind the skilled worker work area 303.
[0090] (Third embodiment) Next, a third embodiment of the present invention will be described with reference to the drawings. In the first and second embodiments described above, an example was described in which a change in the relative position of worker 200 (201, 202) with respect to the work vehicle 100 was detected as a change in the state of worker 200 (201, 202). In contrast, in the third embodiment, a change in the distance from the work vehicle 100 to worker 200 (201, 202) is detected as a change in the state of worker 200 (201, 202).
[0091] Figure 15 is a block diagram showing an example of the functional configuration of a work vehicle control device 30 according to the third embodiment. The work vehicle control device 30 according to the third embodiment is mounted on a work vehicle 100 in place of the work vehicle control device 10 shown in Figure 1. In Figure 15, components with the same reference numerals as those shown in Figure 2 have the same functions, so redundant explanations are omitted here.
[0092] As shown in Figure 15, the work vehicle control device 30 according to the third embodiment includes a state change detection unit 31, a travel speed control unit 32, and a notification unit 13 as its functional configuration. These functional blocks 31, 32, and 13 can be configured using hardware, a DSP, or software. For example, when configured using software, the functional blocks 31, 32, and 13 are actually configured using a computer's CPU, RAM, ROM, etc., and are realized by the operation of a program stored in a storage medium such as RAM, ROM, hard disk, or semiconductor memory.
[0093] The state change detection unit 31 detects changes in the distance of the worker 200, who is working behind the work vehicle 100, from the work vehicle 100. As described above, the distance from the work vehicle 100 to the worker 200 is the distance relative to the rear of the work vehicle 100. That is, the distance detected by the state change detection unit 31 is not the distance of the straight line connecting the work vehicle 100 (rear camera 103) and the worker 200, but the distance projected onto a straight line extending rearward from the work vehicle 100 (a straight line parallel to the direction of travel of the work vehicle 100). Although the operation example shown in Figure 16 is assumed here, if the contact risk area 301 is semicircular or elliptical as shown in Figure 4, it is possible to use the distance of the straight line connecting the work vehicle 100 (rear camera 103) and the worker 200.
[0094] The travel speed control unit 32 increases the travel speed of the work vehicle 100 when the state change detection unit 31 detects a change in the distance between the work vehicle 100 and the worker 200, from a state where the distance is greater than or equal to a predetermined proximity distance to a state where the distance is less than or equal to a predetermined proximity distance. Conversely, the travel speed control unit 32 decreases the travel speed of the work vehicle 100 when the state change detection unit 31 detects a change in the distance between the work vehicle 100 and the worker 200, from a state where the distance is greater than or equal to a predetermined separation distance to a state where the distance is greater than or equal to a predetermined separation distance.
[0095] Here, the proximity-side predetermined distance is the second distance d2 to the rear end of the approach area 302A shown in Figure 3. In other words, the travel speed control unit 32 increases the travel speed of the work vehicle 100 when the distance from the work vehicle 100 to the worker 200 changes from a state where it is greater than or equal to the second distance d2 to a state where it is less than the second distance d2.
[0096] Furthermore, the predetermined distance on the separation side is the third distance d3 to the front end of the reversing area 302R shown in Figure 3. In other words, the travel speed control unit 32 reduces the travel speed of the work vehicle 100 when the distance from the work vehicle 100 to the worker 200 changes from a state of being less than the third distance d3 to a state of being greater than or equal to the third distance d3.
[0097] Figure 16 is a diagram illustrating the operation of the travel speed control unit 32 as described above. In the third embodiment, it is not necessary to detect the position of the worker 200 (a combination of distance and direction from the work vehicle 100), and it is sufficient to detect the distance to the worker 200, so it is not necessarily required to set an area. Figure 16 does not show an example of area setting, but rather an example of the operation of the travel speed control unit 32. Note that, as shown in Figure 16, each area may be set in a stripe pattern (instead of setting each area to surround the contact hazard area, each strip-shaped area may be set parallel to the strip-shaped contact hazard area).
[0098] As indicated by arrow Y1 in Figure 16, the travel speed control unit 32 increases the travel speed of the work vehicle 100 when the distance from the work vehicle 100 to the worker 200 changes from a state where it is greater than or equal to the second distance d2 to a state where it is less than the second distance d2. Also, as indicated by arrow Y2 in Figure 16, the travel speed control unit 32 decreases the travel speed of the work vehicle 100 when the distance from the work vehicle 100 to the worker 200 changes from a state where it is less than the third distance d3 to a state where it is greater than or equal to the third distance d3.
[0099] In this document, an example has been described in which, based on the first embodiment, a change in the distance of the worker 200 is detected instead of a change in the position of the worker 200. However, the system is not limited to this. That is, based on the first and second modifications of the first embodiment, the second embodiment, or the first to fourth modifications of the second embodiment, the system may also detect a change in the distance of the worker 200 instead of a change in the position of the worker 200.
[0100] For example, based on the second embodiment, if the change in the worker's distance is detected instead of the change in the worker's position, the travel speed control unit 32 controls the travel speed of the work vehicle 100 by assuming that there are multiple predetermined proximity distances and predetermined separation distances at different positions. In this case, the multiple predetermined proximity distances are, for example, the second distance d2 to the rear end of the skilled worker approach area 303A and the fifth distance d5 to the rear end of the novice worker approach area 304A shown in Figure 7. The multiple predetermined separation distances are the third distance d3 to the front end of the skilled worker retreat area 303R and the sixth distance d6 to the front end of the novice worker retreat area 304R shown in Figure 7.
[0101] Alternatively, the multiple predetermined proximity distances are, for example, the second distance d2 to the rear end of the skilled worker approach area 303A shown in Figure 13, and the second beginner distance d2' to the rear end of the beginner worker approach area 304A'. The multiple predetermined separation distances are the third distance d3 to the front end of the skilled worker retreat area 303R shown in Figure 13, and the third beginner distance d3' to the front end of the beginner worker retreat area 304R'. In this case, the travel speed control unit 32 changes the control content of the travel speed of the work vehicle 100 depending on whether the attribute recognized by the attribute recognition unit 25 is that of a skilled worker 201 or a beginner worker 202.
[0102] (Other embodiments) The system may recognize whether the object captured in the image from the rear camera 103 is a worker whose image has been pre-registered, and control the travel speed of the work vehicle 100 according to the detected state change of the recognized worker. This prevents the travel speed of the work vehicle 100 from being controlled in response to the movement of objects or people that are not workers in the captured image. Alternatively, instead of analyzing the image captured by the rear camera 103, the system may recognize whether the object is a pre-registered worker based on information transmitted from an electromagnetic storage medium such as RFID.
[0103] The front camera 104 may analyze the images it captures, and if it detects that there are people or obstacles within a specified distance, it may stop the work vehicle 100 from moving. This would ensure the safety of workers when they are in front of the vehicle or when it is turning.
[0104] The system may further recognize the presence of a manager as an attribute, and the work vehicle 100 may only begin moving when it is recognized that a manager is present in the work area 302 (skilled worker work area 303 or beginner work area 304, 304') and the manager has given the instruction to start work. In this way, work can be started safely and appropriately. In this case, the skilled worker 201 may be designated as the manager, or a manager may be designated separately from the skilled worker 201.
[0105] Figure 17 is a flowchart showing an example of operations from start to finish when an administrator is set up. Here, the series of operations will be explained using the case where administrator control for starting work is applied to the first embodiment as an example. In this case, the work vehicle control device 10 further includes an attribute recognition unit (a functional configuration for recognizing the administrator) in addition to the functional configuration shown in Figure 2.
[0106] First, the attribute recognition unit determines whether the person present in the work area 302 is a manager, and whether an instruction to start work has been issued by the manager (step S1). If it is determined that the instruction to start work is not from a manager in the work area 302, the process returns to step S1, and the work vehicle 100 does not start moving. On the other hand, if it is determined that the instruction to start work is from a manager in the work area 302, the work vehicle 100 starts moving automatically, and the process proceeds to step S2 and beyond.
[0107] Next, the state change detection unit 11 determines whether or not the worker 200 has entered the contact hazard area 301 (step S2). If the state change detection unit 11 detects that the worker 200 has entered the contact hazard area 301, the travel speed control unit 12 stops the movement of the work vehicle 100 (step S3). At this time, the operation of the work machine 102 also stops. After that, the process proceeds to step S9.
[0108] If the state change detection unit 11 determines in step S2 that the worker 200 is not in the contact hazard area 301, the state change detection unit 11 then determines whether the worker 200 has entered the approach area 302A (step S4). If the state change detection unit 11 detects that the worker 200 has entered the approach area 302A, the travel speed control unit 12 increases the travel speed of the work vehicle 100 (step S5). The process then proceeds to step S9.
[0109] If the state change detection unit 11 determines in step S4 that the worker 200 is not in the approach area 302A, the state change detection unit 11 then determines whether the worker 200 has entered the reverse area 302R (step S6). If the state change detection unit 11 detects that the worker 200 has entered the reverse area 302R, the travel speed control unit 12 reduces the travel speed of the work vehicle 100 (step S7). The process then proceeds to step S9.
[0110] If the state change detection unit 11 determines in step S6 that the worker 200 is not in the reversing area 302R, the travel speed control unit 12 maintains the travel speed of the work vehicle 100 (step S8). The process then proceeds to step S9. In step S9, it is determined whether the scheduled work has been completed. For example, it is determined whether the entire predetermined target route has been traveled. Alternatively, it is determined whether an instruction to complete the work has been issued by the manager. If it is determined that the work has not been completed, the process returns to step S2. On the other hand, if it is determined that the work has been completed, the process shown in the flowchart in Figure 17 is terminated.
[0111] Furthermore, although the above embodiment describes an example in which the work vehicle control devices 10, 20, and 30 are mounted on the work vehicle 100, the present invention is not limited to this. For example, the above-described functional configuration may be provided by a remote control device installed at a remote base station or the like, and the work vehicle 100 may be equipped with a device that controls the movement of the work vehicle 100 and the operation of the work machine 102 in response to instructions from the remote control device. In this case, the remote control device receives images captured by the rear camera 103 and generates instruction information for executing the control related to the above-described functional configuration. Then, by transmitting the generated instruction information to the mounted device of the work vehicle 100, it causes the device to execute an operation according to the instruction.
[0112] Furthermore, the embodiments and modifications described above are merely examples of how the present invention may be implemented, and the technical scope of the invention should not be interpreted as being limited by them. In other words, the present invention can be implemented in various forms without departing from its gist or its main features. [Explanation of symbols]
[0113] 10, 20, 30 Work vehicle control system 11,21,31 State change detection unit 12,22,32 Driving speed control unit 25 Attribute recognition section
Claims
1. A work vehicle control device that controls the movement of a work vehicle equipped with a work implement at the rear, when it automatically travels along a target path, A state change detection unit that detects changes in the distance or relative position of a worker performing work behind the work vehicle, The system includes a travel speed control unit that controls the travel speed of the work vehicle in accordance with the state change detected by the state change detection unit, Starting from the area closest to the above-mentioned work vehicle, we have designated the areas as follows: contact hazard zone, skilled worker area, and beginner worker area. Of the above-mentioned skilled worker work areas, the area adjacent to the above-mentioned contact hazard area shall be designated as the skilled worker approach area, and of the above-mentioned beginner work areas, the area adjacent to the above-mentioned skilled worker area shall be designated as the beginner approach area. The above-mentioned speed control unit increases the speed of the work vehicle when the state change detection unit detects a change in the worker's state from being outside the skilled worker approach area within the skilled worker work area to being inside the skilled worker approach area, or when the state change detection unit detects a change in the worker's state from being outside the beginner approach area within the beginner work area to being inside the beginner approach area. A work vehicle control device characterized by the following features.
2. Of the above skilled worker work areas, the area further away from the skilled worker approach area, separated by the skilled worker normal area, shall be designated as the skilled worker retreat area, and of the above beginner work areas, the area further away from the beginner approach area, separated by the beginner normal area, shall be designated as the beginner retreat area. The above-mentioned speed control unit reduces the speed of the work vehicle when the state change detection unit detects a change in the worker's state from being outside the skilled worker reverse area within the skilled worker work area to being inside the skilled worker reverse area, or when the state change detection unit detects a change in the worker's state from being outside the beginner reverse area within the beginner work area to being inside the beginner reverse area. The work vehicle control device according to feature 1.
3. Of the above-mentioned skilled worker work area, the area further away from the skilled worker approach area, separated by the skilled worker normal area, will be designated as the skilled worker retreat area. Of the above-mentioned beginner work area, the area further away from the beginner approach area, separated by the beginner normal area, will be designated as the beginner retreat area. The area further away from the beginner retreat area will be designated as the work delay area. The above-mentioned speed control unit reduces the speed of the work vehicle when the state change detection unit detects a change in the worker's state from being outside the skilled worker reverse area within the skilled worker work area to being inside the skilled worker reverse area, or when the worker moves from being ahead of the beginner reverse area within the beginner work area to being inside the beginner reverse area. The speed control unit also stops the work vehicle when the state change detection unit detects a change in the worker's state from being outside the work delay area to being inside the work delay area. The work vehicle control device according to feature 1.
4. The above-mentioned speed control unit is characterized in that, when a change in state that causes an increase in the speed of the work vehicle and a change in state that causes a decrease in the speed of the work vehicle occur simultaneously, it prioritizes increasing the speed of the work vehicle, as described in claim 2 or 3.
5. The above unit further includes an attribute recognition unit that recognizes whether the worker is an expert or a novice. The above-mentioned speed control unit controls the speed of the work vehicle when a worker recognized as an expert by the attribute recognition unit is in the expert work area, and controls the speed of the work vehicle when a worker recognized as a novice by the attribute recognition unit is in the novice work area. A work vehicle control device according to feature 2 or 3.
6. The work vehicle control device according to claim 2 or 3, characterized in that when the state change detection unit detects a change in the state from the state in the beginner work area to the state in the skilled work area after the worker has moved from the skilled work area to the beginner work area, the work vehicle control unit does not change the travel speed of the work vehicle when the worker returns.
7. The work vehicle control device according to claim 2 or 3, characterized in that when the state change detection unit detects a change in the state from the state in the skilled worker area to the state in the beginner worker area after the worker has moved from the beginner worker area to the skilled worker area, the work vehicle control unit does not change the travel speed of the work vehicle when the worker returns to the beginner worker area.
8. A work vehicle control method for controlling the movement of a work vehicle equipped with a work implement at its rear, when it automatically travels along a target path, The work vehicle control device's state change detection unit detects a change in the distance or relative position of a worker performing work behind the work vehicle, The travel speed control unit of the above-mentioned work vehicle control device has the step of controlling the travel speed of the work vehicle in accordance with the state change detected by the state change detection unit, Starting from the area closest to the above-mentioned work vehicle, we have designated the areas as follows: contact hazard zone, skilled worker area, and beginner worker area. Of the above-mentioned skilled worker work areas, the area adjacent to the above-mentioned contact hazard area shall be designated as the skilled worker approach area, and of the above-mentioned beginner work areas, the area adjacent to the above-mentioned skilled worker area shall be designated as the beginner approach area. The above-mentioned speed control unit increases the speed of the work vehicle when the state change detection unit detects a change in the worker's state from being outside the skilled worker approach area within the skilled worker work area to being inside the skilled worker approach area, or when the state change detection unit detects a change in the worker's state from being outside the beginner approach area within the beginner work area to being inside the beginner approach area. A method for controlling work vehicles characterized by the following features.
Citation Information
Patent Citations
Harvesting work system
JP2020018255A
Work vehicle
JP2020103093A
Safety system of working vehicle
JP2020125171A