The present invention relates to a work machine such as a hydraulic excavator.
There has been known a control system in which when performing construction by use of a hydraulic excavator (work machine) including a front work device including a boom, an arm and a bucket, the front work device is operated by correcting the operator's operation by use of preliminarily prepared three-dimensional design data on a target surface, such that the bucket is moved along the target surface (design surface) prescribed in design drawing, to perform an excavation forming work on a semi-automatic basis.
The excavation forming work includes (1) an “excavation work” of putting each cylinder of the boom and the arm into automatic coordination operation to move the bucket claw tip along the target surface, thereby to excavate the terrain, and (2) a “leveling work” of putting each cylinder of the bucket, the boom and the arm into automatic coordination operation to move the bucket bottom surface along the target surface while maintaining the bucket bottom surface substantially in parallel to the target surface, thereby to shape the terrain.
In addition, after one time of excavation forming work is completed, a “returning work” of taking a posture for starting the next-time excavation forming work according to the operator's operation, without moving the bucket along the target surface, is present.
As an example, Patent Document 1 is mentioned.
In a work machine (construction machine) described in Patent Document 1, a leveling work of moving the bucket bottom surface along the target surface is performed, by putting the arm and the boom into automatic coordination operation such that the posture of the bucket relative to the target surface becomes constant, based on the shortest distance from the bucket to the target surface, arm operation, and bucket operation.
Specifically, when an arm operation is performed by the operator, the operator is deemed as intending to perform a leveling work, the bucket cylinder, the boom cylinder and the arm cylinder are put into automatic coordination operation, and, while performing a bucket automatic operation such as to automatically maintain a state in which the bucket bottom surface is in parallel to the target surface, the bucket is moved along the target surface, to perform the leveling work. This enables the operator to easily perform the leveling work by only an arm operation.
It is to be noted, however, that when a bucket operation is conducted by the operator, or when the shortest distance from the bucket to the target surface is greater than a predetermined threshold (D1), the bucket automatic operation of automatically holding the bucket posture for the leveling work is not performed. In other words, when the operator intends to adjust the bucket posture by his or her own operation, or in the case of performing a returning work by separating the bucket from the target surface, the automatic operation of the bucket is not conducted.
However, in the work machine described in Patent Document 1, depending on the posture of the bucket at the time when the returning work is completed, work efficiency or operability may be spoiled, in transition thereafter to the leveling work.
In the case of performing the leveling work, in general, the posture of the bucket becomes a posture such that the bucket bottom surface is nearly parallel to the target surface, as depicted in
When the returning work is finished in a posture as depicted in
When the threshold D1 for the shortest distance between the bucket and the target surface, at which the bucket automatic operation is possible, is reduced below d1thr (for example, D1=0), the bucket automatic operation is not triggered even if an arm operation is inputted in the state of
Therefore, to prevent a lowering in the work efficiency in transition after the returning work to the leveling work, it may be contemplated to preliminarily set the threshold D1 for the shortest distance between the bucket and the target surface, at which the bucket automatic operation is possible, to be greater than d1thr. In that case, even if the bucket posture is adjusted as depicted in
However, when the threshold D1 for the shortest distance between the bucket and the target surface, at which the bucket automatic operation is possible, is set large, the possibility that the shortest distance between the bucket and the target surface may become less than the threshold D1 during the returning work (for example, during an arm dumping operation) is enhanced. When the shortest distance between the bucket and the target surface becomes less than the threshold D1 during the arm dumping operation, the bucket automatic operation would be triggered against the operator's will, possibly giving a discomfort to the operator.
The present invention has been made in consideration of the above problems. It is an object of the present invention to provide a work machine capable of performing a leveling work, while spoiling neither of the work efficiency at the time of transition from a returning work to the leveling work nor the operability at the time of the returning work.
In order to achieve the above object, according to the present invention, there is provided a work machine including: a work device having a boom, an arm and a bucket; an operation device for operating the work device; and a controller capable of controlling the work device using an excavation work control for controlling the work device so as to cause a claw tip of the bucket to move along a predetermined target surface and a leveling work control for controlling the work device so as to cause the bucket to move along the target surface while maintaining a posture of the bucket with respect to the target surface, in which the controller is configured to: calculate, based on posture data and size data on the work device and position data on the target surface, an arm tip difference that is a distance from a tip of the arm to the target surface; execute the leveling work control when the calculated arm tip difference is equal to or less than a predetermined threshold, when there is no input of a bucket operation to the operation device, and when there is an input of an arm operation to the operation device; and execute the excavation work control when the calculated arm tip difference is more than the predetermined threshold, or when there is an input of the bucket operation to the operation device, or when there is no input of the arm operation to the operation device.
According to the present invention, a leveling work can be performed, while spoiling neither of the work efficiency at the time of transition from a returning work to the leveling work nor the operability at the time of the returning work. Note that the above and other objects, configurations and effects will be made clear by the following description of embodiments.
Embodiments of the present invention will be described below using the drawings.
The lower track structure 9 has left and right crawler track devices, which are driven by left and right track hydraulic motors 3a and 3b (only the left side 3b is illustrated).
The upper swing structure 10 is mounted on the lower track structure 9 in the manner of being swingable to the left and the right, and is driven to swing by a swing hydraulic motor 4. An engine 14 as a prime mover, a hydraulic pump device 2 (a first hydraulic pump 2a and a second hydraulic pump 2b (see
The work device 15 has an articulated structure having a boom 11, an arm 12 and a bucket 8 which are a plurality of swingable front members. The boom 11 is swung relative to the upper swing structure 10 by extension and contraction of a boom cylinder 5, the arm 12 is swung relative to the boom 11 by extension and contraction of an arm cylinder 6, and the bucket 8 is swung relative to the arm 12 by extension and contraction of a bucket cylinder 7.
In order to calculate the position of an optional point on the work device 15 in the controller 500, the hydraulic excavator includes a first posture sensor 13a that is provided in the vicinity of a junction between the upper swing structure 10 and the boom 11 and that detects the angle (boom angle) of the boom 11 relative to a horizontal plane, a second posture sensor 13b that is provided in the vicinity of a junction between the boom 11 and the arm 12 and that detects the angle (arm angle) of the arm 12 relative to a horizontal plane, a third posture sensor 13c that is provided in the vicinity of a bucket link 8a connecting the arm 12 with the bucket 8 and that detects the angle (bucket angle) of the bucket link 8a relative to a horizontal plane, and a machine body posture sensor 13d that detects the inclination angle (roll angle, pitch angle) of the upper swing structure 10 relative to a horizontal plane. Note that as the posture sensors 13a to 13d, for example, IMUs (Inertial Measurement Units) can be used. In addition, the first posture sensor 13a to the third posture sensor 13c may be sensors that detect a relative angle.
The angles detected by these posture sensors 13a to 13d are inputted to an information processing section 100 in the controller 500 described later as posture data including boom angle data, arm angle data, bucket angle data, and machine body angle data.
The upper swing structure 10 includes a cab. A track right operation lever device 1a, a track left operation lever device 1b, a right operation lever device 1c and a left operation lever device 1d and the like are disposed in the cab as operation devices for operating the work device 15 (the front members 11, 12, and 8), the upper swing structure 10 and the lower track structure 9. The track right operation lever device 1a is a device for issuing an operation instruction on a right track hydraulic motor 3a, the track left operation lever device 1b is a device for issuing an operation instruction on a left track hydraulic motor 3b, the right operation lever device 1c is a device for issuing operation instructions on the boom cylinder 5 (boom 11) and the bucket cylinder 7 (bucket 8), and the left operation lever device 1d is a device for issuing operation instructions on the arm cylinder 6 (arm 12) and the swing hydraulic motor 4 (upper swing structure 10). The operation devices 1a to 1d in the present embodiment are electric levers, which generate operation signals (electrical signals) according to operation amounts inputted by the operator, and outputs them to the controller 500. Note that the operation devices 1a to 1d may be of hydraulic pilot system, and operation amounts thereof may be detected by pressure sensors and may be inputted to the controller 500.
The control valve 20 is a valve device including a plurality of directional control valves (for example, directional control valves 21, 22, and 23 in
In the hydraulic driving device of
The control valve 20 is provided with two systems of pump lines, namely, the first pump line L1 and the second pump line L2. A boom directional control valve 22 for controlling the flow (flow rate and direction) of the hydraulic working fluid supplied to the boom cylinder 5 and a bucket directional control valve 21 for controlling the flow of the hydraulic working fluid supplied to the bucket cylinder 7 are connected to the first pump line L1. Thus, the hydraulic working fluid delivered by the first hydraulic pump 2a is supplied to the boom cylinder 5 and the bucket cylinder 7. Similarly, an arm directional control valve 23 for controlling the flow of the hydraulic working fluid supplied to the arm cylinder 6 is connected to the second pump line L2, and the hydraulic working fluid delivered by the second hydraulic pump 2b is supplied to the arm cylinder 6. Note that the boom directional control valve 22 and the bucket directional control valve 21 are configured to be capable of branched flow by a parallel circuit L1a.
In addition, relief valves 26 and 27 are individually connected to the first pump line L1 and the second pump line L2. When the pressures inside the respective pump lines L1 and L2 reach preset relief pressures, the relief valves 26 and 27 are opened to cause the hydraulic working fluid to escape to a tank.
The boom directional control valve 22 is operated by signal pressures generated by the solenoid proportional valves 22a and 22b. Similarly, the arm directional control valve 23 is operated by signal pressures of the solenoid proportional valves 23a and 23b, and the bucket directional control valve 21 is operated by signal pressures of the solenoid proportional valves 21a and 21b.
These solenoid proportional valves 21a to 23b reduce a pilot hydraulic working fluid (primary pressure) supplied from a pilot hydraulic pressure source 29, based on command currents (control valve driving signals) outputted from the controller 500, and output the thus generated signal pressures to the directional control valves 21 to 23.
The right operation lever device 1c outputs voltage signals according to the operation amount and operation direction of the operation lever to the main controller 500 as boom operation amount data and bucket operation amount data. Similarly, the left operation lever 1d outputs voltage signals according to the operation amount and operation direction of the operation lever to the main controller 500 as arm operation amount data.
The main controller 500, based on the operation amount data inputted from the operation lever devices 1c and 1d to the front members 11, 12, and 8, setting data inputted from a leveling work control setting switch (leveling work control setting device) 17, position data of a target surface (target surface data) inputted from a target surface setting device 18, posture data on the hydraulic excavator inputted from the angle sensors 13a to 13d, and size data inputted from the machine body information storage device 19 that is data concerning the size of the hydraulic excavator, calculates command signals (command currents) for controlling the solenoid proportional valves 21a to 23b, and outputs the calculated command signals to the solenoid proportional valves 21a to 23b.
The leveling work control setting switch 17 is set in the cab of the hydraulic excavator, and is changed to either one changeover position of a permission position and an inhibition position by an operator's operation. In the case in which the leveling work control setting switch 17 is changed over to the permission position for permitting execution of a leveling work control by the main controller 500, the leveling work control setting switch 17 outputs “true” as setting data. Conversely, in the case in which the leveling work control setting switch 17 is changed over to the inhibition position for inhibiting execution of the leveling work control by the main controller 500, the leveling work control setting switch 17 outputs “false” as the setting data. Note that in the present embodiment, the contents of the setting data are determined according to the changeover position of the leveling work control setting switch 17, the contents of the setting data may be determined by other calculation in the controller 500; for example, the angle of the bucket 8 relative to the target surface may be determined based on the aforementioned posture data, and the setting data may be true when the calculated angle is included within a predetermined range, and the setting data may be false when the calculated angle is not included in the predetermined range.
The target surface setting device 18 is a device for setting a target surface as an object of work and for storing the position data of the set target surface (target surface data), and outputs the target surface data to the main controller 500. The target surface data are data prescribing a three-dimensional shape of the target surface, and, in the present embodiment, include position information and angle information concerning the target surface. In the present embodiment, the position of the target surface is defined as a relative distance information with respect to the upper swing structure 10 (hydraulic excavator) (namely, position data of the target surface with respect to the hydraulic excavator 1), and the angle of the target surface is defined as a relative angle information with respect to the vertical direction, but the position may be coordinates of the position on the earth, the angle may be a relative angle with respect to the machine body, and data obtained by appropriate conversion may be utilized.
Note that it is sufficient that the target surface setting device 18 includes a function of storing the preset target surface data, and, for example, it may be replaced by a storage device such as a semiconductor memory. Therefore, in the case in which the target surface data are stored in, for example, a storage device in the controller 500 or a storage device mounted on the hydraulic excavator, the target surface setting device 18 can be omitted.
The machine body information storage device 19 is a device utilized for storing size data of parts constituting the hydraulic excavator (for example, the lower track structure 9, the upper swing structure 10, and the front members 11, 12, and 8 constituting the front work device 15) that are preliminarily measured, and outputs the size data to the main controller 500.
The main controller 500 is a controller that performs various kinds of control concerning the hydraulic excavator, and particularly, is characterized in that it is configured to be capable of executing excavation work control in which target velocities with respect to the front members 11, 12, and 8 (for example, target velocities (target actuator velocities) of the hydraulic cylinders 5, 6, and 7) are calculated such that the claw tip of the bucket 8 moves along the target surface and control of the work device 15 is performed based on the target velocities, and executing leveling work control in which target velocities with respect to the front members 11, 12, and 8 are calculated such that the bucket 8 moves along the target surface while maintaining the posture of the bucket 8 relative to the target surface (for example, the angle of the bucket bottom surface relative to the target surface is a value close to zero) and control of the work device 15 is performed based on the target velocities.
The information processing section 100, based on operation amount data from the operation lever devices 1c and 1d, posture data from the posture sensors 13a to 13d, setting data from the leveling work control setting switch 17, target surface data from the target surface setting device 18, and size data from the machine body information storage device 19, calculates target actuator velocities for the hydraulic cylinders 5, 6, and 7, and outputs the target actuator velocities to the control valve driving section 200. The control valve driving section 200 generates a control valve driving signal according to the target actuator velocities, and drives the control valve 20.
Details of the information processing section 100 will be described using
The claw tip difference calculation section 110, based on the position of the claw tip of the bucket 8 that is calculated from posture data and size data as well as target surface data, calculates the distance between the claw tip of the bucket 8 and the target surface (claw tip difference Dvt), and outputs the calculation result as claw tip difference data.
Here, as a coordinate system (machine body coordinate system) set on the hydraulic excavator, a coordinate system (machine body coordinate system) in which a point at which the lower track structure 9 makes contact with the ground surface on a swing center axis of the hydraulic excavator (upper swing structure 10) is made to be an origin, an X axis is set in the front-rear direction of the machine body, a Y axis is set in the width direction of the machine body, and a Z axis is set in the vertical direction of the machine body is utilized. In this case, the length Lsb between the swing center of the upper swing structure 10 and a boom pin in the X-axis direction, the length Lbm from the boom pin to an arm pin, the length Lam from the arm pin to a bucket pin, and the length Lbk from the bucket pin to the bucket claw tip are preliminarily stored as size data. In this case, the claw tip difference Dvt can be calculated by calculating the coordinates of the bucket claw tip in the machine body coordinate system based on the posture data of the front members 11, 12, and 8 and the size data Lsb, Lbm, Lam, and Lbk and on the basis of the calculated coordinates and the position data of the target surface in the machine body coordinate system.
The arm tip difference calculation section 140 performs calculation with respect the tip pin (bucket pin) of the arm 12, similar to the calculation by the claw tip difference calculation section 110. In other words, from the position of the center of the tip pin of the arm 12 (herein this may be referred to as “arm tip” or “bucket rotational center”) calculated from posture data and size data as well as from target surface data, the arm tip difference calculation section 140 calculate the distance (arm tip difference) Dva (see
The excavation work target velocity calculation section 120, from operation amount data, posture data, size data, and claw tip difference data, calculates and outputs excavation work target velocities which are target velocities (target actuator velocities) of the hydraulic cylinders 5, 6, and 7 at the time of excavation work control.
Details of the excavation work target velocity calculation section 120 will be described using
Excavation work target claw tip velocity calculation section 121 calculates and outputs an excavation work target claw tip velocity Vt (=−k×Dvt) proportional to the size of a claw tip difference Dvt, based on claw tip difference data. The excavation work target claw tip sped Vt is a target velocity of the component perpendicular to the target surface among the velocity vector generated at the bucket claw tip at the time of excavation work, and is calculated to be smaller as the claw tip difference approaches 0 (as the claw tip approaches the target surface).
The claw tip velocity calculation section 122, from arm operation amount data and bucket operation amount data of operation amount data as well as posture data and size data, calculates, by geometrical calculation, an arm bucket combined claw tip velocity as the velocity of the claw tip (bucket claw tip), which is in a direction perpendicular to the target surface, when the bucket 8 and the arm 12 are operated according to an operator's operation.
The subtracting section 123 subtracts the arm-bucket combined claw tip velocity from the excavation work target claw tip velocity Vt, to obtain a boom target claw tip velocity. The boom target claw tip velocity is a claw tip velocity by the boom necessary for causing the claw tip to be operated at the excavation work target claw tip velocity Vt when the bucket 8 and the arm 12 are operated according to an operator's operation.
The angular velocity reverse calculation section 124, based on a boom target claw tip velocity calculated by the subtracting section 123 as well as posture data and size data, calculates, by geometrical calculation, a boom target angular velocity which is a target angular velocity of the boom 11.
The cylinder velocity reverse calculation section, based on a boom target angular velocity calculated by the angular velocity reverse calculation section 124 as well as posture data and size data, calculates, by geometrical calculation, an excavation work boom target cylinder velocity converted from a boom target angular velocity (target angular velocity of the boom 11) into a target velocity of the boom cylinder 5.
In addition, arm operation amount data and bucket operation amount data inputted to the excavation work target velocity calculation section 120 are converted respectively into an excavation work arm target cylinder velocity which is a target velocity of the arm cylinder 6 and an excavation work bucket target cylinder velocity which is a target velocity of the bucket cylinder 7, and the excavation work arm target cylinder velocity and the excavation work bucket target cylinder velocity are outputted to the target velocity selection section 180 as excavation work target velocity together with an excavation work boom target cylinder velocity calculated by the cylinder velocity reverse calculation section 125.
Note that while the excavation work target claw tip velocity Vt is varied according to claw tip difference data in the excavation work target claw tip velocity calculation section 121 in the present invention, a plurality of different proportional constants may be set according to the size of the claw tip difference Dvt, or different functions may be used. In addition, while the bucket 8 and the arm 12 are operated according to an operator's operation and an adjustment for causing the claw tip to move along the target surface is conducted by the boom 11 in the present embodiment, the operations of the bucket 8 and the arm 12 may be corrected according to the claw tip difference Dvt, and an adjustment for causing the claw tip to move along the target surface may be conducted by the bucket 8 or the arm 12, or both of them, and the boom 11.
Returning to
As the predetermined threshold dv1 concerning the arm tip difference Dva, the distance (size Lbk) from the tip of the arm (rotational center of the bucket) to the bucket claw tip is considered as an example. In addition, as the predetermined threshold op1 concerning the bucket operation amount, a value close to zero with which it is possible to determine whether a bucket operation is present or absent (whether an operation of the bucket cylinder 7 is present or absent) is considered. When the bucket operation amount is less than the threshold op1, the bucket operation is judged to be absent. Similarly, as the predetermined threshold op2 concerning the arm operation amount, a value close to zero with which it is possible to determine whether an arm operation is present or absent (whether an operation of the arm cylinder 6 is present or absent) is considered. When the arm operation amount is more than the threshold op2, the arm operation is judged to be present.
The offset difference calculation section 160, based on size data, posture data, arm tip difference data, and bucket mode flag, calculates the offset difference Dvo (see
Details of the offset difference calculation section 160 will be described using
Further, the offset difference calculation section 160 calculates, in the subtracting section 162, an offset difference Dvo (see
When the bucket mode flag is false, the offset difference Dvo coincides with a claw tip difference Dvt. However, the offset difference Dvo in the case where the bucket mode flag is true is the virtual distance between the bucket 8 and the target surface when the posture of the bucket relative to the target surface (for example, the angle of the bucket bottom surface relative to the target surface) is kept constant in a posture at the time when the bucket mode flag is changed from false to true. Therefore, as depicted in
The leveling work target velocity calculation section 170, based on offset difference data, posture data, size data, and operation amount data, calculates and outputs a target velocity (leveling work target velocity) concerning the work device 15 in leveling work control.
The leveling work target velocity calculation section 170 will be described in detail using
The target arm tip velocity calculation section 171, the excavation work target claw tip velocity calculation section 121, calculates and outputs a leveling work target arm tip velocity Va (=−k×Dvo) proportional to the size of the offset difference Dvo, based on the offset difference data (offset difference Dvo) inputted from the offset difference calculation section 160. The leveling work target arm tip velocity Va is the target velocity of a component perpendicular to the target surface among a velocity vector generated at the arm tip at the time of leveling work, and is calculated to be smaller (such as to approach zero) as the offset difference Dvo approaches zero. Note that the proportional constant k may be different from the value utilized for calculation of the excavation work target claw tip velocity Vt.
The arm tip velocity calculation section 172, based on arm operation amount of operation amount data as well as posture data and size data, calculates, by geometrical calculation, arm tip velocity by the arm as a velocity of the arm tip in a direction perpendicular to the target surface when the arm 12 is operated according to an operator's operation.
The subtracting section 173 subtracts the arm tip velocity by the arm from the leveling work target arm tip velocity Va, thereby to obtain a target arm tip velocity by the boom. The target arm tip velocity by the boom is a velocity necessary for moving the arm tip at the leveling work target arm tip velocity Va by the boom, when the arm 12 is operated according to an operator's operation.
The angular velocity reverse calculation section 174, based on the target arm tip velocity by the boom, posture data and size data, calculates a boom target angular velocity which is a target angular velocity of the boom 11, by calculation similar to the angular velocity reverse calculation section 124 of the excavation work target velocity calculation section 120.
The angular velocity calculation section 176, according to arm operation amount data of operation amount data as well as posture data and size data, calculates, by geometrical calculation, an arm angular velocity which is an angular velocity of the arm 12.
The bucket target angular velocity calculation section 177 sets an arm angular velocity inputted from the angular velocity calculation section 176 to be w1, and sets a boom target angular velocity inputted from the angular velocity reverse calculation section 174 to be w2, and by calculation of −(w1+w2) (a calculation of adding both the angular velocity and determining the sign), calculates a bucket target angular velocity W which is a target angular velocity of the bucket 8. As is clear from the calculation process, the bucket target angular velocity W is an angular velocity for canceling variations in the posture of the work device 15 by operations of the arm 12 and the boom 11 such as to keep constant the posture of the bucket 8 relative to the target surface.
The cylinder velocity reverse calculation section 175, based on a bucket target angular velocity calculated by the bucket target angular velocity calculation section 177, a boom target angular velocity calculated by the angular velocity reverse calculation section 174, as well as posture data and size data, calculates, by geometrical calculation, a leveling work bucket target cylinder velocity which is a target velocity of the bucket cylinder 7 and a leveling work boom target cylinder velocity which is a target velocity of the boom cylinder 5.
As a result of the foregoing, the leveling work target velocity calculation section 170 outputs the leveling work arm target cylinder velocity which is a target velocity of the arm cylinder 6 calculated from the arm operation amount, the leveling work bucket target cylinder velocity calculated by the cylinder velocity reverse calculation section 175, and the leveling work boom target cylinder velocity also calculated by the cylinder velocity revere calculation section 175 together as leveling work target velocity.
Note that while it has been described that the leveling work target arm tip velocity Va calculated by the target arm tip velocity calculation section 171 varies according to the offset difference Dvo, different proportional constants may be set according to the magnitude of the offset difference Dvo, or different functions may be used. In addition, while the arm 12 is operated according to an operator's operation and an adjustment for causing the bucket 8 to move along the target surface is conducted by the boom 11 in the present embodiment, a configuration in which the operation of the arm 12 is also corrected based on the magnitude of the arm tip difference Dva and an adjustment for causing the claw tip to move along the target surface is conducted by the arm 12 and the boom 11 may be adopted.
In addition, in the leveling work in the present embodiment, it is assumed that there is no bucket operation by the operator, and, therefore, bucket operation amount is not used in the calculation by the leveling work target velocity calculation section 170.
Returning again to
Details of the target velocity selection section 180 will be described using
The target actuator velocity outputted from the target velocity selection section 180 becomes an output of the information processing section 100, which drives the control valve 20 as a control valve driving signal through the control valve driving section 200, and causes the actuators 5, 6, and 7 to operate at the target actuator velocities.
The information processing section 100 starts processing during when the engine is being activated and when the lock lever that changes over permission and inhibition of an actuator operation by the operation lever is in the permission position, and proceeds to procedure S3 in the case where an operation of the operation levers 1c and 1d is detected (procedures S1 and S2).
In procedure S3, the arm tip difference calculation section 140, based on posture data obtained from posture sensors 13a, 13b, 13c, and 13d, size data obtained from the machine body information storage device 19, and target surface data obtained from the target surface setting device 18, calculates an arm tip difference Dva which is information concerning the difference between the arm tip and the target surface.
In procedure S4, the claw tip difference calculation section 110, based on posture data, size data, and target surface data, calculates a claw tip difference Dvt which is information concerning the difference between the bucket claw tip and the target surface.
In procedure S5, the excavation work target velocity calculation section 120, based on posture data, size data, claw tip difference Dvt, and operation amount data, calculates excavation work target velocities. As aforementioned, the excavation work target velocities are target velocities (target actuator velocities) of the hydraulic cylinders 5, 6, and 7 at the time of excavation work control for moving the claw tip of the bucket along the target surface.
In procedure S6, the bucket mode judging section 150 determines whether or not the setting data inputted from the leveling work control setting switch 17 is true (namely, whether or not the leveling work control setting switch 17 is in the permission position for permitting execution of leveling work control), whether or not the arm tip difference Dva is equal to or less than a predetermined threshold dv1, whether or not bucket operation amount of operation amount data is less than a predetermined threshold op1 (in other words, whether or not there is no input of operator's bucket operation with respect to the operation lever 1c), and whether or not arm operation amount of operation amount data is more than a predetermined threshold op2 (in other words, whether or not there is an input of operator's arm operation with respect to the operation lever 1d). When either one of these three conditions is false, the bucket mode judging section 150 judges that the work being executed is excavation work, outputs false as the bucket mode flag, and proceeds processing to procedure S9b. On the other hand, when all these three conditions are true, the bucket mode judging section 160 judges that the work being executed is leveling work, outputs true as the bucket mode flag, and proceeds processing to procedure S7a.
Next, in procedure S6, the case in which the output of the bucket mode judging section 150 is true and processing is proceeded to procedure S7a will be described.
In procedure S7a, the offset difference calculation section 160, based on size data, posture data, and arm tip difference Dva, calculates an offset difference Dvo. The offset difference Dvo is a distance calculated by subtracting the bucket height Hbk at the time when the bucket mode flag outputted from the bucket mode judging section 150 in procedure S6 is changed from false to true (namely, at the time of start of leveling work control) from the arm tip difference Dva. The posture (angle) of the bucket bottom surface relative to the target surface during execution of leveling work control is kept at the posture (angle) at the time when the bucket mode flag is changed from false to true, by calculation processing of the bucket target angular velocity calculation section 177. In other words, the posture of the bucket 8 relative to the target surface that is kept at the time of leveling work control is the posture of the bucket 8 when the leveling work control setting switch 17 is in the permission position, when the arm tip difference Dva is equal to or less than the threshold dv1, when there is no input of bucket operation with respect to the operation lever 1c, and when an arm operation with respect to the operation lever 1d is inputted. The bucket 8 in this instance is preferably held in a posture such that the angle of the bucket bottom surface relative to the target surface is zero (in other words, the target surface and the bucket bottom surface are parallel) as depicted in
In procedure S8a, the leveling work target velocity calculation section 170, based on size data, posture data, offset difference Dvo, and operation amount data, calculates leveling work target velocities. As aforementioned, the leveling work target velocities are target velocities of the front members 11, 12, and 8, such that the bucket 8 moves along the target surface, while keeping the posture of the bucket 8 relative to the target surface in the posture at the time when the bucket mode flag is changed from false to true, and, in the present embodiment, the leveling work target velocities are target velocities of the hydraulic cylinders 5, 6, and 7.
In procedure S9a, the target velocity selection section 180 selects the leveling work target velocities calculated in procedure S8a as target actuator velocities, and proceeds to procedure S10.
Subsequently, in procedure S6, the case where the output of the bucket mode judging section 150 is false, and processing is proceeded to procedure S9b will be described.
In procedure S9b, the target velocity selection section 180 selects the excavation work target velocities calculated in procedure S5 as target actuator velocities, and proceeds to procedure S10.
In procedure S10, the information processing section 100 outputs the target actuator velocities selected in procedure S9a or procedure S9b to the control valve driving section 200.
Then, in procedure S11, the control valve driving section 200 outputs control valve driving signals with which the actuators 5, 6, and 7 are operated at the target actuator velocities to the control valve 20. The control valve 20 is driven by the control valve driving signals to operate the actuators 5, 6, and 7 at the target actuator velocities, and excavation work control or leveling work property is conducted by the work device 15.
According to the present embodiment configured as above, coordination operation of the bucket 8 with respect to the arm 12 and the boom 11 can be automatically conducted such that the posture of the bucket 8 relative to the target surface is constant according to an operator's operation, and leveling work can be performed, without spoiling the operability at the time of returning work and work efficiency at the time of transition from the returning work to the leveling work.
When the bucket mode flag continues to be true (in other words, when leveling work control is executed), if the arm tip approaches the target surface by an arm operation and the arm tip difference Dva is reduced, the offset difference Dvo is reduced toward zero, and the leveling work target arm tip velocity Va calculated by the target arm tip velocity calculation section 171 also approaches zero. Then, when the arm tip difference Dva coincides with the bucket height Hbk (the bucket height at the time when the bucket mode flag is changed from false to true, and is a constant value), the offset difference Dvo becomes zero, and the bucket 8 is moved along the target surface while keeping a state in which the point on the bucket 8 which is nearest to the target surface is located on the target surface. In other words, by this operation of the work device 15, leveling work for causing the actual terrain to approach the target surface is conducted.
Actions and effects of the present embodiment will be described specifically below. Hereinafter, as depicted in
The operator mounted on the hydraulic excavator configured as above, in the case of desiring to execute leveling work control, changes over the leveling work control setting switch 17 from the inhibition position to the permission position at a desired timing. As a result, the leveling work control setting switch 17 continues to output “true” as the setting data to the main controller 500. Next, the operator performs a returning work by arm operation and boom operation, to move the bucket 8 to a starting position of a leveling work, and finishes the returning work in a state in which, for example, the bucket 8 is in contact with the target surface as depicted in
During the leveling work control (when the bucket mode flag is continuedly true), the arm tip approaches the target surface by an operator's arm operation, and the arm tip difference Dva is gradually reduced. Since the bucket height Hbk in this instance is maintained at the value (fixed value) at the timing when the bucket mode flag is changed from false to true, as aforementioned, the offset difference Dvo is reduced toward zero as the arm tip difference Dva is reduced, and the leveling work target arm tip velocity Va calculated by the target arm tip velocity calculation section 171 also approaches zero as the arm tip difference Dva is reduced. Then, the offset difference Dvo becomes zero at the time when the arm tip difference Dva coincides with the bucket height Hbk (fixed value), a state in which that point (for example, a bucket bottom surface) on the bucket 8 which is nearest to the target surface is located on the target surface is maintained, and the bucket 8 is moved along the target surface. In other words, by this operation of the work device 15, a leveling work of causing the actual terrain to approach the target surface is automatically performed.
Incidentally, as aforementioned, in Patent Document 1, that “the difference (distance) between the claw tip and the target surface” is equal to or less than a predetermined threshold D1 is one of the conditions for starting a bucket automatic operation (leveling work control). Therefore, for enabling transition from a state in which the bucket posture is adjusted as depicted in
In view of this, in the present embodiment, that “the difference (distance) Dva between the arm tip and the target surface” is equal to or less than the threshold dv1 is made to be one of starting conditions for the bucket automatic operation. For example, when the threshold dv1 is set at the size (Lbk) from the tip of the arm (rotational center of the bucket) to the bucket claw tip, with the posture of the bucket 8 depicted in
In Patent Document 1, also, if the threshold D1 is set, for example, smaller than d1thr (see
Note that under the condition where the bucket mode flag is false, the above-mentioned problem is not generated. In addition, as depicted in
Next, a second embodiment will be described. The present embodiment judges that “there is an operation of the arm 12” concerning the conditions of procedure S6 in
The information processing section 100 possessed by the hydraulic excavator according to the second embodiment will be described using
The bucket mode judging section 150 in
The other parts than the above-mentioned are similar to those in the first embodiment.
The flow of control in the second embodiment will be described using
According to the hydraulic excavator of the present embodiment configured as above, in addition to the effects of the first embodiment, in the excavation work target velocity calculation section 120 and the leveling work target velocity calculation section 170, or other additional calculation blocks, when the arm cylinder 6 is not operated against the operator's will attendant on cylinder operation being stopped attendant on the arm cylinder 6 reaching a stroke end and due to other additional functions, a discomfort can be prevented from being given to the operator due to triggering of a bucket automatic operation (leveling work control).
Note that while it is judged that there is an input of arm operation with respect to the operation lever 1 in the case in which magnitude of the arm target cylinder velocity (target velocity of the arm cylinder 6) is greater than the threshold Val in the foregoing, it may be judged that there is an input of arm operation in the case in which the magnitude of a target angular velocity of the arm 12 is greater than a predetermined threshold, as other target velocity concerning the arm 12.
While the aforementioned hydraulic excavator includes the leveling work control setting switch 17 and “that the setting data are true” is included in the conditions judged in procedure S6 in
Note that the present invention is not limited to the aforementioned embodiments, but includes various modifications within such ranges as not to depart from the gist of the invention. For example, the present invention is not limited to the one including all the configurations described in each of the above embodiments, and includes those in which part of the configurations is omitted. In addition, a part of a configuration according to an embodiment may be added to or replaced by the configuration according to other embodiment.
Besides, each configuration according to the main controller 500 and functions, execution processing, and the like of each configuration may be partly or entirely realized by hardware (for example, by designing logics for executing each function in the form of an integrated circuit). In addition, the configurations according to the controller 500 may be programs (software) that are read and executed by an arithmetic processing device (for example, CPU) to thereby realize each function according to the configuration of the controller 500. Information concerning the programs can be stored, for example, in a semiconductor memory (flash memory, SSD, etc.), a magnetic recording device (hard disc drive, etc.) and a recording medium (magnetic disc, optical disc, etc.) and the like.
Besides, in the above description of each embodiment, control lines and information lines that are considered to be necessary for explanation of the embodiment have been shown, but all the control lines and information lines concerning the product are necessarily shown. In practice, substantially all configurations may be considered to be connected to one another.
Number | Date | Country | Kind |
---|---|---|---|
2019-173087 | Sep 2019 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2020/035871 | 9/23/2020 | WO | 00 |