The present invention relates to a control device for a work machine for assisting remote operation of the work machine.
Conventionally, a control device for a work machine has been known that is described in Patent Literature 1. This control device comprises a camera mounted on a hydraulic excavator, two motors that change the viewing angle range of the camera, a controller that controls the two motors, and three sensors that detect the angles of the boom, arm, and bucket. The control device transmits a signal including an image captured by the camera to a remote control room during remote operation of the work machine. This displays the image on a monitor in the remote control room to allow an operator to remotely operate the work machine.
During remote operation of the work machine, this control device draws a straight line from the center of the camera to the end of the bucket based on the detection signals of the three sensors. The control device then determines whether the end of the bucket is positioned within the viewing angle range of the camera from a relationship between the straight line and the viewing angle range of the camera. Then, when the end of the bucket is out of the viewing angle range of the camera, the viewing angle range of the camera is changed to its maximum value. The control device then re-determines whether the end of the bucket is within the changed field of view. When the end of the bucket is out of the changed viewing angle range of the camera, the control device controls the angle of the camera so that the end of the bucket is within the viewing angle range of the camera.
Patent Literature 1: Japanese Patent Laid-Open No. H9-270945
The above conventional control device determines whether the end of the bucket is out of the viewing angle range of the camera in two steps: before and after change of the viewing angle range of the camera. Therefore, a large positional change of the bucket requires time to change the angle of the camera, resulting in a state in which the end of the bucket cannot be imaged by the camera. Furthermore, a large positional change of the bucket may cause frequent changes in the camera angle. In that case, it is difficult for the operator to recognize the end of the bucket as a video displayed on the monitor frequently changes. This problem occurs not only in imaging the end portion of the bucket but also in imaging a predetermined portion of an attachment such as a boom, an arm, or a bucket.
The present invention has been made to solve the above problems, and it is an object of the present invention to provide a control device for a work machine capable of preventing frequent changes in the posture of the imaging device, preventing a state in which a predetermined portion is not imaged, and improving operability, when an imaging device images a predetermined portion of an attachment.
In order to achieve the above object, the control device for a work machine according to the present invention is a control device for a work machine that captures an image within a predetermined viewing angle range on a front side of the work machine with an imaging device provided in the work machine and that transmits a signal including the image to a remote location to assist remote operation of the work machine, the control device for the work machine comprising:
By the control device of this work machine, the determination unit determines whether the predetermined portion of the attachment of the work machine is in a state of being presumed to deviate into one of the vertical directions from the predetermined height range between the first height and the second height below the first height with reference to the work machine. Then, when a predetermined portion of the attachment is in a state being presumed to deviate into one of the vertical directions from the predetermined height range, the control unit controls the driving device so that the viewing angle range of the imaging device is changed into the deviation direction. In this way, the viewing angle range of the imaging device is changed when the predetermined portion of the attachment is in a state of being presumed to deviate from the predetermined height range. This, unlike the conventional art, makes it possible to quickly change the viewing angle range of the imaging device, resulting in prevention of a state in which the image of the predetermined portion of the attachment is not captured. In addition, the viewing angle range of the imaging device is not changed as long as the predetermined portion of the attachment does not deviate from the predetermined height range. This can prevent frequent changes in the image captured by the imaging device. As described above, it is possible to improve the operability when an operator remotely operates the work machine.
A control device and a remote operation assistance system according to one embodiment of the present invention is to be described below with reference to the drawings. As shown in
The work machines 10 and the remote operation device 20 are configured to be able to communicate with each other via a network 4. The network 4 is configured with a wireless network or a wired network. This remote operation device 20 is used by an operator to remotely control the work machines 10 and is provided in a remote control room 2. As shown in
The remote control device 200 is configured with an arithmetic processing device (single-core processor, or multi-core processor or a processor core configuring this). The remote control device 200 reads necessary data and software from a storage device such as a memory, and executes arithmetic processing on this data according to the software.
The remote input interface 210 comprises a remote operation mechanism 211. This remote operation mechanism 211 includes a traveling operation device, a revolving operation device, a boom operation device, an arm operation device, a bucket operation device, and the like. Each operating device has an operation lever that receives a turning operation. The operation lever of the traveling operation device is operated to move a lower traveling body 11 of the work machine 10.
The operation lever of the revolving operation device is operated to move the revolving mechanism of the work machine 10, and the operation lever of the boom operation device is operated to move a boom cylinder of the work machine 10. The operation lever of the arm operation device is operated to move an arm cylinder of the work machine 10, and the operation lever of the bucket operation device is operated to move a bucket cylinder of the work machine 10.
The remote output interface 220 also comprises an image output device 221, a remote wireless communication device 222, and a speaker (not shown). The image output device 221 is configured with a monitor. When this remote output interface 220 receives an image signal to be described below via the remote wireless communication device 222, the remote output interface 220 outputs an image in the image signal to the image output device 221.
As shown in
This actual machine control device 100 is configured with an arithmetic processing device (single-core processor, or multi-core processor or a processor core configuring this). The actual machine control device 100 reads necessary data and software from a storage device such as a memory, executes arithmetic processing on the data according to the software, and executes drive control processing and the like to be described below.
The work machine 10 is a crawler excavator type construction machine. The work machine 10 comprises a crawler-type lower traveling body 11, an upper revolving body 12 mounted on the lower traveling body 11 so as to be revolvable via a revolving mechanism, and an internal combustion engine (not shown) as a power source. The upper revolving body 12 is provided with a cabin 13 (operation room) on the front left side thereof. The upper revolving body 12 is provided with a working attachment 140 at the front central part thereof.
The actual machine input interface 110 comprises an actual machine operation mechanism 111, an imaging device 112, and a sensor device 113. The actual machine operation mechanism 111 comprises a plurality of real machine operation levers arranged similarly to the remote operation mechanism 211 around a seat arranged inside the cabin 13. The cabin 13 is provided with a drive mechanism or a robot that receives a signal corresponding to the operation aspect of the remote operation mechanism 211 and moves the actual machine operation levers based on the received signal.
The imaging device 112 is configured with, for example, a camera installed inside the cabin 13. The imaging device 112 images the environment including at least part of the actuating mechanism 140 through a front window 13a and a ceiling window 13b.
The sensor device 113 is configured with a boom angle sensor, an arm angle sensor, and an imaging device angle sensor. This boom angle sensor detects the boom angle, which is an angle of a boom 141 with respect to the upper revolving body 12.
The arm angle sensor detects the arm angle, which is an angle of an arm 142 with respect to the boom 141. Further, the imaging device angle sensor detects the imaging device angle, which is an angle of the optical axis of the imaging device 112 that is changed by the driving device 150.
The actual machine output interface 120 comprises an actual machine wireless communication device 121 that executes wireless communication with the remote operation device 20.
A working attachment 140 that is the actuating mechanism comprises a boom 141, an arm 142 and a bucket 143. The boom 141 is mounted on the upper revolving body 12 so as to be able to move up and down, and is driven by a boom cylinder to turn around a horizontal axis, thereby changing the boom angle.
The arm 142 is turnably connected to the end of the boom 141. The arm 142 is driven by an arm cylinder to turn around the horizontal axis, thereby changing the arm angle. The bucket 143 is turnably connected to the end of the arm 142 and is driven by a bucket cylinder to turn around the horizontal axis with respect to the arm 142.
The driving device 150 changes a posture of the imaging device 112, and is configured with a motor and a gear mechanism (not shown). As is to be described below, the driving device 150 is controlled by the actual machine control device 100 to change the posture (angle) of the imaging device 112 in three steps between a reference posture shown in
When the posture of imaging device 112 is the reference posture shown in
Here, a predetermined height range H (=h1−h2) is defined as a range between a first height h1 and a lower second height h2 from the bottom surface of the work machine 10, as shown in
When the posture of the imaging device 112 is the upper posture shown in
Specifically, the upper range R2 has: both left and right ends that is located outside the left and right ends of the front window 13a and the ceiling window 13b of the cabin 13, and that covers the entire ceiling window 13b; and a lower end that is located above the front window 13a. Additionally, the lower part of the upper range R2 overlaps with the upper part of the reference range R1.
The upper range R2 is set to a range in which the connection center C1 described above can be imaged when the connection center C1 is positioned higher than the predetermined height range H and is visible from the ceiling window 13b and above the center of the front window 13a in the vertical direction.
When the posture of the imaging device 112 is the lower posture shown in
Specifically, the lower range R3 has: both left and right ends located outside the left and right ends of the front window 13a of the cabin 13; the upper end located slightly above the center of the front window 13a in the vertical direction; and the lower end substantially coinciding with the lower end of the front window 13a. Additionally, substantially the upper half of the lower range R3 overlaps with substantially the lower half of the reference range R1.
The lower range R3 is set to a range in which the connection center C1 described above can be imaged when the connection center C1 is positioned at a position lower than the predetermined height range H and visible from the front window 13a.
Next, drive control processing is to be described with reference to
As shown in the figure, drive condition determination processing is first executed (
Next, it is determined whether an upper drive control flag F_UPPER is “1” (
If the determination is affirmative (
At that time, the posture change speed of the imaging device 112 is controlled corresponding to the moving speed V of the connection center C1. Specifically, control is performed so that the posture change speed of the imaging device 112 increases as the moving speed V of the connection center C1 increases. In this case, the moving speed V of the connection center C1 is calculated based on the detection signal of the sensor device 113 described above. After upper drive control processing is executed as described above, this processing ends.
Contrarily, if the above determination is negative (
When this determination is affirmative (
At that time, the posture change speed of the imaging device 112 is controlled in the same manner as in the upper drive control processing. In other words, control is performed so that the posture change speed of the imaging device 112 increases as the moving speed V of the connection center C1 increases. After lower drive control processing is executed as described above, this processing ends.
Contrarily, if the above determination is negative (
If this determination is affirmative (
At that time, the posture change speed (that is, the rotational angular speed) of the imaging device 112 is controlled in the same manner as the upper drive control processing and the lower drive control processing. In other words, control is performed so that the posture change speed of the imaging device 112 increases as the moving speed V of the connection center C1 increases. After the reference drive control processing is executed as described above, this processing ends.
Contrarily, if the above determination is negative (
Next, the drive condition determination processing described above is to be described with reference to
If this determination is negative (
If this determination is negative (
As shown in the figure, it is first determined whether the imaging device 112 is in the reference posture (
In this case, if all of the following conditions (f1) to (f2) are satisfied, it is determined that the upper switching condition is satisfied. Otherwise, it is determined that the upper switching condition is not satisfied.
In this case, both the moving speed V and the height hc of the connection center C1 are calculated based on the detection result of the sensor device 113 described above. The moving speed V is calculated as an absolute value of speed. The above Vref is a positive predetermined speed and c is a positive predetermined value. If all of the above (f1) to (f2) are satisfied, the connection center C1 is in a state of being presumed to deviate upward from the predetermined height range H described above.
If the above determination is affirmative (
Contrarily, if the above determination is negative (
In this case, if all of the following conditions (f3) to (f4) are satisfied, it is determined that the lower switching condition is satisfied. Otherwise, it is determined that the lower switching condition is not satisfied.
If all of the above conditions (f3) to (f4) are satisfied the connection center C1 is in a state of being presumed to deviate downward from the predetermined height range H described above. In the above conditions (f1) and (f3), the predetermined values to be compared with the absolute value V of the moving speed may be set to different values. Furthermore, in the above conditions (f2) and (f4), the predetermined values to be compared with the value h1−hc and the value hc−h2 may be set to different values.
If the above determination is affirmative (
Contrarily, if the above determination is negative (
Contrarily, if the above determination is negative (
The reference switching condition is a condition for executing reference drive control processing for switching the posture of the imaging device 112 from the upper posture or the lower posture to the reference posture. In this case, if all of the following conditions (f5) to (f6) are satisfied, or if all of the following conditions (f7) to (f8) are satisfied, it is determined that the reference switching condition is satisfied, and otherwise it is determined that the reference switching condition is not satisfied.
In the above conditions (f5) and (f7), the predetermined values to be compared with the absolute value V of the moving speed may be set to different values. Furthermore, in the above conditions (f6) and (f8), the predetermined values to be compared with the value hc−h1 and the value h2−hc may be set to different values.
If the above determination is affirmative (
Contrarily, if the above determination is negative (
Returning to
Contrarily, if the above determination is affirmative (
If this determination is affirmative (
Contrarily, if the above determination is affirmative (
If this determination is affirmative (
Contrarily, if the above-mentioned determination is affirmative (
If this determination is affirmative (
Next, image control processing is to be described with reference to
As shown in
Next, marker line superimposition processing is executed (
For example, when the posture of the imaging device 112 is the reference posture described above, the first marker line L1 and the second marker line L2 are respectively superimposed on the upper and lower parts of the captured image within the reference range R1, as shown in
When the posture of the imaging device 112 is the above-described upper posture, the first marker line L1 is superimposed on the region where the upper range R2 overlaps with the reference range R1, as shown in
When the posture of the imaging device 112 is the lower posture described above, the second marker line L2 is superimposed on the region that is located in an upper part of the lower range R3 and overlaps with the reference range R1, as shown in
While the above-described upper drive control processing changes the posture of the imaging device 112 from the reference posture to the upper posture to change the viewing angle range of the imaging device 112 from the reference range R1 to the upper range R2, the first marker line L1 is always superimposed on the captured image of the imaging device 112.
Similarly, while the reference drive control described above changes the posture of the imaging device 112 from the upper posture to the reference posture to change the viewing angle range of the imaging device 112 from the upper range R2 to the reference range R1, the first marker line L1 is always superimposed on the captured image of the imaging device 112.
In contrast, while the lower drive control processing described above changes the posture of the imaging device 112 from the reference posture to the lower posture to change the viewing angle range of the imaging device 112 from the reference range R1 to the lower range R3, the second marker line L2 is always superimposed on the captured image of the imaging device 112.
Similarly, while the reference drive control described above changes the posture of the imaging device 112 from the lower posture to the reference posture to change the viewing angle range of the imaging device 112 from the lower range R3 to the reference range R1, the second marker line L2 is always superimposed on the captured image of the imaging device 112.
As described above, in the marker line superimposition processing, at least one of the first marker line L1 and the second marker line L2 is superimposed on the captured image of the imaging device 112.
Next, an image signal including the captured image on which at least one of the first marker line L1 and the second marker line L2 is superimposed as described above is transmitted to the remote control device 200 of the remote operation device 20 (
When the image signal is thus transmitted to the remote control device 200 of the remote operation device 20, the captured image of the image signal is output from the image output device 221 of the remote operation device 20 to the operator 3. Thereby, the operator 3 can remotely operate the work machine 10 while visually recognizing the image near the connection center C1.
As described above, the actual machine control device 100 of the present embodiment executes the upper drive control processing when the upper switching condition is satisfied and the connection center C1 is presumed to deviate upward from the predetermined height range H. Thereby, the viewing angle range of the imaging device 112 is changed from the reference range R1 to the upper range R2. If the lower switching condition is satisfied and the connection center C1 is presumed to deviate downward from the predetermined height range H, the lower drive control processing is executed. Thereby, the viewing angle range of the imaging device 112 is changed from the reference range R1 to the lower range R3.
In this way, when the connection center C1 is in a state of being presumed to deviate from the predetermined height range H, the viewing angle range of the imaging device 112 is changed from the reference range R1 to the upper range R2 or the lower range R3. This, unlike the conventional art, makes it possible to quickly change the viewing angle range of the imaging device 112, resulting in prevention of a state in which the connection center C1 is not imaged. In addition, the viewing angle range of the imaging device 112 is not changed as long as the connection center C1 does not deviate from the predetermined height range H. This can prevent frequent changes in the image captured by the imaging device 112.
Also, the posture change speed of the imaging device 112 in the upper drive control processing and the lower drive control processing is controlled so as to increase as the moving speed V of the connection center C1 increases. This makes it possible to more reliably prevent a state in which the connection center C1 is not imaged.
Furthermore, the upper part of the reference range R1 and the lower part of the upper range R2 are configured to overlap with each other, and the lower part of the reference range R1 and the upper part of the lower range R3 are configured to overlap with each other. This makes it possible to prevent the operator 3 who remotely operates the work machine 10 from having a dead angle before and after switching the viewing angle range of the imaging device 112.
In addition, the imaging device 112 is arranged in the cabin 13 of the work machine 10, and the upper range R2 and the lower range R3 are set to ranges in which the connection center C1 can be imaged through the front window 13a and the ceiling window 13b of the cabin 13, respectively when the connection center C1 deviates upward and downward from the predetermined height range H. Therefore, even when the connection center C1 deviates upward and downward from the predetermined height range H, the operator 3 who remotely operates the work machine 10 can refer to an image near the connection center C1 as an image viewed from the cabin 13 of the work machine 10. This allows the operator 3 to recognize continuity of the images, with reference to the cabin 13, before and after change in the viewing angle range of the imaging device 112.
In the image control processing, when the viewing angle range of the imaging device 112 is changed between the reference range R1 and the upper range R2, the first marker line L1 indicating the first height h1 is displayed on a part, in the captured image, where the upper part of the reference range R1 overlaps with the lower part of the upper range R2. In addition to this, when the viewing angle range of the imaging device 112 is changed between the reference range R1 and the lower range R3, the second marker line indicating the second height h2 is superimposed and displayed on a part, in the captured image, where the lower part of the reference range R1 overlaps with the upper part of the lower range R3. This allows the operator 3 to recognize continuity of the captured images during the change, and before and after the change with reference to the first marker line L1 and the second marker line, when the viewing angle range of the imaging device 112 is changed between the reference range R1 and the upper range R2, and when it is changed between the reference range R1 and the lower range R3.
Both the determination of whether the upper switching condition is satisfied or not and the determination of whether the lower switching condition is satisfied or not are executed based on the distance from the height hc of the connection center C1 to the first height h1 or the second height h2 and the moving speed V of the connection center C1. Therefore, these determinations can be performed with high accuracy. This makes it possible to improve operability when the operator 3 remotely operates the work machine 10.
Note that the embodiment is an example in which the control device to be used is the actual machine control device 100. Alternatively, the control device to be used may be the remote control device 200 provided in the remote control room 2, or the control device to be used may be a server (not shown) provided to be able to communicate with work machine 10 via the network 4.
The embodiment is an example using the actual machine control device 100 provided in the work machine 10 as the determination unit. Alternatively, the remote control device 200 provided in the remote control room 2 may be used as the determination unit, or a server (not shown) provided to be able to communicate with work machine 10 via the network 4 may be used as the determination unit.
The embodiment is an example in which the control unit to be used is the actual machine control device 100 provided in the work machine 10. Alternatively, the control unit to be used may be the remote control device 200 provided in the remote control room 2, or the control unit to be used may be a server (not shown) provided to be able to communicate with work machine 10 via the network 4.
The embodiment is an example in which the connection center C1 is set to a predetermined portion of the attachment of the work machine. Alternatively, the end part or a predetermined portion of the bucket 143 may be set to the predetermined portion of the attachment, or a predetermined portion of the arm 142 may be set to the predetermined portion of the attachment.
The actual machine control device 100 may be configured to control the driving device 150 so that the speed at which the viewing angle range of the imaging device 112 is changed from the reference range R1 to the upper range R2 is faster than the speed at which the viewing angle range of the imaging device 112 is changed from the reference range R1 to the lower range R3. Alternatively, the actual machine control device 100 may be configured to control the driving device 150 so that the former is slower than the latter.
The first predetermined angle θ1 just needs to be set to an angle such that, when the viewing angle range of the imaging device 112 is switched from the reference range R1 to the upper range R2, the connection center C1 is positioned within the predetermined region of the upper range R2; and the second predetermined angle θ2 just needs to be set to an angle such that, when the viewing angle range of the imaging device 112 is switched from the reference range R1 to the lower range R3, the connection center C1 is positioned within the predetermined region of the lower range R3.
The embodiment is an example in which the first marker line L1, which is the line indicating the first height h1, is used as the first marker image, and the second marker line L2, which is the line indicating the second height h2, is used as the second marker image. However, it is not essential that the first marker line L1 and the second marker line L2 match the first height h1 and the second marker line L2, respectively. For example, the first marker line L1 may be displayed at a position shifted in the vertical direction with respect to the first height h1, and the second marker line L2 may be displayed at a position shifted in the vertical direction with respect to the second height h2. Also, the first marker image and the second marker image may be figures having shapes (for example, rectangles, circles, triangles, etc.) instead of lines such as the first marker line L1 and the second marker line L2.
In the work machine control device according to the present invention, it is preferable that the control unit determine the speed at which the viewing angle range of the imaging device is changed in one of the vertical directions corresponding to the moving speed of the predetermined portion of the attachment.
According to this work machine control device, the control unit controls the speed at which the viewing angle range of the imaging device is changed in one of the vertical directions corresponding to the moving speed of the predetermined portion of the attachment. Therefore, the viewing angle range of the imaging device can be changed at a speed corresponding to the moving speed of the predetermined portion of the attachment. This makes it possible to more reliably prevent a state in which the predetermined portion of the attachment is not imaged, and to further improve operability when an operator remotely operates the work machine.
The control device for the work machine according to the present invention is preferably configured so that:
This work machine control device is configured to be able to change the viewing angle range of the imaging device between a reference range, an upper range, and a lower range. The reference range is a range within which a predetermined portion of the attachment can be imaged when the predetermined portion is within a predetermined height range. The upper range has a center located above the center of the reference range by a first predetermined angle. The lower range has a center located lower than the center of the reference range by the second predetermined angle. In addition, the upper part of the reference range and the lower part of the upper range are configured to overlap with each other, and the lower part of the reference range and the upper part of the lower range are configured to overlap with each other. This makes it possible to prevent the operator who remotely operates the work machine from having a dead angle before and after switching the viewing angle range of the imaging device. This can reliably provide high operability.
The control device for the work machine according to the present invention is preferably configured so that the imaging device is arranged inside a cabin of the work machine, and the upper range and the lower range are set to a range in which the predetermined portion of the attachment can be imaged through a window of the cabin when the predetermined portion respectively deviates upward and downward from the predetermined height range.
According to this work machine control device, the imaging device is arranged in the cabin of the work machine. Further, the upper range and the lower range are set to a range in which the predetermined portion of the attachment can be imaged through the window of the cabin when the predetermined portion of the attachment deviates respectively upward and downward from the predetermined height range. Therefore, even when the predetermined portion of the attachment deviates upward and downward from the predetermined height range, an operator who remotely operates the work machine can refer to an image of a predetermined portion of the attachment as viewed from the cabin of the work machine. This allows the operator to recognize continuity of the images, with reference to the cabin, before and after change in the viewing angle range of the imaging device, and to be reliably provided with high operability in remotely operating the work machine.
The control device for the work machine according to the present invention is preferably configured so that
According to this work machine control device, image control is further executed by the control unit. This image control displays the first marker image on a part, in the image captured by the imaging device, where the upper part of the reference range overlaps with the lower part of the upper range, when the viewing angle range of the imaging device is changed between the reference range and the upper range. In addition to this, the image control superimposes and displays the second marker image on a part, in the image captured by the imaging device, where the lower part of the reference range overlaps with the upper part of the lower range, when the viewing angle range of the imaging device is changed between the reference range and the lower range. This allows the operator to recognize continuity of the images during the change, and before and after the change with reference to the first marker image and the second marker image, when the viewing angle range of the imaging device is changed between the reference range and the upper range, and when it is changed between the reference range and the lower range, and can reliably provide high operability in remotely operating the work machine.
The control device for the work machine according to the present invention is preferably configured so that if a distance from a height of the predetermined portion of the attachment to one of the first height and the second height is equal to or less than a predetermined value and a moving speed at which the predetermined portion moves toward the one of the heights is equal to or higher than a predetermined speed, the determination unit determines that the predetermined portion of the attachment is in a state of being presumed to deviate into one of vertical directions from the predetermined height range.
The control device of this work machine determines whether a predetermined portion of the attachment is likely to deviate from a predetermined height range based on the distance from the height of the predetermined portion to the first height or the second height, and the moving speed at which the predetermined portion moves toward the first height or the second height. Therefore, these determinations can be performed with high accuracy.
Number | Date | Country | Kind |
---|---|---|---|
2020-171168 | Oct 2020 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2021/026953 | 7/19/2021 | WO |