The present invention relates to a work machine that controls at least one of a plurality of hydraulic actuators under predetermined conditions when an operation device is operated.
Machine control (MC) is a technology that improves the work efficiency of a work machine (e.g., a hydraulic excavator) having a work device (e.g., a front work device) driven by a hydraulic actuator. The MC is a technology that provides operational assistance to an operator by executing semi-automatic control for operating the work device under predetermined conditions when an operation device is operated by the operator.
A technology disclosed, for example, in Japanese Patent No. 5865510 provides MC of the front work device in such a manner as to move the blade edge of a bucket along a reference plane. According to this patent document, when the operation amount of an arm operation lever is small, the actual arm cylinder speed may be higher than an estimated arm cylinder speed calculated based on the operation amount of the arm operation lever due to the free fall of the bucket depending on the posture of the front work device. If MC is executed based on the estimated arm cylinder speed under such circumstances, the blade edge of the bucket may become unstable to cause hunting. When the operation amount of the arm operation lever is smaller than a predetermined amount, the technology described in this patent document performs calculations to determine a speed higher than the speed calculated based on the operation amount of the arm operation lever as the estimated arm cylinder speed that takes into account the free fall of the bucket, and executes MC based on such an estimated arm cylinder speed in order to solve the above-mentioned problem.
Patent Document 1: Japanese Patent No. 5865510
When the free fall of the bucket is taken into account during the calculation of the estimated arm cylinder speed as described with reference to the technology disclosed in Patent Document 1, the calculated estimated arm cylinder speed is close to the actual arm cylinder speed. Therefore, hunting can be avoided during MC. However, the deviation of the arm cylinder speed estimated based on the operation amount of the arm operation lever from the actual arm cylinder speed is not only due to the free fall of the bucket. Consequently, the occurrence of hunting is not sufficiently avoided by estimating the arm cylinder speed in consideration of the free fall of the bucket as described in Patent Document 1.
For example, the viscosity of a hydraulic operating fluid for the work machine is high at a low temperature. In this instance, however, the actual arm cylinder speed may be lower than the speed estimated from a lever operation amount.
Further, when a raking-and-leveling operation is to be performed, that is, when earth on a sloped surface below the work machine is to be raked and leveled as illustrated, for example, in
As described above, the actual arm cylinder speed differs in some cases from the speed estimated from the lever operation amount depending on the state of the work machine and on its operation. As a result, the blade edge of the bucket (the end of the work device) is unstable during MC. This may cause hunting.
Meanwhile, the work machine designed to provide MC in the above-described manner includes a posture sensor (e.g., a potentiometer attached to a pin for coupling the arm to a boom) that detects the posture of the work device. The arm cylinder speed computed from the lever operation amount is nothing more than an estimated value. However, an output generated from the posture sensor makes it possible to grasp the actual posture of the work device. The arm cylinder speed calculated from temporal changes in the output value of the posture sensor is usually closer to the actual speed than the speed calculated from the lever operation amount. In view of these circumstances, it is conceivable that MC can be provided based on the arm cylinder speed calculated from the output value of the posture sensor. However, there is still the following problem with such use of the posture sensor.
The posture sensor is not able to detect changes in the posture of the arm until the arm actually starts moving. Therefore, if MC based on the arm speed calculated from the output value of the posture sensor is executed when the arm starts moving, the response (e.g., a boom raising command) of MC to the beginning of actual arm movement may be delayed. Consequently, the blade edge position of the bucket may become unstable to cause hunting.
The problem has been described by citing the arm cylinder speed as an example. However, the same problem applies to the speed of the other hydraulic actuators that drive the work device.
An object of the present invention is to provide a work machine that calculates more appropriately the speed of a specific hydraulic actuator for driving a work device and stabilizes the behavior of the tip of the work device (e.g., the blade edge of a bucket) during MC.
The present application includes a plurality of means for solving the above-described problem. As an example, there is provided a work machine having a work device, a plurality of hydraulic actuators, an operation device, and a controller. The work device includes a plurality of front members. The plurality of hydraulic actuators drive the plurality of front members. The operation device instructs each of the plurality of hydraulic actuators on an operation thereof in accordance with an operation of an operator. The controller includes an actuator control section that controls at least one of the plurality of hydraulic actuators in accordance with speeds of the plurality of hydraulic actuators and with predetermined conditions when the operation device is operated. The work machine includes a posture sensor and an operation amount sensor. The posture sensor detects a physical quantity concerning a posture of a specific front member that is one of the plurality of front members. The operation amount sensor detects a physical quantity concerning an operation amount for the specific front member that is among operation amounts inputted to the operation device by the operator. The controller includes a first speed computation section, a second speed computation section, and a third speed computation section. The first speed computation section calculates, from a value detected by the operation amount sensor, a first speed of a specific hydraulic actuator for driving the specific front member. The specific hydraulic actuator is among the plurality of hydraulic actuators. The second speed computation section calculates a second speed of the specific hydraulic actuator from a value detected by the posture sensor. The third speed computation section calculates, in accordance with the first speed and with the second speed, a third speed that is used as a speed of the specific hydraulic actuator by the actuator control section. The third speed computation section calculates the first speed as the third speed during a period between a detection of an input of operation for the specific front member by the operation amount sensor and a first predetermined time, calculates as the third speed a speed calculated from the first speed and the second speed during a period between the first predetermined time and a second predetermined time that is later than the first predetermined time, and calculates the second speed as the third speed at and after the second predetermined time.
The present invention makes it possible to calculate more appropriately the speed of a specific hydraulic actuator for driving a work device and stabilize the behavior of the tip of the work device during MC.
Embodiments of the present invention will now be described with reference to the accompanying drawings. Exemplified in the following description is a hydraulic excavator having a bucket 10 as a work tool (an attachment) on the tip of a work device. However, the present invention may be applied to a work machine having an attachment other than a bucket. Further, the present invention is also applicable to a work machine other than a hydraulic excavator as far as the work machine includes a multi-joint work device that is formed by coupling a plurality of front members (an attachment, an arm, a boom, etc.).
Meanwhile, this document uses “on,” “above,” or “below” together with a term indicative of a certain shape (e.g., a target surface or a design surface). The word “on” indicates the “surface” of such a certain shape, the word “above” indicates a “position higher than the surface” of such a certain shape, and the word “below” indicates a “position lower than the surface” of such a certain shape. Further, in the following description, a plurality of identical elements may be designated by reference characters (signs or numerals) suffixed with an alphabetical letter. In some cases, however, the plurality of identical elements may be designated collectively without using such an alphabetical letter. For example, when two pumps 2a and 2b exist, they may be designated as the pumps 2.
<Basic Structure>
Referring to
The front work device 1A is formed by coupling a plurality of front members (a boom 8, an arm 9, and a bucket 10), which respectively pivot in the vertical direction. The base end of the boom 8 is pivotally supported through a boom pin at the front of the upper swing structure 12. The arm 9 is pivotally coupled to the tip of the boom 8 through an arm pin. The bucket 10 is pivotally coupled to the tip of the arm 9 through a bucket pin. The plurality of front members 8, 9, and 10 are driven by a plurality of hydraulic cylinders 5, 6, and 7, which are hydraulic actuators. More specifically, the boom 8 is driven by a boom cylinder 5, the arm 9 is driven by an arm cylinder 6, and the bucket 10 is driven by a bucket cylinder 7.
In such a manner as to be able to measure pivot angles α, β, and γ (see
Installed in a cab mounted on the upper swing structure 12 are an operation device 47a (
An engine 18 mounted in the upper swing structure 12 acts as a prime mover and drives hydraulic pumps 2a and 2b and a pilot pump 48. The hydraulic pumps 2a and 2b are variable displacement pumps, and their displacements are controlled by regulators 2aa and 2ba. The pilot pump 48 is a fixed displacement pump. The hydraulic pumps 2 and the pilot pump 48 draw a hydraulic fluid from a tank 200. In the present embodiment, as illustrated in
A pump line 48a is a delivery piping for the pilot pump 48. The pump line 48a runs through a lock valve 39, then branches into a plurality of lines, and connects to various valves in the operation devices 45, 46, and 47 and in the front control hydraulic unit 160. The lock valve 39 is a solenoid selector valve in the present embodiment, and its solenoid drive section is electrically connected to a position sensor of a gate lock lever (not illustrated) disposed in the cab (
The operation devices 45, 46, and 47 are of a hydraulic pilot type, and generates a pilot pressure (may be referred to also as the operating pressure) based on the hydraulic fluid delivered from the pilot pump 48 in accordance with the operation amount (e.g., lever stroke) and operation direction of the operation levers 1, 23 operated by the operator. The pilot pressure generated in the above manner is supplied to associated hydraulic drive sections 150a to 155b of flow control valves 15a to 15f (
The hydraulic fluid delivered from the hydraulic pumps 2 is supplied to the travel right hydraulic motor 3a, the travel left hydraulic motor 3b, the swing hydraulic motor 4, the boom cylinder 5, the arm cylinder 6, and the bucket cylinder 7 through the flow control valves 15a, 15b, 15c, 15d, 15e, and 15f (see
The tank 200 includes a hydraulic fluid temperature sensor 210 that detects the temperature of the hydraulic fluid for driving the hydraulic actuators. The hydraulic fluid temperature sensor 210 may be installed outside the tank 200. For example, the hydraulic fluid temperature sensor 210 may be attached to an inlet or outlet line for the tank 200.
As MC of the front work device 1A, when an excavation operation (more specifically, an instruction for at least one of arm crowding, bucket crowding, and bucket dumping) is inputted through an operation device 45b, 46a, based on the positional relationship between a target surface 60 (see
Executing MC in the above manner prevents the claw tip of the bucket 10 from intruding into a position below the target surface 60. Therefore, an excavation operation can be performed along the target surface 60 without regard to the skill of the operator. In the present embodiment, a control point for the front work device 1A during MC is set at the claw tip of the bucket 10 (at the tip of the work device 1A) of the hydraulic excavator. However, the control point may be set at a point other than the claw tip of the bucket as far as it is a point of the tip portion of the work device 1A. For example, the bottom surface of the bucket 10 or the outermost portion of the bucket link 13 is selectable as the control point.
The system illustrated in
The work device posture sensor (posture sensor) 50 includes the boom angle sensor 30, the arm angle sensor 31, the bucket angle sensor 32, and the machine body inclination angle sensor 33. These angle sensors 30, 31, 32, and 33 function as a posture sensor for detecting a physical quantity concerning the postures of a plurality of front members, namely, the boom 8, the arm 9, and the bucket 10.
The target surface setting device 51 is an interface that is capable of inputting information concerning the target surface 60 (information including the position information and inclination angle information about each target surface). The target surface setting device 51 is connected to an external terminal (not illustrated) that stores three-dimensional data concerning a target surface defined on a global coordinate system (absolute coordinate system). A target surface may be manually inputted by the operator through the target surface setting device 51.
The operator operation amount sensors (operation amount sensors) 52a include pressure sensors 70a, 70b, 71a, 71b, 72a, and 72b. The pressure sensors 70a, 70b, 71a, 71b, 72a, and 72b acquire an operating pressure (first control signal) that is generated in the pilot lines 144 and 145, and 146 when the operator operates the operation levers 1a, lb (operation devices 45a, 45b, and 46a). These pressure sensors 70a, 70b, 71a, 71b, 72a, and 72b function as an operation amount sensor for detecting a physical quantity concerning the amount of operation that is performed by the operator through the operation devices 45a, 45b, and 46a with respect to the boom 7 (boom cylinder 5), the arm 8 (arm cylinder 6), and the bucket 9 (bucket cylinder 7).
<Front Control Hydraulic Unit 160>
As illustrated in
Further, the front control hydraulic unit 160 includes the pressure sensors 71a and 71b, a solenoid proportional valve 55b, and a solenoid proportional valve 55a. The pressure sensors 71a and 71b are installed in the pilot lines 145a and 145b for the arm 9, detect the pilot pressure (first control signal) as the operation amount of the operation lever 1b, and output the detected pilot pressure to the controller 40. The solenoid proportional valve 55b is installed in the pilot line 145b, reduces the pilot pressure (first control signal) in accordance with a control signal from the controller 40, and outputs the reduced pilot pressure. The solenoid proportional valve 55a is installed in the pilot line 145a, reduces the pilot pressure (first control signal) in the pilot line 145a in accordance with a control signal from the controller 40, and outputs the reduced pilot pressure.
Moreover, the front control hydraulic unit 160 is structured so that the pressure sensors 72a and 72b, solenoid proportional valves 56a and 56b, solenoid proportional valves 56c and 56d, and shuttle valves 83a and 83b are disposed in the pilot lines 146a and 146b for the bucket 10. The pressure sensors 72a and 72b detect the pilot pressure (first control signal) as the operation amount of the operation lever 1a, and output the detected pilot pressure to the controller 40. The solenoid proportional valves 56a and 56b reduce the pilot pressure (first control signal) in accordance with a control signal from the controller 40, and output the reduced pilot pressure. The solenoid proportional valves 56c and 56d has a primary port side connected to the pilot pump 48, reduces the pilot pressure from the pilot pump 48, and outputs the reduced pilot pressure. The shuttle valves 83a and 83b select a higher pressure out of the pilot pressure in the pilot lines 146a and 146b and a control pressure outputted from the solenoid proportional valve 56c, 56d, and direct the selected pressure to hydraulic drive sections 152a, 152b of the flow control valve 15c. Connection lines between the pressure sensors 70, 71, and 72 and the controller 40 are omitted from
The solenoid proportional valves 54b, 55a, 55b, 56a, and 56b maximize their openings when de-energized, and reduce their openings with an increase in a current acting as a control signal from the controller 40. Meanwhile, the solenoid proportional valves 54a, 56c, and 56d are closed when de-energized and open when energized. Their openings become larger with an increase in the current (control signal) from the controller 40. In this manner, the openings 54, 55, and 56 of the solenoid proportional valves are based on a control signal from the controller 40.
When the controller 40 outputs a control signal to drive the solenoid proportional valves 54a, 56c, and 56d in the control hydraulic unit 160 structured as described above, a pilot pressure (second control signal) is generated even if the associated operation devices 45a, 46a are not operated by the operator. This makes it possible to forcibly perform a boom raising operation, a bucket crowding operation, and a bucket dumping operation. Meanwhile, when the controller 40 similarly drives the solenoid proportional valves 54b, 55a, 55b, 56a, and 56b, the pilot pressure (second control signal) is generated. The second pressure (second control signal) is obtained by reducing the pilot pressure (first control signal) that is generated when the operation devices 45a, 45b, and 46a are operated by the operator. This makes it possible to forcibly reduce the speeds of a boom lowering operation, an arm crowding/dumping operation, and a bucket crowding/dumping operation to values lower than operator-inputted values.
In this document, a pilot pressure generated by operating the operation devices 45a, 45b, and 46a, which is among the control signals for the flow control valves 15a to 15c, is referred to as the “first control signal.” A pilot pressure generated by allowing the controller 40 to drive the solenoid proportional valves 54b, 55a, 55b, 56a, and 56b in order to correct (reduce) the first control signal, and a pilot pressure generated newly and separately from the first control signal by allowing the controller 40 to drive the solenoid proportional valves 54a, 56c, and 56d, which are among the control signals for the flow control valves 15a to 15c, are referred to as the “second control signal.”
The second control signal is generated when the velocity vector of the control point for the work device 1A, which is generated by the first control signal, does not meet predetermined conditions. The second control signal is generated as a control signal for generating a velocity vector of the control point for the work device 1A that meets the predetermined conditions. In a case where the first control signal is generated for one hydraulic drive section and the second control signal is generated for the other hydraulic drive section in the same flow control valve 15a to 15c, it is assumed that the second control signal preferentially works on a hydraulic drive section. Thus, the first control signal is blocked by a solenoid proportional valve, and the second control signal is inputted to the other hydraulic drive section. Consequently, a flow control valve 15a to 15c for which the second control signal is computed is controlled based on the second control signal, a flow control valve 15a to 15c for which the second control signal is not computed is controlled based on the first control signal, and a flow control valve 15a to 15c for which neither of the first and second control signals is generated is not controlled (not driven). When the first control signal and the second control signal are defined as described above, it can be said that MC is controlling the flow control valves 15a to 15c in accordance with the second control signal.
<Controller 40>
Referring to
The controller 40 illustrated in
The display control section 374 controls the display device 53 in accordance with a work device posture and target surface outputted from the MC control section 43. The display control section 374 includes a display ROM that stores a large amount of display data including images and icons of the work device 1A. The display control section 374 reads a predetermined program based on a flag included in inputted information, and provides display control of the display device 53.
The operation amount computation section 43a calculates the operation amounts of the operation devices 45a, 45b, and 46a (operation levers 1a and 1b) in accordance with values detected by the operator operation amount sensors 52a. That is to say, the operation amounts of the operation devices 45a, 45b, and 46a can be calculated from the values detected by the pressure sensors 70, 71, and 72.
Using the pressure sensors 70, 71, and 72 for operation amount calculation is merely an example. For example, a position sensor (e.g., rotary encoder) for detecting the rotational displacement of the operation levers for the operation devices 45a, 45b, and 46a may be used to detect the operation amounts of the operation levers.
The posture computation section 43b computes, in accordance with values detected by the work device posture sensor 50, the postures of the boom 8, arm 9, and bucket 10 in a local coordinate system, the posture of the front work device 1A, and the position of the claw tip of the bucket 10.
The postures of the boom 8, arm 9, and bucket 10 and the posture of the front work device 1A can be defined in an excavator coordinate system (local coordinate system) illustrated in
The target surface computation section 43c computes the position information about the target surface 60 in accordance with information from the target surface setting device 51, and stores the computed position information in the ROM 93. In the present embodiment, a cross-sectional shape obtained by cutting a three-dimensional target surface along a plane on which the work device 1A moves (the motion plane of the work device) as illustrated in
In the example of
The arm cylinder first speed computation section 43f calculates the speed of the arm cylinder 6 from a detected operation amount value for the arm 9 that is among the values detected by the operator operation amount sensors 52a, and outputs the result of calculation to the arm cylinder third speed computation section 43e. In the present embodiment, the operation amount computation section 43a calculates an arm operation amount from arm operation amounts detected by the operator operation amount sensors 52a, and the arm cylinder first speed computation section 43f calculates the speed of the arm cylinder 6 in accordance with the arm operation amount calculated by the operation amount computation section 43a and with a table illustrated in
In this document, the arm 9, which is one of the three front members 8, 9, and 10 forming the front work device 1A, is referred to as the “specific front member,” and the arm cylinder 6, which drives the arm 9, is referred to as the “specific hydraulic actuator.” The speed of the arm cylinder 6, which is calculated by the arm cylinder first speed computation section 43f, is referred to as the “first speed.”
The arm cylinder second speed computation section 43d calculates the speed of the arm cylinder 6 from a detected posture value of the arm 9 that is among the values detected by the work device posture sensor 50, and outputs the result of calculation to the arm cylinder third speed computation section 43e. In the present embodiment, the posture computation section 43b calculates the posture of the arm 9 from values of the arm 9 that are detected by the work device posture sensor 50, and the arm cylinder second speed computation section 43d calculates the speed of the arm cylinder 6 from temporal changes in the posture of the arm 9, which are calculated by the posture computation section 43b, and dimension values (described later with reference to
The dimension values of the front work device 1A that are used to calculate the second speed will now be described with reference to
Based on the first speed of the arm cylinder 6, which is computed by the arm cylinder first speed computation section 43f, and on the second speed of the arm cylinder 6, which is computed by the arm cylinder second speed computation section 43d, the arm cylinder third speed computation section 43e calculates a speed (referred to as the “third speed”) that is used as the speed of the arm cylinder 6 when the actuator control section 81 executes MC. The arm cylinder third speed computation section 43e then outputs the result of calculation to the actuator control section 81. The calculation of the third speed that is performed by the arm cylinder third speed computation section 43e will be described in detail later with reference to
The boom control section 81a and the bucket control section 81b form the actuator control section 81, which controls at least one of a plurality of hydraulic actuators 5, 6, and 7 under predetermined conditions when the operation devices 45a, 45b, and 46a are operated. The actuator control section 81 computes target pilot pressures for the flow control valves 15a, 15b, and 15c of the hydraulic cylinders 5, 6, and 7, and outputs the computed target pilot pressures to the solenoid proportional valve control section 44.
When the operation devices 45a, 45b, and 46a are operated, based on the position of the target surface 60, the posture of the front work device 1A, the position of the claw tip of the bucket 10, and the speeds of the hydraulic cylinders 5, 6, and 7, the boom control section 81a executes MC in order to control the operation of the boom cylinder 5 (boom 8) in such a manner that the claw tip (control point) of the bucket 10 is positioned on or above the target surface 60. The boom control section 81a computes the target pilot pressure for the flow control valve 15a of the boom cylinder 5. MC executed by the boom control section 81a will be described in detail later with reference to
The bucket control section 81b executes bucket angle control based on MC when the operation devices 45a, 45b, and 46a. More specifically, when the distance between the target surface 60 and the claw tip of the bucket 10 is not greater than a predetermined value, MC (bucket angle control) is executed to control the operation of the bucket cylinder 7 (bucket 10) in such a manner that the angle θ of the bucket 10 with respect to the target surface 60 coincides with a preset bucket angle with respect to target surface, which is designated as OTGT. The bucket control section 81b computes the target pilot pressure for the flow control valve 15c of the bucket cylinder 7.
Based on the target pilot pressures for the flow control valves 15a, 15b, and 15c, which are outputted from the actuator control section 81, the solenoid proportional valve control section 44 computes commands for the solenoid proportional valves 54 to 56. When a pilot pressure (first control signal) based on an operator operation coincides with a target pilot pressure calculated by the actuator control section 81, a current value (command value) for the associated solenoid proportional valve 54 to 56 is zero so that the associated solenoid proportional valve 54 to 56 does not operate.
<Third-Speed Calculation Flow of Arm Cylinder Third Speed Computation Section 43e>
In step S600, a check is performed to determine whether a current arm operation amount computed by the operation amount computation section 43a is greater than a threshold value Pit. The threshold value Pit is a constant for determining whether the arm 9 is operated. If the arm operation amount is greater than the threshold value pit, it is determined that an arm operation is performed, and then processing proceeds to step S610. If, by contrast, the arm operation amount is not greater than the threshold value Pit, it is determined that no arm operation is performed, and then processing proceeds to step S690.
In step S610, a check is performed to determine whether the arm operation amount in the last sequence is greater than the threshold value Pit. If step S610 is answered YES, it is concluded that an arm operation is continuously performed beginning with the last sequence, and then processing proceeds to step S620. In step S620, the count time t of a timer is advanced by an amount equivalent to a control interval, and then processing proceeds to step S640. If, by contrast, step S610 is answered NO, it is concluded that the arm operation is started in the current sequence, the count time t of the timer is reset in step S630, that is, the count time t is assumed to be equal to 0, and then processing proceeds to step S640.
In step S640, the second speed Vama calculated by the arm cylinder second speed computation section 43d is acquired, and then processing proceeds to step S650.
In step S650, the first speed Vame calculated by the arm cylinder first speed computation section 43f is acquired, and then processing proceeds to step S660.
In step S660, a weighting ratio Wact for the second speed Vama is calculated from the count time t calculated in step S620 or S630 and a table illustrated in
In this document, time t0 and time t1 may be referred to respectively as the “first predetermined time” and the “second predetermined time.” Time t0 and time t1 may be set, for example, as described below by selecting a value in consideration of a delay in the response from the work device posture sensor 50.
In step S670, the weighting ratio West for the arm cylinder first speed Vame is calculated from the weighting ratio Wact for the arm cylinder second speed, which is calculated in step S660. In this document, the weighting ratio West may be referred to as the “first weighting function.” The weighting ratio West is calculated from the equation West=1−Wact. That is to say, the weighting ratio West remains at 1 while t is 0 to t0, decreases monotonically from 1 to 0 with an increase in the count time t while t is t0 to t1, and remains at 0 while t is t1 or greater.
In step S680, an arm cylinder third speed Vams is outputted as Vams=Vams×Wact+Vame×West. More specifically, the sum of a value obtained by multiplying the first speed Vame by the first weighting function West and a value obtained by multiplying the second speed Vama by the second weighting function Wact is calculated as the third speed, and then the result of such computation is outputted to the actuator control section 81.
Meanwhile, if step S600 is answered NO, it is concluded that no arm operation is performed in step S600, and then in step S690, an arm cylinder third speed Vams of 0 is outputted.
<Flow of Boom Raising Control by Boom Control Section 81a>
The controller 40 according to the present embodiment executes boom raising control by the boom control section 81a as MC.
In step S410, the boom control section 81a acquires the speeds of the hydraulic cylinders 5, 6, and 7. The speeds of the boom cylinder 5 and bucket cylinder 7 are computed and acquired based on the amounts of operations performed for the boom 8 and the bucket 10, which are computed by the operation amount computation section 43a. More specifically, as is the case described earlier with reference to
In step S420, based on the operating speeds of the hydraulic cylinders 5, 6, and 7, which are acquired in step S410, and on the posture of the work device 1A, which is computed by the posture computation section 43b, the boom control section 81a computes the velocity vector B of the tip (claw tip) of the bucket operated by the operator.
In step S430, from the distance between the position (coordinates) of the claw tip of the bucket 10, which is computed by the posture computation section 43b, and a straight line including the target surface 60 stored in the ROM 93, the boom control section 81a calculates the distance D (see
In step S440, the boom control section 81a acquires a component by of the velocity vector B calculated in step S420 of the tip of the bucket operated by the operator that is vertical to the target surface 60.
In step S450, the boom control section 81a determines whether the limit value ay calculated in step S430 is 0 or greater. It should be noted that xy coordinates are set as illustrated in the upper right corner of
In step S460, the boom control section 81a determines whether the vertical component by of the velocity vector B of the claw tip operated by the operator is 0 or greater. If the vertical component by is positive, it indicates that the vertical component by of the velocity vector B is oriented upward. If the vertical component by is negative, it indicates that the vertical component by of the velocity vector B is oriented downward. If it is determined in step S460 that the vertical component by is 0 or greater (i.e., the vertical component by is oriented upward), processing proceeds to step S470. If, by contrast, the vertical component by is smaller than 0, processing proceeds to step S500.
In step S470, the boom control section 81a compares the absolute value of the limit value ay with the absolute value of the vertical component by. If the absolute value of the limit value ay is equal to or greater than the absolute value of the vertical component by, processing proceeds to step S500. If, by contrast, the absolute value of the limit value ay is smaller than the absolute value of the vertical component by, processing proceeds to step S530.
In step S500, the boom control section 81a selects “cy=ay−by” as the equation for calculating the component cy vertical to the target surface 60 of a velocity vector C of the tip of the bucket that should be generated by the operation of the machine-controlled boom 8, and calculates the vertical component cy in accordance with the selected equation, the limit value ay in step S430, and the vertical component by in step S440. In step S510, the velocity vector C capable of outputting the calculated vertical component cy is calculated and its horizontal component is designated as cx.
In step S520, a target velocity vector T is calculated. When a component of the velocity vector T vertical to the target surface 60 is ty and a component of the velocity vector T horizontal to the target surface 60 is tx, the components are expressed by“ty=by+cy” and “tx=bx+cx,” respectively. When the equation (cy=ay−by) in step S500 is substituted into the above equations, the target velocity vector T is eventually expressed by“ty=ay” and “tx=bx+cx.” That is to say, when step S520 is reached, the vertical component ty of the target velocity vector is limited to the limit value ay, and a forced boom raising operation is initiated under machine control.
In step S480, the boom control section 81a determines whether the vertical component by of the velocity vector B of the claw tip operated by the operator is 0 or greater. If it is determined in step S480 that the vertical component by is 0 or greater (i.e., the vertical component by is oriented upward), processing proceeds to step S530. If, by contrast, the vertical component by is smaller than 0, processing proceeds to step S490.
In step S490, the boom control section 81a compares the absolute value of the limit value ay with the absolute value of the vertical component by. If the absolute value of the limit value ay is equal to or greater than the absolute value of the vertical component by, processing proceeds to step S530. If, by contrast, the absolute value of the limit value ay is smaller than the absolute value of the vertical component by, processing proceeds to step S500.
When step S530 is reached, the boom 8 need not be operated under machine control. Therefore, the boom control section 81a sets the velocity vector C to zero. In this instance, when based on the equations (ty=by+cy, tx=bx+cx) used in step S520, the target velocity vector T is expressed by “ty=by” and “tx=bx.” As a result, the target velocity vector T coincides with the velocity vector B based on an operator operation (step S540).
In step S550, the boom control section 81a computes the target speeds of the hydraulic cylinders 5, 6, and 7 in accordance with the target velocity vector T (ty, tx) determined in step S520 or S540. As is obvious from the foregoing description, if the target velocity vector T does not coincide with the velocity vector B in the case of
In step S560, the boom control section 81a computes the target pilot pressures for the flow control valves 15a, 15b, and 15c of the hydraulic cylinders 5, 6, and 7 in accordance with the target speeds of the cylinders 5, 6, and 7, which are calculated in step S550.
In step S590, the boom control section 81a outputs the target pilot pressures for the flow control valves 15a, 15b, and 15c of the hydraulic cylinders 5, 6, and 7 to the solenoid proportional valve control section 44.
The solenoid proportional valve control section 44 controls the solenoid proportional valves 54, 55, and 56 in such a manner that the target pilot pressures are applied to the flow control valves 15a, 15b, and 15c of the hydraulic cylinders 5, 6, and 7. This causes the work device 1A to perform an excavation operation. When, for example, the operator operates the operation device 45b to perform an arm crowding operation for horizontal excavation, the solenoid proportional valve 55c is controlled so as to prevent the tip of the bucket 10 from intruding into the target surface 60 and automatically raise the boom 8.
In the present embodiment, boom control (forced boom raising control) by the boom control section 81a and bucket control (bucket angle control) by the bucket control section 81b are executed as MC. However, boom control based on the distance D between the bucket 10 and the target surface 60 may alternatively be executed as MC.
<Operations and Advantages>
Operations of the hydraulic excavator structured as described above will now be described with reference to
As time t0 and time t1 in
(1) When the Elapsed Time from the Beginning of Arm Crowding is Shorter than t0
Firstly, when the elapsed time from the beginning of a crowding operation of the arm 9 by the operator is shorter than t0, the arm cylinder third speed computation section 43e outputs the first speed to the actuator control section 81 as the speed of the arm cylinder 6 in accordance with the control flowchart of
(2) When the Elapsed Time from the Beginning of Arm Crowding is t0 or Longer but Shorter than t1
Secondly, when the elapsed time from the beginning of a crowding operation of the arm 9 by the operator is t0 or longer but shorter than t1, the arm cylinder third speed computation section 43e outputs the third speed Vams (yams=Vama×Wact+Vame×West), which is calculated from the first speed Vame, the second speed Vama, and the weighting ratios Wact, West, to the actuator control section 81 as the speed of the arm cylinder 6 in accordance with the control flowchart of
(3) When the Elapsed Time from the Beginning of Arm Crowding is t1 or Longer
Lastly, when the elapsed time from the beginning of a crowding operation of the arm 9 by the operator is t1 or longer, the arm cylinder third speed computation section 43e outputs the second speed to the actuator control section 81 as the speed of the arm cylinder 6 in accordance with the control flowchart of
Particularly, when MC is executed on or after time t1 while the arm angle ϕ is 90 degrees or smaller as in the state S2, the actual arm cylinder speed is lower than the first speed due to the own weights of front work devices (arm 9 and bucket 10) positioned forward of the arm 9. However, based on the flowchart of
That is to say, as compared with a case where the first speed is constantly used as the arm cylinder speed during MC, the present embodiment uses the second speed calculated based on actual posture changes. Consequently, MC is stabilized as it is unlikely to be affected by changes, for example, in load pressure, posture, and hydraulic fluid temperature.
Embodiment 2 of the present invention will now be described.
First of all, a major problem to be solved by the present embodiment will be described. In Embodiment 1, a change in the posture of the arm cannot be detected by its posture sensor until the arm actually begins to move. Therefore, the response of MC may be delayed from the beginning of arm movement. However, if the operator suddenly changes the operation amount of the arm operation lever at a time point other than the beginning of arm movement, the actual arm cylinder speed may change earlier than the response of the posture sensor, as is the case with the beginning of arm movement. Consequently, the arm speed calculated from the output of the posture sensor may deviate from the actual arm speed, as is the case with the beginning of arm movement. Embodiment 2 is structured to solve such a problem.
<Flow of Third Speed Calculation by Arm Cylinder Third Speed Computation Section 43e>
In step S720, a check is performed to determine whether the difference between a current arm operation amount computed by the operation amount computation section 43a and an arm operation amount computed in the last sequence is greater than a threshold value dPit. The threshold value dPit can be determined in a manner described below.
<Threshold Value dPit>
When the operating speed of the arm 9 is suddenly changed by an operator operation (when the amount of temporal change in the operating speed of the arm 9 is great), the second speed computed by the arm cylinder second speed computation section 43d may deviate from the actual arm cylinder speed (true value) depending on the detection response performance of the work device posture sensor 50. The amount of temporal change in the operating speed of the arm 9 that causes such deviation is assumed to be equal to or greater than a threshold value dWam. More specifically, the work device posture sensor 50 exhibits a delayed response if the amount of temporal change in the operating speed of the arm 9 is equal to or greater than the threshold value dWam, and responds without undue delay to the amount of change in the operating speed of the arm 9 if the amount of temporal change in the operating speed of the arm 9 is smaller than the threshold value dWam.
In the present embodiment, the amount of change in the arm operation amount (equivalent to the arm operating pressure) at which the amount of temporal change in the operating speed of the arm 9 is equal to the threshold value dWam is predetermined by experiments and simulations and set as the threshold value dPit.
If step S720 is answered YES (if the difference in the arm operation amount between the current sequence and the last sequence is greater than the threshold value dPit), it is concluded that the operating speed of the arm 9 is rapidly changed between the last sequence and the current sequence. Then, in step S730, a check is performed to determine whether the difference in the arm operation amount between the last sequence and the second last sequence is greater than the threshold value dPit.
If step S730 is answered YES (if the difference in the arm operation amount between the last sequence and the second last sequence is greater than the threshold value dPit), it is concluded that a state where the operating speed of the arm 9 is rapidly changed persists. Then, in step S620, the count time t of the timer is advanced by an amount equivalent to a control interval, and then processing proceeds to step S640.
If step S730 is answered NO (if the difference in the arm operation amount between the last sequence and the second last sequence is not greater than the threshold value dPit), it is concluded that a rapid change in the operating speed of the arm 9 is started in the current sequence. Then, in step S630, the count time t of the timer is reset, that is, set to 0, and then processing proceeds to step S640.
If step S720 is answered NO (if the difference in the arm operation amount between the current sequence and the last sequence is not greater than the threshold value dPit), it is concluded that the arm operation is continued from the last sequence (i.e., the encountered situation is the same as a situation where step S610 in Embodiment 1 is answered YES). Then, in step S620, the count time t of the timer is advanced by an amount equivalent to a control interval, and then processing proceeds to step S640.
In step S640, the second speed Vama calculated by the arm cylinder second speed computation section 43d is acquired, and then processing proceeds to step S770.
In step S770, the first speed Vame, which is calculated by the arm cylinder first speed computation section 43f in consideration of a value detected by the hydraulic fluid temperature sensor 210, is acquired.
<Correction Process for First Speed in Accordance with Hydraulic Fluid Temperature>
A process performed by the arm cylinder first speed computation section 43f in order to compute the first speed in accordance with the present embodiment will now be described. The arm cylinder first speed computation section 43f calculates the first speed of the arm cylinder 6 in accordance with the arm operation amount calculated by the operation amount computation section 43a, with the table illustrated in
Processing in steps S660 and beyond is the same as the processing illustrated in
<Operations and Advantages>
If the operator using the hydraulic excavator structured as described above suddenly changes the arm operation amount during an arm operation, the arm cylinder third speed computation section 43e resets the timer in step S630 after performing steps S720 and S730 of
If the amount of change in the lever operation amount is continuously greater than dPit, during the next control interval, the arm cylinder third speed computation section 43e advances the count time t of the timer by an amount equivalent to a control interval in step S620 after performing steps S720 and S730 of
If the count time t is t0 or longer but shorter than t1, in accordance with the control flowchart of
If the count time t is t1 or longer, in accordance with the control flowchart of
Further, even if the speeds of the hydraulic actuators are lowered due to a low hydraulic fluid temperature, an estimated speed of the arm cylinder is calculated based on the result of detection by the hydraulic fluid temperature sensor 210. As a result, the amount of boom raising operation is properly calculated.
Consequently, as compared with a case where the first speed is constantly used as the arm cylinder speed during MC, the present embodiment also uses the second speed calculated based on actual posture changes. As a result, MC is stabilized as it is unlikely to be affected by changes, for example, in load pressure, posture, and hydraulic fluid temperature.
<Other>
Embodiment 2, which has been described above, assumes that time t0 and time t1 are fixed values. Alternatively, however, the values of time t0 and time t1 may be variable with the amount of change in the arm operation amount.
In step S660 according to Embodiment 2, the weighting ratio Wact for the second speed Vama is calculated from the count time t of the timer and the table illustrated in
In Embodiment 2, the arm cylinder first speed computation section 43f performs a correction process for the first speed in accordance with the hydraulic fluid temperature. Alternatively, however, this correction process may be omitted from Embodiment 2 and may be added to Embodiment 1.
The foregoing embodiments use the angle sensors for detecting the angles of the boom 8, arm 9, and bucket 10. Alternatively, however, cylinder stroke sensors may be used instead of the angle sensors in order to calculate the posture information about an excavator. Further, the foregoing description deals with an example in which a hydraulic pilot operated excavator is used. However, when an electric lever operated excavator is used, it may be structured so as to control a command current generated from an electric lever. The velocity vector of the front work device 1A may be determined from an angular velocity that is calculated by differentiating the angles of the boom 8 and bucket 10 instead of being determined from an operator-operated pilot pressure.
In the foregoing embodiments, the process of calculating the arm cylinder speed is changed based on the elapsed time from the beginning of an arm operation or from the beginning of a sudden arm operation while the arm is regarded as the specific front member and the arm cylinder is regarded as the specific hydraulic actuator. However, the problem of the accuracy of speed calculation from an operation amount and the problem of response from a posture sensor also apply to a front member other than the arm, namely, the boom and the bucket. Consequently, the specific front member and the specific hydraulic actuator may be changed to the boom 8 and the boom cylinder 5 or to the bucket 10 and the bucket cylinder 7.
For example, elements pertaining to the controller 40 and their functions and processes to be executed may be partly or wholly implemented by hardware (e.g., by designing the logic for executing the functions with an integrated circuit). Further, the elements pertaining to the controller 40 may be implemented by a program (software) that exercises the functions of the elements of the controller 40 when read and executed by a computation processing unit (e.g., a CPU). Information pertaining to the program may be stored, for example, in a semiconductor memory (a flash memory, an SSD, etc.), a magnetic storage device (a hard disk drive, etc.), and a recording medium (a magnetic disk, an optical disk, etc.).
The present invention is not limited to the foregoing embodiments, but includes various modifications without departing from the spirit and scope thereof. For example, the present invention is not limited to a structure that includes all the elements described in conjunction with the foregoing embodiments, but is also applicable to a structure from which some of the elements are eliminated. Further, some of the elements in a certain embodiment may be added to the elements in another embodiment or used as their substitutes.
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2017/033077 | 9/13/2017 | WO | 00 |
Publishing Document | Publishing Date | Country | Kind |
---|---|---|---|
WO2019/053814 | 3/21/2019 | WO | A |
Number | Name | Date | Kind |
---|---|---|---|
5768810 | Ahn | Jun 1998 | A |
7530225 | Ikeda | May 2009 | B2 |
10156061 | Matsuyama | Dec 2018 | B2 |
10801187 | Izumi | Oct 2020 | B2 |
20160069044 | Takaura et al. | Mar 2016 | A1 |
Number | Date | Country |
---|---|---|
02-176023 | Jul 1990 | JP |
09-273502 | Oct 1997 | JP |
5865510 | Feb 2016 | JP |
Entry |
---|
International Preliminary Report on Patentability received in corresponding International Application No. PCT/JP2017/033077 dated Mar. 26, 2020. |
International Search Report of PCT/JP2017/033077 dated Dec. 5, 2017. |
Number | Date | Country | |
---|---|---|---|
20200157768 A1 | May 2020 | US |