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 increases 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. “Executing MC” may be hereinafter simply referred to as “MCing.”
A technology disclosed, for example, in a patent document named “JP-2000-303492-A” sets a target posture of a bucket (work tool), and provides MCing of a front work device in such a manner as to move the bucket in the target posture along a target excavation surface (hereinafter may be referred to also as a target surface). According to this patent document, as regards the setting of a target bucket posture (a bucket angle with respect to the target surface), the position of the toe of the bucket and the bucket angle in a case where an operation lever of an operation lever device for an arm (arm operation lever) is in neutral are always regarded as the bucket angle with respect to the target surface. Further, this patent document assumes that MC starts at the point in time when the arm operation lever is operated from its neutral position and ends at the point in time when the arm operation lever returns to its neutral position. That is to say, a bucket posture at the beginning of an arm operation is set as the target bucket posture (the bucket angle with respect to the target surface), and MC is executed so as to maintain the bucket in its target posture during the arm operation.
Patent Document 1: JP-2000-303492-A
According to the above patent document, the bucket posture at the point in time when the arm operation is started by the operator is set as the bucket angle with respect to the target surface during MC. That is to say, MC is not executed so as to set the bucket angle with respect to the target surface (referred to as the “bucket angle with respect to the ground” in Patent Document 1) to a predetermined value. Therefore, in order to set the bucket angle with respect to the target surface during MC to a desired value, the bucket angle with respect to the target surface needs to be adjusted by the operator before the start of the arm operation. However, it is difficult for the operator to visually check the bucket angle with respect to the target surface during such an angle adjustment. Consequently, it requires skills to set the bucket angle with respect to the target surface to a desired value.
Further, MC may give an uncomfortable feeling to the operator because it provides an operation that intervenes with an operation performed by the operator. Therefore, wherever possible, MC should preferably be initiated at a point in time that does not give an uncomfortable feeling to the operator.
An object of the present invention is to provide a work machine that is capable of easily setting the angle of a work tool, such as a bucket, with respect to a target surface to a desired value without giving an uncomfortable feeling to an operator wherever possible.
In accomplishing the above object, according to the present invention, there is provided a work machine that performs work by operating an arm after moving a work tool to a work start position. The work machine includes a work device, a plurality of hydraulic actuators, an operation device, and a control device. The work device includes a boom, the arm, and the work tool. The hydraulic actuators drive the work device. The operation device instructs the work device to operate in accordance with an operator's operation. The control device includes an actuator control section that controls at least one of the hydraulic actuators under predetermined conditions at a time of operation of the operation device is operated. The control device further includes an operation determination section that determines, based on an operation performed on the operation device, whether the work device is engaged in a work preparation operation for moving the work tool to the work start position. When the operation determination section determines that the work device is engaged in the work preparation operation at the time of operation of the operation device, the actuator control section executes machine control to control a target hydraulic actuator such that an angle of the work tool with respect to a target surface indicative of a target shape of a work target for the work device coincides with a preset target angle. The target hydraulic actuator is one of the hydraulic actuators and related to the work tool.
When a work tool is to be positioned with respect to a target surface as needed at the beginning of excavation or other work, the present invention makes it possible to quickly adjust the angle of the work tool for the target surface without causing an uncomfortable feeling, and thus provide increased work efficiency.
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) at 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 link 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 suffix. For example, when three pumps 300a, 300b, and 300c exist, they may be collectively designated as the pumps 300.
Referring to
The front work device 1A is formed by coupling a plurality of driven members (a boom 8, an arm 9, and a bucket 10), which pivot independently from each other 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 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 a hydraulic pump 2 and a pilot pump 48. The hydraulic pump 2 is a variable displacement pump, and its displacement is controlled by a regulator 2a. The pilot pump 48 is a fixed displacement pump. In the present embodiment, as depicted in
A pump line 148a is a delivery piping for the pilot pump 48. The pump line 148a 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 example, and its solenoid drive section is electrically connected to a position sensor of a gate lock lever (not depicted) disposed in the cab (
The operation devices 45, 46, and 47 are of a hydraulic pilot type, and generate a pilot pressure (may be referred to 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 and 23 operated by an 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 (see
The hydraulic fluid delivered from the hydraulic pump 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
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 front 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 front 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 depicted in
The work device 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. Each of these angle sensors 30, 31, 32, and 33 functions as a posture sensor for the front work device 1A.
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 depicted) 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 sensor 52a includes 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, 145, and 146 when the operator operates the operation levers 1a and 1b (operation devices 45a, 45b, and 46a). That is to say, the operator operation sensor 52a detects an operation performed on the hydraulic cylinders 5, 6, and 7 related to the front work device 1A.
The control selection switch 97 is disposed, for example, on the front upper end of the operation lever 1a shaped like a joystick. The control selection switch 97, which is depressed by the thumb of the operator gripping the operation lever 1a, is a momentary switch. Pressing the control selection switch 97 alternately enables (turns on) and disables (turn off) a bucket angle control (work tool angle control) function. The position in which the control selection switch 97 is placed (the ON or OFF position) is inputted to the controller 40. The control selection switch 97 need not always be disposed on the operation lever 1a (1b), but may be disposed at a different location.
The target angle setting device 96 is an interface that is capable of inputting the angle formed between the target surface 60 and the bottom surface 10a of the bucket 10 (this angle is hereinafter referred to also as the “bucket angle with respect to target surface θTGT”). For example, a rotary switch (dial switch) for selecting a desired angle from a plurality of different angles may be used as the target angle setting device 96. The setting of the bucket angle with respect to target surface θTGT may be manually inputted by the operator through the target angle setting device 96, provided with an initial value, or acquired from the outside. The bucket angle with respect to target surface θTGT, which is set by the target angle setting device 96, is inputted to the controller 40.
The control selection switch 97 and the target angle setting device 96 need not always be formed of hardware. For example, an alternative is to adopt a touch panel display device 53 and implement the control selection switch 97 and the target angle setting device 96 by using a graphical user interface (GUI) displayed on the screen of the touch panel display device 53.
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 configured 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 have a primary port side connected to the pilot pump 48, reduce the pilot pressure from the pilot pump 48, and output 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 and 56d, and direct the selected pressure to hydraulic drive sections 152a and 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 front control hydraulic unit 160 configured as described above, a pilot pressure (second control signal) is generated even if the associated operation devices 45a and 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 pilot 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 smaller 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.” Further, 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 speed vector of the control point for the front 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 speed vector of the control point for the front 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 interrupted 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 controls the flow control valves 15a to 15c in accordance with the second control signal.
Referring to
The controller 40 depicted 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 front 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 an input from the operator operation sensor 52a. 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 an operation lever for the operation device 45a, 45b, 46a may be used to detect the operation amount of the operation lever. Further, the configuration for calculating an operation speed from an operation amount may be replaced by a configuration in which stroke sensors for detecting the expansion and contraction amounts of the hydraulic cylinders 5, 6, and 7 are installed to calculate the operation speeds of the cylinders in accordance with temporal changes in the detected expansion and contraction amounts.
The posture computation section 43b computes, based on information from the work device posture sensor 50, the posture of the front work device 1A and the position of the claw tip of the bucket 10 in a local coordinate system.
The posture of the front work device 1A can be defined in an excavator coordinate system (local coordinate system) depicted 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 front work device 1A moves (the operation plane of the work device) as depicted in
In the example of
The boom control section 81a and the bucket control section 81b form an actuator control section 81. The actuator control section 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.
The operation determination section 81c determines, based on an operation performed on the operation devices 45a, 45b, and 46a, whether the front work device 1A is engaged in an operation (referred to as the “work preparation operation”), that is, positioned to move the bucket 10 to a start position (referred to as the “work start position”) for work (referred to as the “arm work”) in which the arm 9 (arm cylinder 6) performs a crowding operation or a dumping operation. The “work preparation operation” is referred to also as a bucket positioning operation or bucket positioning work for moving the bucket 10 to the work start position.
An exemplary work preparation operation (bucket positioning work) for arm work based on arm crowding is illustrated in
For example, in finishing work for slope excavation, it is preferable that the bucket 10 be linearly moved along the target surface 60 to smooth the target surface 60 while the bottom surface 10a of the bucket 10 is angled substantially parallel to the slant of the target surface 60 (i.e., the bucket angle with respect to target surface θ is zero). Therefore, at the work start position, it is preferred that the bottom surface 10a of the bucket 10 be angled substantially parallel to the slant of the target surface 60. Here, the bottom surface 10a of the bucket 10 is a surface of the bucket 10 that corresponds to a straight line joining the front end of the bucket 10 to its rear end.
The work preparation operation (bucket positioning work) in the above case is a series of operations that start in a state S1 (see
In the state S1 in which the work preparation operation starts, the arm 9 need not always be fully crowded as depicted in
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 operation amounts of the operation devices 45a, 45b, and 46a, 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 are operated. More specifically, when the operation determination section 81c determines that the front work device 1A is performing the work preparation operation, and the distance between the target surface 60 and the claw tip of the bucket 10 is equal to or smaller 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 the bucket angle with respect to target surface θTGT, which is preset by the target angle setting device 96. The bucket control section 81b computes the target pilot pressure for the flow control valve 15c of the bucket cylinder 7. MC executed by the bucket control section 81b will be described in detail later with reference to
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.
<Flow of Bucket Angle Control by Bucket Control Section 81b and Operation Determination Section 81c>
In step 101, the operation determination section 81c determines whether the front work device 1A is engaged in the work preparation operation by checking whether the pivot speed of the arm 9 is equal to or smaller than a predetermined value ω1. The predetermined value ω1 is set in order to detect the point in time when an arm operation in the state S2 will end shortly or has already ended and thus a boom lowering operation in the state S3 will start shortly. If the arm pivot speed is equal to or smaller than the predetermined value ω1, the front work device 1A is determined to be engaged in the work preparation operation, and processing proceeds to step 102. The arm pivot speed used in step 101 may be obtained by presetting a correlation table defining the relationship between the pilot pressure for the flow control valve 15b and the arm pivot speed and then determining the arm pivot speed from the correlation table and the pilot pressure for the flow control valve 15b, which is detected by the operator operation sensor 52a. Alternatively, the arm pivot speed may be determined by time-differentiating the angle of the arm 9 that is detected by the work device posture sensor 50.
The predetermined value ω1 of the arm pivot speed should be preferably set to a sufficiently small value so that the speed of the arm 9 does not decrease even when MC of the bucket 10 or boom 8 is initiated to let the bucket 10 or the boom 8 move simultaneously with the arm 9 in a case where the operator operates the arm 9 to transition from the state S2 to the state S3. As far as the predetermined value ω1 is set in the above manner, the operator does not feel uncomfortable even if MC is initiated during an arm operation. Further, the predetermined value ω1 may be set to zero. When the predetermined value ω1 is set to zero, bucket angle control is executed to prevent the operation of the bucket 10 during an arm operation performed by the operator. Consequently, no uncomfortable feeling will be caused by a complex operation.
In step 102, the bucket control section 81b determines whether the distance D between the target surface 60 and the claw tip of the bucket 10 is equal to or smaller than a predetermined value D1. If the distance between the target surface 60 and the bucket 10 is equal to or smaller than the predetermined value D1, processing proceeds to step 103.
The predetermined value D1 of the distance between the bucket 10 and target surface 60 in the present embodiment determines the point in time at which MC is initiated to execute bucket angle control. It is preferable that the predetermined value D1 be set to a value as small as possible with a view toward reducing the uncomfortable feeling that may be given to the operator by the initiation of bucket angle control. For example, the predetermined value D1 may be equal to the length of the bottom surface 10a of the bucket 10. Further, the distance D between the target surface 60 and the claw tip of the bucket 10, which is used in step 102, can be calculated 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. A reference point of the bucket 10 on which the calculation of the distance D is based need not always be the bucket claw tip (the front end of the bucket 10). The reference point may be a point on the bucket 10 that minimizes the distance to the target surface 60, or may be at the rear end of the bucket 10.
In step 103, the bucket control section 81b determines, based on a signal from the operation amount computation section 43a, whether an operation signal for the bucket 10 is issued by the operator. If it is determined that an operation signal for the bucket 10 is issued, processing proceeds to step 104 and then to step 105. If, by contrast, it is determined that no operation signal is issued for the bucket 10, processing skips to step 105.
In step 104, the bucket control section 81b outputs a command so as to close the solenoid proportional valves (bucket pressing reducing valves) 56a and 56b in the pilot lines 146a and 146b for the bucket 10. This prevents the bucket 10 from being pivoted by an operator operation that is performed through the operation device 46a.
In step 105, the bucket control section 81b outputs a command so as to open the solenoid proportional valves (bucket pressure increasing valves) 56c and 56d in the pilot line 148a for the bucket 10, and controls the bucket cylinder 7 so that the bucket angle with respect to target surface coincides with the setting θTGT. Bucket angle control starts at the point in time when the distance D reaches the predetermined value D1. However, a control algorithm should preferably be built so as to complete bucket angle control before the distance D reaches zero.
If it is determined in any of steps 100, 101, and 102 that a condition is not satisfied (the query is answered “NO”), processing proceeds to step 106. In step 106, the angle of the bucket 10 (the bucket angle with respect to target surface) is not controlled so that no command is issued to the four solenoid proportional valves 56a, 56b, 56c, and 56d.
<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 machine control in addition to bucket angle control by the above bucket control section 81b. The flow of boom raising control by the boom control section 81a is illustrated in
In step 410, the boom control section 81a computes the operation speed (cylinder speed) of each hydraulic cylinder 5, 6, and 7 in accordance with an operation amount computed by the operation amount computation section 43a.
In step 420, based on the operation speeds of the hydraulic cylinders 5, 6, and 7, which are computed in step 410, and on the posture of the front work device 1A, which is computed by the posture computation section 43b, the boom control section 81a computes a speed vector B of the toe (claw tip) of the bucket operated by the operator.
In step 430, 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 440, the boom control section 81a acquires a vertical component by of the speed vector B, calculated in step 420, of the toe of the bucket operated by the operator. The acquired vertical component by is vertical to the target surface 60.
In step 450, the boom control section 81a determines whether the limit value ay calculated in step 430 is 0 or greater. It should be noted that xy coordinates are set as depicted in the upper right corner of
In step 460, the boom control section 81a determines whether the vertical component by of the speed vector B of the claw tip operated by the operator is equal to or greater than 0. If the vertical component by is positive, it indicates that the vertical component by of the speed vector B is oriented upward. If the vertical component by is negative, it indicates that the vertical component by of the speed vector B is oriented downward. If it is determined in step 460 that the vertical component by is equal to or greater than 0 (i.e., the vertical component by is oriented upward), processing proceeds to step 470. If, by contrast, the vertical component by is smaller than 0, processing proceeds to step 500.
In step 470, 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 500. 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 530.
In step 500, 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 speed vector C of the toe 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 430, and the vertical component by in step 440. Subsequently, the speed vector C capable of outputting the calculated vertical component cy is calculated, and its horizontal component is designated as cx (step 510).
In step 520, a target speed vector T is calculated. When a component of the target speed vector T that is vertical to the target surface 60 is ty, and a component horizontal to the target speed vector T is tx, the components are expressed by “ty=by+cy and tx=bx+cx,” respectively. When the equation (cy=ay−by) in step 500 is substituted into the above equations, the target speed vector T is eventually expressed by “ty=ay and tx=bx+cx.” That is to say, when step 520 is reached, the vertical component ty of the target speed vector is limited to the limit value ay, and a forced boom raising operation is initiated under machine control.
In step 480, the boom control section 81a determines whether the vertical component by of the speed vector B of the claw tip operated by the operator is equal to or greater than 0. If it is determined in step 480 that the vertical component by is equal to or greater than 0 (i.e., the vertical component by is oriented upward), processing proceeds to step 530. If, by contrast, the vertical component by is smaller than 0, processing proceeds to step 490.
In step 490, 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 530. 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 500.
When step 530 is reached, the boom 8 need not be moved under machine control. Therefore, a front control device 81d sets the speed vector C to zero. In this instance, when based on the equations (ty=by+cy, tx=bx+cx) used in step 520, the target speed vector T is expressed by “ty=by and tx=bx.” As a result, the target speed vector T coincides with the speed vector B based on an operator operation (step 540).
In step 550, the front control device 81d computes the target speeds of the hydraulic cylinders 5, 6, and 7 in accordance with the target speed vector T (ty, tx) determined in step 520 or 540. As is obvious from the foregoing description, if the target speed vector T does not coincide with the speed vector B in the case of
In step 560, 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 550.
In step 590, 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 front 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 toe of the bucket 10 from intruding into the target surface 60 and automatically raise the boom 8.
In the present embodiment, arm 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, arm control based on the distance D between the bucket 10 and the target surface 60 may alternatively be executed as MC.
Operator operations performed on the hydraulic excavator having the above-described configuration in a case where a transition occurs from the state S1 (
First of all, an operator operation performed to transition from the state S1 to the state S2 in
Next, an operator operation performed to transition from the state S2 to the state S3 as depicted in
That is to say, when the front work device 1A is engaged in the work preparation operation (e.g., between the state S2 and the state S3) in a situation where the bucket control section 81b is configured as described above, bucket angle control is executed at the point in time at which the distance D between the bucket 10 and the target surface 60 reaches a value equal to or smaller than the predetermined value D1 (i.e., at the point in time when the bucket 10 approaches the target surface 60). Thus, before the claw tip of the bucket 10 reaches the target surface 60, the bucket angle with respect to target surface can be set to the value θTGT, which is set by the target angle setting device 96. Therefore, bucket angle control is initiated so that the bucket angle with respect to target surface is easily controlled to the setting θTGT. In addition, the bucket angle control is prevented from being initiated in a situation where the claw tip of the bucket 10 is positioned away from the target surface 60. This makes it possible to relatively shorten the period during which an uncomfortable feeling is given to the operator.
Further, when a plurality of hydraulic actuators driven by a hydraulic fluid of the same hydraulic pump are simultaneously moved, the operation speeds of the hydraulic actuators generally tend to be lower than when one hydraulic actuator is moved. When the work preparation operation is performed, the positioning of the bucket 10 in a front-rear direction of the machine body is mainly achieved by the arm 9. Therefore, if MC is executed, at the time of an operation of the arm 9, for another hydraulic actuator that is driven by the hydraulic fluid of the same hydraulic pump as for the arm 9, the operator may feel uncomfortable because the operation speed of the arm 9 may decrease against an operator's intention. It should be noted in this regard that the present embodiment does not execute bucket angle control while the operation amount of the arm 9 is large (while the arm pivot speed is high). Consequently, the speed of the arm 9 does not decrease due to an operator operation. As a result, the operator can move the arm 9 without feeling uncomfortable.
Accordingly, when the work preparation operation for arm work is performed, the hydraulic excavator configured as described above makes it possible to quickly adjust the bucket angle with respect to target surface to the setting θTGT without giving an uncomfortable feeling to the operator. This results in increased work efficiency.
If the operator performs a crowding or dumping operation of the bucket 10 during a transition made from the state S2 to the state S3 as depicted in
In Embodiment 1, when the arm pivot speed is equal to or lower than the predetermined value ω1, the operation determination section 81c determines that the front work device 1A is engaged in the work preparation operation. In Embodiment 2, however, the front work device 1A is determined to be engaged in the work preparation operation when a component of the speed vector at the tip of the arm 9 that is vertical to the target surface 60 is oriented toward the target surface 60.
More specifically, in Embodiment 2, whether the angle of the bucket 10 is to be subjected to MC to achieve a desired bucket angle with respect to target surface θTGT is determined based on the direction of a speed vector 100 (see
<Flow of Bucket Angle Control by Bucket Control Section 81b and Operation Determination Section 81c>
In step 201 of
The speed vector 100 used for determination in step 201 can be calculated by converting the pilot pressure acquired from the operator operation sensor 52a into a cylinder speed through the use of the correlation table, which is indicative of the correlation between pilot pressure and cylinder speed and stored in the controller 40, and geometrically converting the cylinder speed into an angular speed of the front work device 1A.
If, as depicted in
The above description deals with, as an example, the speed vector 100 generated at the bucket pin (the tip of the arm 9). However, an alternative is to calculate the speed vector generated at the toe of the bucket 10 or at some other reference point on the bucket and execute control by using the vertical component of the calculated speed vector that is vertical to the target surface.
Embodiment 3 is characterized in that a boom lowering operation and an arm dumping operation are detected by adding steps 301 and 302 to the flowchart of
In step 301, the operation determination section 81c determines, based on a signal from the operation amount computation section 43a, whether the arm 9 is not operated by the operator or an arm dumping operation is performed by the operator. That is to say, the operation determination section 81c determines whether an arm crowding operation is not performed. In the work preparation operation, the arm 9 mainly performs a dumping operation, and then a boom lowering operation is performed to bring the bucket 10 closer to the target surface 60. Therefore, detecting whether or not an arm crowding operation is performed in step 301 makes it possible to determine with higher accuracy than in Embodiment 1 whether the front work device 1A is engaged in the work preparation operation. If the query in step 301 is answered “YES,” the arm pivot speed in step 101 is determined to be the pivot speed of an arm dumping operation. If it is determined in step 301 that no arm crowding operation is performed, the front work device 1A is determined to be currently engaged in the work preparation operation, and then processing proceeds to step 102. If, by contrast, it is determined that an arm crowding operation is performed, the front work device 1A is determined to be not engaged in the work preparation operation, and then processing proceeds to step 106.
In step 302, which is performed subsequently to step 102, the operation determination section 81c determines, based on a signal from the operation amount computation section 43a, whether a boom lowering operation is performed by the operator. As mentioned earlier, in the work preparation operation, a boom lowering operation is performed to bring the bucket 10 closer to the target surface. Therefore, detecting whether or not a boom lowering operation is performed in step 302 makes it possible to detect with higher accuracy than in Embodiment 1 whether the front work device 1A is engaged in the work preparation operation. If it is determined in step 302 that a boom lowering operation is performed, processing proceeds to step 103.
As steps 301 and 302 are added to bucket angle control, the hydraulic excavator configured as described in conjunction with Embodiment 3 detects the work preparation operation with higher accuracy than in Embodiment 1. This makes it possible to further reduce an uncomfortable feeling given to the operator.
The order of performing steps 100, 101, 301, 102, and 302 in
Embodiment 4 corresponds to an example of processing performed in step 105 of
When step 105 begins in
Next, in step 105-2, the bucket control section 81b calculates a target value γTGT of the bucket pivot angle γ. The target value γTGT can be calculated from Equation (1) below by making use of the fact that the sum of α, β, γ, θTGT, and γTGT is 180 degrees. More specifically, the target value γTGT can be calculated in the manner described in the flowchart of
γTGT=180−(α+β+θTGT) Equation (1)
As depicted in
Referring to the flowchart of
In step 105-3, the bucket control section 81b compares the current bucket pivot angle γ with γTGT calculated in step 105-2. If the result of comparison in step 105-3 indicates that γ is greater than γTGT, processing proceeds to step 105-4. If any other result is obtained, processing proceeds to step 105-5.
In step 105-4, the bucket control section 81b issues a command for the solenoid proportional valve 56d to the solenoid proportional valve control section 44 in order to pivot the bucket 10 in the dumping direction and thus decrease the pivot angle γ. Upon completion of step 105-4, the bucket control section 81b returns to step 105-1.
In step 105-5, the bucket control section 81b compares γ with γTGT. If γ is smaller than γTGT, processing proceeds to step 105-6. If γ is not smaller than γTGT, processing proceeds to step 105-7.
In step 105-6, the bucket control section 81b issues a command for the solenoid proportional valve 56c to the solenoid proportional valve control section 44 in order to pivot the bucket 10 in the crowding direction and thus increase the pivot angle γ. Upon completion of step 105-6, the bucket control section 81b returns to step 105-1.
In step 105-7, the bucket control section 81b terminates step 105 without controlling the pivot of the bucket because the pivot angle γ of the bucket is equal to the target value γTGT of the pivot angle γ.
Performing the above processing makes it possible to execute control so that the bucket pivot angle γ coincides with the target value γTGT. Therefore, control can be executed so that the bucket angle with respect to target surface coincides with the setting θTGT.
Further, in step 105-2, the pivot angle γTGT of the bucket may be calculated as described below.
γTGT is calculated from Equation (2) below. β, δ, and θTGT in Equation (2) are known values. Therefore, when αTGT is calculated, γTGT can be calculated. The offset amount OF is uniquely determined from dimensional information about the bucket 10 when the setting θTGT of the bucket angle with respect to target surface is specified. For example, the offset amount OF=L3 sin(θTGT+δ). In this instance, the height coordinate Za of the target position of the connection point 9F at the time of positioning is also uniquely determined, and the longitudinal coordinate Xa of the target position is determined in accordance with the pivot angle β of the arm 9 and the target value αTGT of the pivot angle of the boom 8. As the pivot angle β of the arm 9 is determined by an operator operation, it is possible to compute the pivot angle αTGT of the boom 8 that should be eventually achieved at the time of positioning. Here, γTGT is calculated as described in the flowchart of
γTGT=18031 (αTGT+β+δ+θTGT) Equation (2)
Referring to the flowchart of
When the target value γTGT of the pivot angle of the bucket 10 is calculated as described above, the pivot control amount of the bucket 10 can be reduced to shorten the time period during which the operator may feel uncomfortable.
Embodiment 1 executes bucket angle control at the point in time when the operation determination section 81c finds the front work device 1A in the work preparation operation and the distance D between the bucket 10 and the target surface 60 is equal to or smaller than the predetermined value D1. Meanwhile, a modification of Embodiment 1 executes bucket angle control at the point in time when the operation determination section 81c determines that the front work device 1A is engaged in the work preparation operation. The other portions have the same configuration as those in Embodiment 1 and will not be redundantly described.
In step 101, as is the case with Embodiment 1, whether the front work device 1A is engaged in the work preparation operation is determined by allowing the operation determination section 81c to check whether the pivot speed of the arm 9 is equal to or lower than the predetermined value ω1. If the arm pivot speed is equal to or lower than the predetermined value ω1, the front work device 1A is determined to be engaged in the work preparation operation, and processing proceeds to step 103.
In step 103, the bucket control section 81b determines, based on a signal from the operation amount computation section 43a, whether an operation signal for the bucket 10 is issued by the operator. If no operation signal is issued for the bucket 10, processing proceeds to step 105.
In step 105, the bucket control section 81b issues a command for opening the solenoid proportional valves (bucket pressure increasing valves) 56c and 56d in the pilot line 148a for the bucket 10, and controls the bucket cylinder 7 so that the bucket angle with respect to target surface coincides with the setting θTGT.
When the bucket control section 81b is configured as described above, bucket angle control is executed upon detection of the front work device 1A engaged in the work preparation operation in step 101 so that the bucket angle with respect to target surface can be set to the value θTGT, which is set by the target angle setting device 96. Therefore, the bucket angle with respect to target surface can be easily controlled to the setting θTGT by initiating bucket angle control.
The present modification is configured so that whether the front work device 1A is engaged in the work preparation operation is determined by allowing the operation determination section 81c to check whether the pivot speed of the arm 9 is equal to or lower than the predetermined value ω1. However, whether the front work device 1A is engaged in the work preparation operation may be determined under different conditions. For example, whether the front work device 1A is engaged in the work preparation operation may alternatively be determined by checking whether the pivot speed in a boom lowering direction is equal to or lower than a predetermined value ω2. Another alternative is to make the determination in step 201 of
The present invention is not limited to the foregoing embodiments, but includes various modifications. For example, the foregoing embodiments have been described in detail in order to facilitate the understanding of the present invention. Therefore, the present invention is not limited to a configuration that includes all the elements described in conjunction with the foregoing embodiments.
For example, in the foregoing embodiments, whether the front work device 1A is engaged in the work preparation operation is mainly determined depending on whether the pivot speed of the arm 9 is equal to or lower than the predetermined value ω1 or whether a component of the speed vector of the arm 9 or bucket 10 that is vertical to the target surface 60 is oriented toward the target surface 60. However, the determination may alternatively be made depending on some other elements (e.g., temporal changes in the load on the hydraulic cylinders 5, 6, and 7).
A hydraulic excavator having the bucket 10 as a work tool has been described in conjunction with the foregoing embodiments. However, the work tool is not limited to the bucket 10. The present invention is also applicable to a work machine having, for example, a spray device 10X as the work tool as depicted in
Further, the bucket angle with respect to target surface has been described with reference to a case where the bottom surface of the bucket 10 is angled substantially parallel to the slant of the target surface 60 (i.e., a case where θTGT=0). However, the setting of the bucket angle with respect to target surface is not limited to such a case. For example, excavation work may be facilitated by placing the toe of the bucket 10 in an initial posture for intruding the toe of the bucket 10 into the target surface 60 by setting θTGT to a value greater than 0 (zero). Furthermore, when the spray device 10X depicted in
Moreover, the bucket position maintained by setting the bucket angle with respect to target surface to θTGT need not always be on the target surface 60, but may be on a surface that is similar in shape to the target surface 60 and obtained by offsetting the target surface 60 by a desired amount. When the angle of the work tool is controlled to θTGT on the above-mentioned offset surface, the ejection port of the nozzle 10Y can be continuously positioned at a desired distance from the spraying surface 60X while spraying work is performed with the spray device 10X depicted, for example, in
The foregoing embodiments use angle sensors for detecting the angles of the boom 8, arm 9, and bucket 10. However, cylinder stroke sensors may alternatively be used instead of the angle sensors in order to calculate the posture information about an excavator. Further, the foregoing embodiments have been described with reference to a case where a hydraulic pilot excavator is employed. However, the foregoing embodiments are also applicable to an electric lever excavator as far as it is configured so as to control a command current generated from an electric lever. The foregoing embodiments have been described on the assumption that the speed vector of the front work device 1A is calculated from a pilot pressure based on an operator operation. However, the speed vector of the front work device 1A may alternatively be calculated from an angular speed that is determined by differentiating the angle of the boom 8, arm 9, or bucket 10.
When, in the foregoing embodiments, the operator brings the bucket 10 closer to the target surface 60 by lowering the boom 8 in a case where a transition is made from the state S2 to the state S3 as depicted in
For example, the elements of the above-described controller 40, the functions of the elements, and the processes executed by the elements may be partly or wholly implemented by hardware (e.g., by designing the logic for executing each function with an integrated circuit). Further, the elements of the above-described controller 40 may be each implemented by a program (software) that is read and executed by an arithmetic processing unit (e.g., a CPU) in order to perform the functions of the elements of the controller 40. Information concerning the program may be stored, for example, in a semiconductor memory (e.g., a flash memory or an SSD), a magnetic storage device (e.g., a hard disk drive), or a recording medium (e.g., a magnetic disk or an optical disk).
Number | Date | Country | Kind |
---|---|---|---|
2017-049397 | Mar 2017 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2017/040321 | 11/8/2017 | WO | 00 |