The present invention relates to a work machine such as a hydraulic excavator or a hydraulic crane to which an entry-prohibited area for a work implement is set to perform a work.
A work machine represented, for example, by a hydraulic excavator can perform complicated action efficiently by simultaneously driving a plurality of members that configure the work implement such as a boom and an arm.
In recent years, in order to ensure a high work efficiency in such a work machine as described above without depending upon the proficiency of the operator, a work supporting system has been proposed which decelerates, when its work implement comes near to a target plane, the work implement to prevent the work implement from contacting a surrounding obstacle.
For example, Patent Document 1 discloses a technology for area limiting control in which, after an operator sets an entry-prohibited area within a range within which the work implement can act before the work is started, the distance between the entry-prohibited area and the machine body is measured at the time of the work on the basis of sensor information, and then the work implement is decelerated and stopped such that the work implement does not enter the entry-prohibited area. Patent Document 1 further discloses a technology in which a claw tip position of the work implement is sensed and an entry-prohibited area plane for area limiting control is set.
Regarding the shape of the entry-prohibited area plane in a case where area limiting control is performed, for example, a shape is available in which a plane perpendicular to the crawler bottom plane is set as depicted in
Here, where a plane perpendicular to the crawler bottom plane is set as an entry-prohibited area plane, if the entry-prohibited area plane is set in the inside of a rear end radius circle of the upper swing structure, then while deviation suppression of the work implement can be implemented, there is the possibility that, when the upper swing structure performs a swing action, the rear end of the upper swing structure may enter the entry-prohibited area.
In order to set an entry-prohibited area plane at a position at which the rear end of the upper swing structure does not enter the entry-prohibited area, it is necessary for the operator to repeat trial and error, which is a burden on the operator.
It is an object of the present invention to provide a work machine that can reduce the burden on an operator when an entry-prohibited area plane for area limiting control is set.
In order to attain the object described above, according to the present invention, there is provided a work machine comprising a lower track structure, an upper swing structure swingably mounted on an upper portion of the lower track structure, a work implement attached pivotally in an upward and downward direction at a front portion of the upper swing structure, and a controller that performs area limiting control such that the work implement does not enter an entry-prohibited area beyond an entry-prohibited area plane set in advance, wherein the work machine includes a setting operation device used for setting a target position of the entry-prohibited area plane, and the controller is configured to set the entry-prohibited area plane at the target position set by the setting operation device when a distance between the target position set by the setting operation device and a center of swing action of the upper swing structure is greater than a threshold value set based on a distance from the center of swing action of the upper swing structure to a rear end of the upper swing structure.
With the present invention, since the machine body side determines whether swing action is possible or not at the time of setting of the position of an entry-prohibited area plane, the burden on the operator at the time of position setting of the entry-prohibited area plane can be reduced.
In the following, embodiments of the present invention are described in detail with reference to the drawings.
<Work Machine>
Referring to
The lower track structure 100 includes left and right crawlers 100a and 100b.
The boom 103a, arm 103b, and bucket 103c are driven by a boom cylinder 104a, an arm cylinder 104b, and a bucket cylinder 104c, respectively. The left and right crawlers 100a and 100b are driven by left and right travel motors 104d and 104e, respectively. The upper swing structure 102 is driven by a swing motor 104f installed on a swing frame 102a.
On the swing frame 102a of the upper swing structure 102, a center joint (not depicted) is provided which connects hydraulic hoses positioned on the upper swing structure 102 side and hydraulic hoses positioned on the lower track structure 100 side to each other such that those hydraulic hoses are not twisted by the swing action of the upper swing structure 102. Further, an angle sensor 24 that senses a swing angle of the upper swing structure 102 with respect to the lower track structure 100 is provided on the center joint.
Further, on the boom 103a, arm 103b, and bucket 103c, a boom IMU sensor 25, an arm IMU sensor 26, and a bucket IMU sensor 27 are provided, respectively, as a plurality of posture sensors that sense the posture of the work implement 103. The boom IMU sensor 25, arm IMU sensor 26, and bucket IMU sensor 27 individually sense the posture of the work implement 103 from changes in kinetic momentum of the sensor elements.
A cabin 105 that forms the operator cab is installed at a left side front portion of the upper swing structure 102.
<Inside of Cabin>
Referring to
The operation lever devices 3 and 4 are provided on the left and right in front of the operator seat 2, and the left side operation lever device 3 issues instructions of action of the arm 103b and the upper swing structure 102, and the right side operation lever device 4 issues instructions of action of the boom 103a and the bucket 103c.
The operation lever devices 5 and 6 are provided side by side at a middle portion of the floor on the front side of the operator seat 2, and the left side operation lever device 5 issues instructions of action of the left crawler 100a, and the right side operation lever device 6 issues instructions of action of the right crawler 100b.
Further, the cabin 105 has two pillars 7a and 7b that support the front side of the roof unit, and a windshield 8 is fitted between the two pillars 7a and 7b. Further, on the pillar 7b on the right side as viewed from the operator seat 2, a monitor 9 is installed which is used for setting of an entry-prohibited area plane, other vehicle body setting, and field-of-view assistance. Further, the monitor 9 has a function of displaying details of area limiting control (ON/OFF of area limiting control, position and validity/invalidity of an entry-prohibited area plane, and validity/invalidity of deceleration control).
Furthermore, on the rear side of the operation lever device 4 on the right side of the operator seat 2, and particularly, on the right side of the operator seated on the operator seat 2, a console box 10 is provided. A console switch 11 and a monitor operation device 12 are provided as a setting operation device used for setting of a target position of the entry-prohibited area plane for the area limiting control are provided on the console box 10.
<Hydraulic System>
Referring to
It is to be noted that, in
The operation devices 3a, 3b, 4a, 4b, 5, and 6 are connected to the control valve 16 through pilot lines 17a, 17b, 17c, 17d, 17e, and 17f, respectively, such that an operation pilot pressure generated by them is introduced into the spool valves of the control valve 16 through the pilot lines 17a, 17b, 17c, 17d, 17e, and 17f, respectively. The spool valves of the control valve 16 are switched by the operation pilot pressure and control the flow rate and the flowing direction of hydraulic fluid to be supplied from the hydraulic pump 15 to the plurality of actuators.
In the pilot lines 17a, 17c, and 17d of the operation lever devices 3a, 4a, and 4b, pressure reducing valves 18a, 18b, and 18c are provided, respectively. When area limiting control is performed, the pressure reducing valves 18a, 18b, and 18c are rendered operative to reduce the operation pilot pressure to perform deceleration and stopping control of the work implement 103.
It is to be noted that, in order for the operation device devices 3a, 3b, 4a, 4b, 5, and 6 to individually generate two operation pilot pressures for instructions of action in opposite directions of the boom 103a, arm 103b, bucket 103c, upper swing structure 102, and left and right crawlers 100a and 100b, for each of the pilot lines 17a, 17b, 17c, 17d, 17e, and 17f, two pilot lines are provided for each one operation lever device. However, in
<Control System>
Referring to
The main controller 21 is disposed, for example, at the rear side of the operator seat 2. The monitor controller 22 is disposed, for example, at the lower side of the console box 10.
In the main controller 21, an entry-prohibited area plane including a vertical plane is set in advance as hereinafter described, and the main controller 21 performs area limiting control such that the work implement 103 does not enter an entry-prohibited area beyond the entry-prohibited area plane set in advance.
Further, the main controller 21 is configured to set the entry-prohibited area plane at the target position when a distance between the target position set by the console switch 11 or the monitor operation device 12 (setting operation device) and a center of swing action of the upper swing structure 102 is greater than a threshold value set based on a distance from the center of swing action of the upper swing structure 102 to a rear end of the upper swing structure 102.[0038]
In the present invention, an entry-prohibited area plane including a vertical plane is targeted. The vertical plane signifies a plane perpendicular to the crawler bottom plane of the lower track structure 100 (bottom plane of the left and right crawlers 100a and 100b). The entry-prohibited area plane may include a plane other than a vertical plane, for example, an inclined plane or a curved plane if the plane includes a vertical plane.
In the following, a case is described in which the entry-prohibited area plane is a vertical plane. Where the entry-prohibited area plane includes a plane other than a vertical plane, it is sufficient if the following operation or processes by the main controller 21 are applied to the vertical plane portion of the entry-prohibited area plane.
The operator, when an entry-prohibited area plane is to be set, operates the monitor operation device 12 to turn an entry-prohibited area plane setting mode ON.
An ON signal of the entry-prohibited area plane setting mode is transmitted from the monitor controller 22 to the main controller 21, and the main controller 21 places the setting function of an entry-prohibited area plane into a standby state.
Further, the operator, when an entry-prohibited area plane is to be set, performs operation for issuing instruction of a target position of an entry-prohibited area plane. For the target position instruction method for an entry-prohibited area plane, a method by positioning of the work implement 103 and a method by numerical inputting with use of the monitor operation device 12 are available.
It is necessary for the entry-prohibited area plane to be set at a position at which the rear end of the monitor operation device 12 does not enter the entry-prohibited area plane.
Further, in
˜
The operator performs operation to align all claw tips of a plurality of claws 103c1 formed at the distal end of the bucket 103c with the target position M of the entry-prohibited area plane by the operation lever devices 3a, 3b, 4a, and 4b, and depresses the console switch 11 when all claw tips of the plurality of claws 103c1 are aligned with to the target position M of the entry-prohibited area plane. When the console switch 11 is depressed, a switch signal is transmitted from the console switch 11 to the main controller 21 via the monitor controller 22. When the main controller 21 receives the signal from the console switch 11, the main controller 21 computes position information of a line segment that contacts with all claw tips of the plurality of claws 103c1 of the work implement 103 at that time on the basis of sensor signals from the angle sensor 24, boom IMU sensor 25, arm IMU sensor 26, and bucket IMU sensor 27. Further, the main controller 21 computes information of the target position M of the entry-prohibited area plane (for example, r1 and θ hereinafter described) at that time from the position information of the line segment and stores the computed information as target position information of the entry-prohibited area plane.
˜
In
˜
Using the monitor operation device 12, as depicted in
˜
In
˜
Using the monitor operation device 12, the operator displays a polar coordinate system on the screen of the monitor 9 similarly to the case of
<Main Controller>
Now, details of a setting process of an entry-prohibited area plane performed by the main controller 21 is described with reference to
Further, the processing procedure of
Referring to
Then, the main controller 21 computes position information of a line segment that is tangent to all claw tips of the plurality of claws 103c1 of the bucket 103c on the basis of the received sensor signals. Further, the main controller 21 computes, from the position information of the line segment, a distance r1 between the target position M of the entry-prohibited area plane and the center O of swing action of the upper swing structure 102 and a deflection angle θ, and stores them as target position information of the entry-prohibited area plane (step S110).
Here, the distance r1 between the target position M of the entry-prohibited area plane and the center O of swing action of the upper swing structure 102 is a length of a perpendicular N to the target position M, which passes the center O of swing action of the upper swing structure 102, as depicted in
Then, the main controller 21 decides whether or not the distance r1 is greater than a threshold value set based on the distance r2 from the center O of swing action of the upper swing structure 102 to the rear end of the upper swing structure 102 (step S115). In the present embodiment, the threshold value is set to a value equal to the distance r2 from the center O of swing action of the upper swing structure 102 to the rear end of the upper swing structure 102. Namely, the threshold value is equal to r2.
The main controller 21 is configured to validate the distance r1 and the deflection angle θ as target position information of the entry-prohibited area plane when the distance r1 is greater than the threshold value r2, and sets the entry-prohibited area plane at the target position M (step S120) and controls the monitor 9 to display that setting of an entry-prohibited area plane results in success (step S125).
On the other hand, the main controller 21 erases and discards the stored target position information (distance r1 and deflection angle θ) (step S130) when the distance r1 is equal to or smaller than the threshold value r2, and controls the monitor 9 to display that setting of an entry-prohibited area plane results in failure (step S135).
<Advantage>
In the present embodiment configured in this manner, only an entry-prohibited area plane into which the rear end of the upper swing structure 102 does not enter is selected and set automatically. Then, where an entry-prohibited area plane is set, the monitor 9 in the cabin 105 displays that setting of an entry-prohibited area plane results in success, but where an entry-prohibited area plane is not set, the monitor 9 displays that setting of an entry-prohibited area plane results in failure. Therefore, the operator can precisely grasp a result of setting of an entry-prohibited area plane, and the burden on the operator can be reduced when an entry-prohibited area plane for area limiting control is set.
It is to be noted that, although, in the present embodiment, a value equal to the distance r2 from the center O of swing action of the upper swing structure 102 to the rear end of the upper swing structure 102 is set as the threshold value for use for decision of the distance r1, a value that is obtained by adding a predetermined distance to the distance r2 and therefore is greater than the distance r2 may be set as the threshold value.
Depending upon the situation of the work site, some other worker may engage in some work near an entry-prohibited area plane in an entry-prohibited area. In such a case, if the threshold value to be used for decision of the distance r1 is set to a value greater than the swing structure rear end radius r2, then even if the worker enters the work area of the hydraulic excavator beyond the entry-prohibited area plane from within the entry-prohibited area, the distance between the rear end of the upper swing structure 102 and the worker can be secured.
A second embodiment of the present invention is described with reference to
Referring to
In particular, in the present embodiment, the main controller 21 is configured to set a corrected entry-prohibited area plane as the entry-prohibited area plane when, in step S115, the distance r1 between the target position M of the entry-prohibited area plane set by the console switch 11 (setting operation device) and the center O of swing action of the upper swing structure 102 is equal to or smaller than the threshold value r2 (step S140). The corrected entry-prohibited area plane is an area plane determined by excluding a range inside the virtual circle S having a radius equal to the threshold value r2 from the entry-prohibited area plane when the entry-prohibited area plane is set at the target position M.
More particularly, in step S140, the main controller 21 computes positions of two intersection points C1 and C2 between the virtual circle S having a radius equal to the threshold value r2 in the entry-prohibited area plane and the entry-prohibited area plane when the entry-prohibited area plane is set at the target position M, excludes target position information of an inner side range (range that is the inner side of the virtual circle S having a radius equal to the threshold value r2) Ra positioned between the intersection points C1 and C2 from the target position information of the entry-prohibited area plane to set target positions M1 and M2, and sets a corrected entry-prohibited area plane at the target positions M1 and M2.
Then, the main controller 21 controls the monitor 9 to display the target positions M1 and M2 as the corrected entry-prohibited area plane (step S150).
In the present embodiment configured in this manner, when the decision in step S115 is in the positive, processes similar to those in the first embodiment are performed, and therefore, advantages similar to those of the first embodiment are obtained.
Further, when the operator sets an entry-prohibited area plane to perform a work, there is a case in which the operator grasps the situation around the machine body sufficiently and even if a rear portion of the upper swing structure 102 only a little enters the entry-prohibited area plane, it can be decided that a swing action is permissible. In such a case where the entry-prohibited area plane is used for prevention of excessive excavation or the like, the swing action is permissible.
In such a case as described above, according to the present embodiment, as an entry-prohibited area plane, the corrected entry-prohibited area plane obtained by excluding the range Ra inside the virtual circle S having a radius equal to the threshold value r2 is set, and this corrected entry-prohibited area plane is displayed on the monitor 9 to give the operator an opportunity to decide whether or not the set entry-prohibited area plane is to be adopted, and when the operator decides that the entry-prohibited area plane can be adopted, it is possible for the operator to set the entry-prohibited area plane and perform the work. This eliminates the necessity for a work for setting an entry-prohibited area plane again, and an advantage that the convenience in setting of an entry-prohibited area plane is improved is obtained.
A third embodiment of the present invention is described with reference to
Referring to
In particular, in the present embodiment, the main controller 21 is configured to set a corrected entry-prohibited area plane as the entry-prohibited area plane when, in step S115, the distance r1 between the target position M of the entry-prohibited area plane set by the console switch 11 (setting operation device) and the center O of swing action of the upper swing structure 102 is equal to or smaller than the threshold value r2 (step S145). The corrected entry-prohibited area plane in the present embodiment is an area plane determined by excluding a range inside the virtual circle S having a radius equal to the threshold value r2 from the entry-prohibited area plane when the entry-prohibited area plane is set at the target position M and replacing the excluded range with an arc of the virtual circle S.
More particularly, in step S145, the main controller 21 computes, positions of two intersection points C1 and C2 between the virtual circle S having a radius equal to the threshold value r2 and the entry-prohibited area plane, when the entry-prohibited area plane is set at the target position M, and then replaces the target position information of the range inside the two intersection points C1 and C2 of the entry-prohibited area plane (range inside the virtual circle S having a radius equal to the threshold value r2) Ra with position information of an arc Sa in the inside range Ra between the two intersection points C1 and C2 of the virtual circle S to set target positions M1, Sa and M2, and sets the corrected entry-prohibited area plane at the target positions M1, Sa, and M2.
Then, the main controller 21 controls the monitor 9 to display the target positions M1, Sa, and M2 as the corrected entry-prohibited area plane (step S150).
Also with the present embodiment, advantages similar to those of the second embodiment are obtained.
A fourth embodiment of the present invention is described with reference to
The first to third embodiments use, as the target position instruction method for an entry-prohibited area plane, the method by positioning of the work implement 103 depicted in
In the target position instruction method for an entry-prohibited area plane that uses the monitor operation device 12 depicted in
Further, since not the console switch 11 but the monitor operation device 12 is used for instruction of a target position of an entry-prohibited area plane, the main controller 21 decides whether or not transmission of input information from the monitor operation device 12 is received (step S100A). When transmission of input information from the monitor operation device 12 is received, the main controller 21 computes a distance r1 from the center O of swing action of the upper swing structure 102 to an entry-prohibited area plane to be set and a deflection angle θ as the target position information of the entry-prohibited area plane, and stores the distance r1 and the deflection angle θ as target position information of the entry-prohibited area plane (step S110A).
The procedure after this is same as that of the flow chart depicted in
Also with the present embodiment configured in such a manner as described above, advantages similar to those by the first embodiment can be obtained.
It is to be noted that, although, in the fourth embodiment, the procedure in steps S100 to S110 of the flow chart of the first embodiment depicted in
Number | Date | Country | Kind |
---|---|---|---|
2021-056108 | Mar 2021 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2021/041423 | 11/10/2021 | WO |