Patent Application
20240133157
The present invention relates to a work machine control system.
In a work machine comprising a work device, productivity can be enhanced by automating works. In a technique described in Patent Literature 1, a series of works executed by a work machine is configured as a task and the work machine operates in accordance with the task.
However, in conventional techniques, there is a problem that it is difficult for a worker (manual worker) to perform a work in the vicinity of a work machine executing a task automatically.
In a work machine operated by an operator on board, the operator and a manual worker perform work while communicating. However, in a work machine executing the task automatically as described in Patent Literature 1, the manual worker cannot communicate with the machine, so the manual worker does not know how the machine moves and cannot go near even if the manual worker wants to perform work in the vicinity, so there is possibility that workability is reduced. Also, if the work machine executes a movement different than expected by the manual worker, there is a risk that the manual worker and the work machine come into contact.
The present invention is made in order to solve such problems and an object is to provide a work machine control system facilitating a worker to perform work more easily in the vicinity of a work machine executing a task automatically.
An example of a work machine control system related to the present invention comprises:
The present description includes the disclosure of Japanese Patent Application No. 2021-063303, which is the basis of the priority of the present application.
According to the work machine control system related to the present invention, a worker can perform work more easily in the vicinity of a work machine executing a task automatically. For example, the manual worker can control execution of the task of the work machine, so the manual worker can perform the work close to the work machine, thereby enhancing productivity and safety.
Embodiments of the present invention will be explained below based on the attached drawings.
A first embodiment of a work machine control system according to the present invention will be explained with reference to
The work machine 1 comprises a front work device 1a, a top rotary body 1b and a bottom traveling body 1c. The front work device 1a comprises a boom 2, an arm 3 and a bucket 4. It is constructed so that the boom 2 is driven by a boom cylinder 5, the arm 3 is driven by an arm cylinder 6 and the bucket 4 is driven by a bucket cylinder 7 via a bucket link 20. The boom cylinder 5, the arm cylinder 6 and the bucket cylinder 7 are examples of hydraulic actuators. The work machine 1 may comprise other hydraulic actuators. The hydraulic actuators are used in order to execute the task.
The top rotary body 1b is constructed to be rotatable with respect to the bottom traveling body 1c and can be rotated by a rotation device 8. Caterpillars 21 are provided at the left and the right of the bottom traveling body 1c and they are constructed to be driven respectively by traveling devices 9 (only the left side is shown).
At the top rotary body 1b, a motor 10, a hydraulic pump 11 driven by the motor 10 and a control valve 12 that distributes pressure oil from the hydraulic pump 11 to the boom cylinder 5, the arm cylinder 6, the bucket cylinder 7, the rotation device 8 and the traveling devices 9.
In order to detect an attitude of the front work device 1a, a boom angle sensor 30 is provided at the boom 2, an arm angle sensor 31 is provided at the arm 3 and a bucket angle sensor 32 is provided at the bucket link 20.
On the top rotary body 1b, provided are a vehicle body inclination angle sensor 33 for detecting an inclination angle of the top rotary body 1b, a rotation angle sensor 34 for detecting a relative angle between the top rotary body 1b and the bottom traveling body 1c and a GNSS antenna 35 for detecting a position and an orientation of the top rotary body 1b.
The task control device 40 comprises a start instruction input device 41 for receiving input of a start instruction of a task, a stop instruction input device 42 for receiving input of a stop instruction of a task, a speed instruction input device 43 for receiving input of a speed instruction of a task, and a task switching input device 44 for receiving input of a task switching instruction for switching tasks. The task switching input device 44 comprises a forward switching button 44a and a reverse switching button 44b.
The start instruction input device 41, the stop instruction input device 42 and the task switching input device 44 are, for example, pushbuttons and constructed so that ON/OFF can be inputted. The speed instruction input device 43 is, for example, a slidable lever and any value can be inputted.
The task control information may include the above start instruction of the task, the stop instruction of the task, the speed instruction of the task, the task switching instruction, etc.
The work machine 1 comprises a vehicle body control device 50, a vehicle body position detection device 57, a work device attitude detection device 58 and an electromagnetic proportional valve 61 shown in
The vehicle body control device 50 comprises a receiving section 51 for receiving the task control information transmitted (outputted) from the task control device 40 and a task control section 52 for controlling execution of the task based on the task control information received at the receiving section 51.
The vehicle body control device 50 comprises a position and attitude calculation section 59. The vehicle body position detection device 57 and the work device attitude detection device 58 are connected to the position and attitude calculation section 59. The position and attitude calculation section 59 calculates a position and an attitude of the work machine 1.
The vehicle body control device 50 further comprises a task content input section 54, a movement planning section 55, a movement control section 56 and an electromagnetic proportional valve control section 60. The task content input section 54 is connected to the external system 53 and receives input of task content information representing content of the task. The movement planning section 55 plans movement of the vehicle body based on the task content information and generates movement plan information.
The movement control section 56 calculates a speed instruction of the hydraulic actuators based on the movement plan information and the position and the attitude of the vehicle body calculated by the position and attitude calculation section 59. Here, the movement plan information is generated based on the task content information as described above, so it can be said that the movement control section 56 calculates the speed instruction of the hydraulic actuators based on the task content information.
The electromagnetic proportional valve control section 60 controls the electromagnetic proportional valve 61 in accordance with the speed instruction from the movement control section 56. The electromagnetic proportional valve control section 60 is connected to the electromagnetic proportional valve 61 so that the work machine 1 can be moved in response to the task by controlling the electromagnetic proportional valve 61. Note that the electromagnetic proportional valve 61 is used for controlling the hydraulic actuators.
A task means, for example, a work to be executed by the work machine 1. Specific examples include “dig earth”, “travel and move to a destination”, etc. The task content information includes, information identifying such work, information representing the spot where the work should be done, etc. The task content information may include information related to a plurality of tasks.
The movement plan information means specific movement of each portion of the work machine for executing the task. For example, movement plan information related to the task “dig earth” includes information indicating movement of the bucket for putting the dug earth into the bucket. Also, for example, movement plan information related to the task “travel and move to a destination” includes information indicating movement of the traveling devices 9 for traveling.
The above are mere examples and those skilled in the art can define content and format of the task content information and the movement plan information at will. Note that, although in the present embodiment the movement plan information is generated based on the task content information, it is not required that the task content information and the movement plan information are distinguished clearly. For example, if the task content information includes information indicating movement of each portion of the work machine, a portion of the task content information or an entire portion thereof may be used as it is as the movement plan information.
The task control section 52 is connected to the movement control section 56. The movement control section 56 is so constructed that it can change configuration related to execution of the task upon sending an instruction to the electromagnetic proportional valve control section 60 in accordance with the instruction from the movement planning section 55 referring to the task control information from the task control section 52.
In the process of
In S103, it is confirmed whether the start instruction of the task is received from the task control device 40. If the start instruction is not received, the process of
After the execution of the task is started, in S104, it is confirmed whether the speed instruction of the task is received.
If the speed instruction is received, the task is executed in accordance with the speed instruction in S105. That is, the task control section 52 controls the execution speed of the task based on the speed instruction regarding the task being executed. If the speed instruction is not received, S105 is not executed.
Those skilled in the art can design how the execution speed of the task should be realized as needed, but for example, the execution speed of the task can be changed by changing movement speed of the boom 2, the arm 3 and the bucket 4.
In S106, it is confirmed whether the task switching instruction is received from the task control device 40. If the task switching instruction is received, the task control section 52 switches the tasks in S107 in accordance with the task switching instruction. For example, if a plurality of tasks can be distinguished by task identification numbers and the task switching instruction indicates that the forward switching button 44a is operated, execution of the task being executed at present is stopped and execution of the task with the task identification number greater by one is started. Similarly, if the task switching instruction indicates that the reverse switching button 44b is operated, execution of the task being executed at present is stopped and execution of the task with the task identification number smaller by one is started.
Those skilled in the art can design control required upon switching the tasks (such as how the movement being executed at that time should be processed) as needed. Note that, if the task switching instruction is not received, S107 is not executed.
In S108, it is confirmed whether the stop instruction of the task is received from the task control device 40. If the stop instruction is received, the task control section 52 stops execution of the task in S109 and the process of
Although this is not shown in
According to the work machine control system of the first embodiment above, the work machine 1 can perform work automatically in accordance with the task inputted from the external system 53. In addition, the task can be executed in accordance with the task control information from the task control device 40.
If the manual worker performing work in the vicinity of the work machine 1 holds the task control device 40, the manual worker can instruct the timing that the work machine 1 starts execution of the task, the execution speed of the task, switching of the tasks and stopping of the task in real time. Accordingly, the manual worker can come close to the work machine 1 while controlling movement of the work machine 1, so the manual worker can come close to the work machine 1 without being afraid, so productivity of work can also be enhanced. Thus, the worker can perform work more easily in the vicinity of work machine 1 executing the task automatically.
A second embodiment of a work machine control system according to the present invention will be explained with reference to
The communication monitoring section 62 is connected to the receiving section 51, monitors communication condition of the task control information and can determine the communication condition of the task control information. The communication condition is, for example, represented by whether there is communication failure. An example of failure is a condition wherein communication is broken down. The communication monitoring section 62 is also connected to the movement control section 56 and can communicate the communication condition to the movement control section 56. If it is determined that there is communication failure in communication of the task control information, the movement control section 56 stops execution of the task.
In the present embodiment, the work machine 1 can move selectively in any of a plurality of movement modes. One of the movement modes is a task control movement mode. In this movement mode, the work machine 1 moves based on the task control information. For example, it starts execution of the task in response to the start instruction of the task and stops execution of the task in response to the stop instruction of the task.
Also, one of the movement modes may be a non-task-control movement mode. In this movement mode, the work machine 1 may move regardless of the task control information. For example, it starts execution of the task in response to the task content information being inputted and stops execution of the task in response to completion of execution of the movement plan related to the task.
The mode switching section 63 is connected to the movement control section 56 and configured so that it can switch whether the task control movement mode is set wherein the task is executed in accordance with the task control information. That is, the mode switching section 63 can switch the movement mode of the work machine 1 to the task control movement mode and another mode. The mode switching section 63 may comprise an input device such as a button provided at the work machine 1.
After S102, in S110, it is confirmed whether the movement mode of the work machine 1 is the task control movement mode. If it is the task control movement mode, the process proceeds to S103. If not, the process of
After S103, in S111, communication condition with the task control device 40 is confirmed. If it is determined that there is communication failure in communication of the task control information, the movement control section 56 stops execution of the task in S109. If not, the process proceeds to S104.
According to the work machine control system of the second embodiment above, the communication condition between the task control device 40 and the vehicle body control device 50 is confirmed, and if there is communication failure, execution of the task is stopped. Accordingly, it is avoided that the work machine 1 cannot be stopped by communication breakdown or that work machine 1 executes an unexpected movement.
Also, by switching the task control movement mode, the work machine 1 can be moved regardless of the task control information. For example, the work machine 1 can be moved based on receiving the task content information even without any instruction from the task control device.
A third embodiment of a work machine control system according to the present invention will be explained with reference to
As the task control device 40 according to the third embodiment, one similar to that in
Also, in the present embodiment, the task control information includes task control device identification information for identifying the task control device. For example, in a case wherein a plurality of task control devices are distinguished by the task control device identification information, each task control device transmits the task control information including the task control device identification information for identifying the task control device. The work machine can be configured so that it can only be controlled by a specific task control device.
The task control device designation device 45 and the task control device identification section 64 receive input of the task control device identification information for identifying a specific task control device 40. For example, the task control device designation device 45 is provided with three buttons on which respective different numbers are displayed so that three task control devices can be selected, and the task control device identification information corresponds to the numbers displayed on the buttons.
The task control device designation device 45 receives input of the task control device identification information and transmits this to the task control device identification section 64. The task control device identification section 64 receives this and designates the task control device 40 for the task control section 52. The task control section 52 is configured so that it follows only the task control information from the task control device 40 designated by the task control device identification section 64. Note that, the task control device designation device 45 and the task control device identification section 64 are not only able to designate a specific task control device 40 but also may automatically designate the task control device 40 that first transmitted the task control information as the specific task control device.
The task control section 52 does not allow the task to be executed if the task control device identification information included in the task control information and the task control device identification information inputted from the task control device identification section 64 do not match.
If the both task control device identification information match, the task control section 52 may perform control similar to the first or the second embodiment.
According to the above work machine control system of the third embodiment, a single task control device 40 can instruct a plurality of work machines 1, so works can be executed efficiently. Also, even if task control is transmitted from a plurality of task control devices 40 to a single work machine 1, it can be moved according only to the specific task control device 40, so it does not move unexpectedly.
In the first to the third embodiments above, the task control device 40 does not have to comprise all shown input devices and one or more input devices may be omitted. For example, any of the start instruction input device 41, the stop instruction input device 42, the speed instruction input device 43 and the task switching input device 44 of
All publications, patents, and patent applications cited in the present description are incorporated in the present description by being cited as they are.
| Number | Date | Country | Kind |
|---|---|---|---|
| 2021-063303 | Apr 2021 | JP | national |
| Filing Document | Filing Date | Country | Kind |
|---|---|---|---|
| PCT/JP2022/011747 | 3/14/2022 | WO |
