The present invention relates to a work machine.
It is known that a hydraulic excavator, which is one type of a work machine, has a region limiting function to control a multijoint front work device (often simply referred to as a work device) in such a manner as to prevent penetration of a control point (for example, bucket claw tip) of the work device into a design surface.
Such a region limiting function can keep the control point of the work device onto the design surface by setting a velocity at which the work device moves toward the design surface to be lower as a distance between the control point of the work device and the design surface is smaller, and setting to zero the velocity at which the work device moves toward the design surface when the distance between the control point of the work device and the design surface is zero.
However, in actual work, not only finishing work for moving the control point (bucket claw tip) along the design surface to form a flat surface but also compaction work such as bumping for pushing a back surface of a bucket against a ground and compacting earth and sand by a boom lowering action is often necessary. Owing to this, if the velocity in a direction of the design surface is set lower near the design surface by the region limiting function described above on a scene where the compaction work is necessary, problems occur that a force of pushing the back surface of the bucket against the ground weakens and that it is impossible to conduct operator's intended work or an operator has a feeling of strangeness for an operation.
In Patent Document 1, for example, it is determined that a work phase is compaction work in a case in which a ratio (a1/A1) of a low-pass filtered boom operation signal (a1) to an actual boom operation signal (A1) is lower than a constant (r1) smaller than 1. In addition, Patent Document 1 discloses that favorable compaction work can be conducted by setting to be higher a limiting velocity of the work device or cancelling limitations when it is determined that the work phase is compaction work, compared with work other than the compaction work.
However, with a technology of Patent Document 1, it is determined whether the work phase is the compaction work only by the boom operation signal. Owing to this, if the boom operation signal satisfies the condition described above, there is a probability that the work phase is determined to be the compaction work and the velocity limitation (that is, region limiting function) on the work device is either relaxed or cancelled even in a state, for example, in which an angle formed between the bucket back surface and the design surface is a right angle and the bucket claw tip stands upright on the design surface. If the velocity limitation on the work device is relaxed or cancelled in this state, the bucket claw tip penetrates into below the design surface and an actual surface to be worked is damaged against an operator's intention of work.
An object of the present invention is to provide a work machine capable of accurately determining a work phase and favorably conducting compaction work.
To attain the object, a work machine includes: a work device having a boom, an arm, and a bucket; a plurality of hydraulic actuators that drive the work device; an operation device that outputs an operation signal in response to an operator's operation and that instructs the plurality of hydraulic actuators to be actuated; and a controller that limits a velocity at which the work device approaches a predetermined design surface to be equal to or lower than a predetermined limiting velocity in such a manner that the work device is located onto or above the design surface when the operation device is operated, the controller determining whether a work phase of the work device is compaction work on the basis of a posture of the bucket with respect to the design surface in a case in which the operation device instructs the work device to approach the design surface, and setting the limiting velocity when determining that the work phase of the work device is the compaction work to be higher than the limiting velocity when determining that the work phase of the work device is other than the compaction work.
According to the present invention, it is possible to accurately determine a work phase and favorably conducting compaction work.
A work machine according to embodiments of the present invention will be described hereinafter with reference to the drawings.
The swing structure 3 has an operation room 4, a machine room 5, and a counterweight 6. The operation room 4 is provided in a left side portion in a front portion of the swing structure 3. The machine room 5 is provided in rear of the operation room 4. The counterweight is provided in rear of the machine room 5, that is, on a rear end of the swing structure 3.
In addition, the swing structure 3 is equipped with a multijoint work device 7. The work device 7 is provided rightward of the operation room 4 in the front portion of the swing structure 3, that is, in a generally central portion of the front portion of the swing structure 3. The work device 7 has a boom 8, an arm 9, a bucket (work tool) 10, a boom cylinder 11, an arm cylinder 12, and a bucket cylinder 13. A base end portion of the boom 8 is rotatably attached to the front portion of the swing structure 3 via a boom pin P1 (refer to
A variable displacement first hydraulic pump 14 and a variable displacement second hydraulic pump 15 (refer to
A machine body inclination sensor 17 is attached to an interior of the operation room 4, a boom inclination sensor 18 is attached to the boom 8, an arm inclination sensor 19 is attached to the arm 9, and a bucket inclination sensor 20 is attached to the bucket 10. The machine body inclination sensor 17, the boom inclination sensor 18, the arm inclination sensor 19, and the bucket inclination sensor 20 are, for example, IMUs (Inertial Measurement Units). The machine body inclination sensor 17 measures an angle (ground angle) of the swing structure (machine body) 3 with respect to a horizontal surface, the boom inclination sensor 18 measures a ground angle of the boom 8 with respect to the horizontal surface, the arm inclination sensor 19 measures a ground angle of the arm 9 with respect to the horizontal surface, and the bucket inclination sensor 20 measures a ground angle of the bucket 10 with respect to the horizontal surface.
A first GNSS (Global Navigation Satellite System) antenna 21 and a second GNSS antenna 22 are attached left and right in a rear portion of the swing structure 3, respectively. Position data about predetermined two points (for example, positions of base end portions of the first GNSS antenna 21 and the second GNSS antenna 22) in a global coordinate system can be calculated from navigation signals received by the antennas 21 and 22 from a plurality of navigation satellites (preferably four or more satellites). In addition, it is possible to calculate coordinate values of an origin P0 (refer to
The operation device 24 has a boom operation lever 24a for operating the boom 8 (boom cylinder 11), an arm operation lever 24b for operating the arm 9 (arm cylinder 12), and a bucket operation lever 24c for operating the bucket 10 (bucket cylinder 13). The operation levers 24a, 24b, and 24c are, for example, electric levers and output voltage values in response to tilting amounts (operation amounts) of the operation levers 24a, 24b, and 24c to the controller 25. The boom operation lever 24a outputs a target action amount (hereinafter, referred to as a boom operation amount) of the boom cylinder 11 as the voltage value in response to the operation amount of the boom operation lever 24a. The arm operation lever 24b outputs a target action amount (hereinafter, referred to as an arm operation amount) of the arm cylinder 12 as the voltage value in response to the operation amount of the arm operation lever 24b. The bucket operation lever 24c outputs a target action amount (hereinafter, referred to as a bucket operation amount) of the bucket cylinder 13 as the voltage value in response to the bucket operation lever 24c. Alternatively, the operation levers 24a, 24b, and 24c may be hydraulic pilot levers and detect the operation amounts by converting pilot pressures generated in response to the tilting amounts of the operation levers 24a, 24b, and 24c into voltage values by a pressure sensor (not depicted) and outputting the voltage values to the controller 25.
The controller 25 computes control commands on the basis of the operation amounts output from the operation device 24, position data (control point position data) about the bucket tip end P4 that is a predetermined control point set to the work device 7 in advance, position data (design surface information) about a design surface 60 (refer to
A boom rod pressure sensor 61 that acquires a rod pressure of the boom cylinder 11 and a boom bottom pressure sensor 62 that acquires a bottom pressure of the boom cylinder 11 are attached to the boom cylinder 11. An arm rod pressure sensor 63 that acquires a rod pressure of the arm cylinder 12 and an arm bottom pressure sensor 64 that acquires a bottom pressure of the arm cylinder 12 are attached to the arm cylinder 12. A bucket rod pressure sensor 65 that acquires a rod pressure of the bucket cylinder 13 and a bucket bottom pressure sensor 66 that acquires a bottom pressure of the bucket cylinder 13 are attached to the bucket cylinder 13. Detection signals of these pressure sensors 61 to 66 are input to the controller 25.
The flow control valve device 26 is configured with a plurality of electromagnetically driven spools, and drives a plurality of hydraulic actuators mounted in the hydraulic excavator 1 and including the hydraulic cylinders 11, 12, and 13 by changing opening areas (throttle opening degrees) of the spools on the basis of the control commands output from the controller 25.
The flow control valve device 26 is configured with a first arm spool 28 that is a first flow control valve controlling the flow rate of the hydraulic operating fluid supplied from the first hydraulic pump 14 to the arm cylinder 12, a second arm spool 29 that is a third flow control valve controlling the flow rate of the hydraulic operating fluid supplied from the second hydraulic pump 15 to the arm cylinder 12, a bucket spool 30 controlling the flow rate of the hydraulic operating fluid supplied from the first hydraulic pump 14 to the boom cylinder 11, a boom spool (first boom spool) 31 that is a second flow control valve controlling the flow rate of the hydraulic operating fluid supplied from the second hydraulic pump 15 to the boom cylinder 11, first arm spool drive solenoid valves 32a and 32b driving the first arm spool 28, second arm spool drive solenoid valves 33a and 33b driving the second arm spool 29, bucket spool drive solenoid valves 34a and 34b driving the bucket spool 30, and boom spool drive solenoid valves (first boom spool drive solenoid valves) 35a and 35b driving the boom spool 31.
The first arm spool 28 and the bucket spool 30 are connected in parallel to the first hydraulic pump 14, while the second arm spool 29 and the boom spool 31 are connected in parallel to the second hydraulic pump 15.
The flow control valve device 26 is a so-called open center type (center bypass type) flow control valve device. The spools 28, 29, 30, and 31 have center bypass sections 28a, 29a, 30a, and 31a that are flow paths for guiding the hydraulic operating fluids delivered from the hydraulic pumps 14 and 15 to the hydraulic operating fluid tanks 36a and 36b until the spools 28, 29, 30, and 31 reach predetermined spool positions from neutral positions. In the present embodiment, the first hydraulic pump 14, the center bypass section 28a of the first arm spool 28, the center bypass section 30a of the bucket spool 30, and the tank 36a are connected in series in this order, and the center bypass sections 28a and 30a configure a center bypass flow path that guides the hydraulic operating fluid delivered from the first hydraulic pump 14 to the tank 36a. In addition, the second hydraulic pump 15, the center bypass section 29a of the second arm spool 29, the center bypass section 31a of the boom spool 31, and the tank 36b are connected in series in this order, and the center bypass sections 29a and 31a configure a center bypass flow path that guides the hydraulic operating fluid delivered from the second hydraulic pump 15 to the tank 36b.
A hydraulic fluid delivered from a pilot pump (not depicted) driven by the engine 16 is guided to the solenoid valves 32, 33, 34, and 35. When control signals are output from the controller 25 to be interlocked with an operation on the operation device 24, the solenoid valves 32, 33, 34, and 35 are actuated as appropriate on the basis of control commands from the controller 25 to cause the hydraulic fluid from the pilot pump to act on drive sections of the spools 28, 29, 30, and 31, whereby the spools 28, 29, 30, and 31 are driven to actuate the hydraulic cylinders 11, 12, and 13.
For example, in a case in which the controller 25 issues a command in relation to an expansion direction of the arm cylinder 12 by, for example, operator's operating the arm operation lever 24a in an arm crowding direction, then commands are issued to the first arm spool drive solenoid valve 32a and the second arm spool drive solenoid valve 33a, and the arm 9 performs a crowding action. Conversely, in a case in which the controller 25 issues a command in relation to a contraction direction (arm dumping direction), then commands are issued to the first arm spool drive solenoid valve 32b and the second arm spool drive solenoid valve 33b, and the arm 9 performs a dumping action. Likewise, in a case in which the controller 25 issues a command in relation to an expansion direction of the bucket cylinder 13 by, for example, operating the bucket operation lever 24c in a bucket crowding direction, then a command is issued to the bucket spool drive solenoid valve 34a, and the bucket 10 performs a crowding action, and in a case in which the controller 25 issues a command in relation to a contraction direction of the bucket cylinder 13, then a command is issued to the bucket spool drive solenoid valve 34b, and the bucket 10 performs a dumping action. Furthermore, likewise, in a case in which the controller 25 issues a command in relation to an expansion direction of the boom cylinder 11 by, for example, operating the boom operation lever 24a in a boom raising direction, then a command is issued to the boom spool drive solenoid valve 35a, and the boom 8 performs a raising action, and in a case in which the controller 25 issues a command in relation to a contraction direction (boom lowering direction) of the boom cylinder 11, then a command is issued to the boom spool drive solenoid valve 35b, and the boom 8 performs a lowering action.
The control point position computing section 53 computes a position of the bucket tip end P4 that is the control point in the global coordinate system in the present embodiment and postures of the front members 8, 9, and 10 of the work device 7 in the global coordinate system. While computing may be based on a well-known method, the control point position computing section 53 calculates, for example, first the coordinate values of the origin P0 (refer to
The design surface storage section 54 stores the position data (design surface data) about the design surface 60 in the global coordinate system computed on the basis of data from the design surface setting device 51 provided within the operation room 4. As depicted in
The distance computing section 37 computes the distance D (refer to
The angle computing section 71 is a section that computes an angle α formed between an angle (ground angle) abk of a bucket bottom surface with respect to a predetermined reference surface and an angle αsf of the design surface 60 with respect to the same reference surface on the basis of data input from the work device posture sensor 50 and the design surface storage section 54. The reference surface according to the present embodiment is a horizontal surface, and the angle αbk of the bucket bottom surface and the angle αsf of the design surface 60 are set with reference to an x-axis set on the horizontal surface, as depicted in
The ground angle αbk of the bucket bottom surface can be calculated from the vehicle body longitudinal inclination angle θ4, the boom angle θ1, the arm angle θ2, the bucket angle θ3, and an angle β formed between a segment connecting the bucket pin position P3 to the claw tip coordinates P4 and a segment in a side view of the bucket bottom surface. The angle β is an angle specified from a bucket shape and can be grasped in advance. The angle αsf of the design surface 60 can be calculated from positions of two points on the design surface 60 stored in the design surface storage section 54.
The work phase determination section 72 is a section that determines whether a work phase of the work device 7 is compaction work on the basis of the angle α computed by the angle computing section 71 and any of operation signals output from the operation device 24. The work phase determination section 72 outputs a compaction work determination flag in response to the angle α. The compaction work determination flag is one of conditions for determining by the work phase determination section 72 that the work phase is compaction work. 1 is output as the compaction work flag when the angle α is equal to or greater than a predetermined value φ0, and 0 is output as the compaction work flag when the angle α is smaller than the predetermined value φ0. The predetermined value φ0 is preferably zero or a value closer to zero and may be a negative value. In other words, the predetermined value φ0 may be set in such a manner that 1 is output as the compaction work flag in a state in which the bucket bottom surface and the design surface 60 are either parallel or nearly parallel to each other. In a case of enlarging a range in which the work phase can be determined as the compaction work (range in which 1 is output as the flag), it is preferable to set φ0 to a negative value closer to zero. In the present embodiment, the predetermined value φ0 is set to zero as depicted in
The work phase determination section 72 determines that the work phase of the work device 7 is compaction work when the compaction work flag described above is 1 and yet any of the operation signals is an operation signals instructing the work device 7 to approach the design surface 60. The “any of the operation signals is an operation signals instructing the work device 7 to approach the design surface 60” means herein an operation signal for giving an instruction of any one of boom lowering, arm dumping, and arm crowding. In other words, the work phase determination section 72 determines that the work phase of the work device is compaction work when the compaction work determination flag described above is 1 and either an operation signal for giving an instruction of boom lowering is input from the boom operation lever 24a or an operation signal for operating the arm 9 is input from the arm operation lever 44a. The work phase determination section 72 determines that the work phase is a bumping action for bumping the bucket bottom surface against a ground (surface to be worked) by boom lowering from the boom lowering operation signal, and that the work phase is a leveling compaction action for moving the bucket 10 along the design surface 60 while pushing the bucket bottom surface against the ground (surface to be worked) near the design surface 60 by arm dumping or crowding from the arm dumping or arm crowding operation signal.
The limiting velocity determination section 38 is a section that computes target velocities (limiting velocities) of the hydraulic cylinders 11, 12, and 13 in response to the distance D in such a manner that the action range of the work device 7 is limited onto or above the design surface 60 when the operation device 24 is operated. In the present embodiment, the limiting velocity determination section 38 executes the following computing.
First, the limiting velocity determination section 38 calculates a demanded velocity of the boom cylinder 11 (boom cylinder demanded velocity) from the voltage value (boom operation amount) input from the operation lever 24a, calculates a demanded velocity of the arm cylinder 12 from the voltage value (arm operation amount) input from the operation lever 24b, and calculates a demanded velocity of the bucket cylinder 13 from the voltage value (bucket operation amount) input from the operation lever 24c. The limiting velocity determination section 38 calculates a velocity vector (demanded velocity vector) V0 of the work device 7 on the bucket tip end P4 from these three demanded velocities and the postures of the front members 8, 9, and 10 of the work device 7 computed by the control point position computing section 53. The limiting velocity determination section 38 then also calculates a velocity component V0z in a design surface vertical direction and a velocity component V0x in a design surface horizontal direction of the velocity vector V0.
Next, the limiting velocity determination section 38 computes correction coefficients k1 and k2 determined in response to the distance D.
As the velocity correction coefficient k, two values, that is, a value k1 during ordinary work (during work other than the compaction work) and a value k2 during the compaction work are set. The velocity correction coefficient k1 during the ordinary work is indicated by a solid line in
On the other hand, as indicated by a broken line in
Furthermore, for the compaction work (leveling compaction work) in a case in which an arm operation is input (that is, in a case in which any of the operation signals is an operation signal for giving an instruction of any one of arm dumping and arm crowding), the velocity correction coefficient k2 during the compaction work is set in such a manner as to be a positive value when the distance D falls in a predetermined range (second region specified by D3≤D≤0 in the example of
It is noted that the velocity correction coefficient k2 during the compaction work out of the first region (D<D2 or D1<D) is set to the same value as the value of the velocity correction coefficient k1 during the ordinary work.
Next, the limiting velocity determination section 38 calculates a velocity component V1z by multiplying the velocity component V0z of the velocity vector V0 in the design surface vertical direction by the correction coefficient k1 or k2 determined in response to the distance D. The limiting velocity determination section 38 calculates a resultant velocity vector (target velocity vector) V1 by combining the velocity component V1z with the velocity component V0x of the velocity vector V0 in the design surface horizontal direction, and computes a boom cylinder velocity, an arm cylinder velocity (Va1), and a bucket cylinder velocity at which the resultant velocity vector V1 can be generated as the target velocities (limiting velocities). At a time of computing these target velocities, the limiting velocity determination section 38 may use the postures of the front members 8, 9, and 10 of the work device 7 computed by the control point position computing section 53.
The flow control valve control section 40 is a section that computes control commands given to the solenoid valves 32, 33, 34, and 35 on the basis of the target velocities of the hydraulic cylinders 11, 12, and 13 computed by the limiting velocity determination section 38, and that controls the flow control valves (spools) 28, 29, 30, and 31 by outputting the control commands to the corresponding solenoid valves 32, 33, 34, and 35.
In relation to control over the arm cylinder 12, the target velocity of the arm cylinder 12 computed by the limiting velocity determination section 38 is input to the flow control valve control section 40, and the flow control valve control section 40 computes and outputs control commands to the first arm spool drive solenoid valves 32a and 32b and the second arm spool drive solenoid valves 33a and 33b (specifically, command current values specifying valve opening degrees of the first arm spool drive solenoid valves 32a and 32b and the second arm spool drive solenoid valves 33a and 33b) corresponding to the target velocity. In computing the control commands given to the first arm spool drive solenoid valves 32a and 32b and the second arm spool drive solenoid valves 33a and 33b, the flow control valve control section 40 in the present embodiment uses tables in which one-to-one correlations between the target velocity of the arm cylinder 12 and the control commands given to the first arm spool drive solenoid valves 32a and 32b and the second arm spool drive solenoid valves 33a and 33b are specified. These tables include first a table for the first arm spool drive solenoid valve 32a and a table for the second arm spool drive solenoid valve 33a as two tables used in a case of expanding the arm cylinder 12. In addition, the tables include a table for the first arm spool drive solenoid valve 32b and a table for the second arm spool drive solenoid valve 33b as two tables used in a case of contracting the arm cylinder 12. In these four tables, correlations between the target velocity and the current values for the solenoid valves 32a, 32b, 33a, and 33b are specified in such a manner that the current values for the solenoid valves 32a, 32b, 33a, and 33b monotonically increase in proportion to an increase in a magnitude of the arm cylinder target velocity on the basis of a relationship between the current values for the solenoid valves 32a, 32b, 33a, and 33b and an actual velocity of the arm cylinder 12 obtained by an experiment or a simulation in advance.
In relation to control over the boom cylinder 11, the target velocity of the boom cylinder 11 computed by the limiting velocity determination section 38 is input to the flow control valve control section 40, and the flow control valve control section 40 computes and outputs control commands to the boom spool drive solenoid valves 35a and 35b (specifically, command current values specifying valve opening degrees of the boom spool drive solenoid valves 35a and 35b) corresponding to the target velocity. In computing the control commands given to the boom spool drive solenoid valves 35a and 35b, the flow control valve control section 40 in the present embodiment uses tables in which one-to-one correlations between the target velocity of the boom cylinder 11 and the control commands given to the boom spool drive solenoid valves 35a and 35b are specified. These tables include a table for the boom spool drive solenoid valve 35a used in a case of expanding the boom cylinder 11 and a table for the boom spool drive solenoid valve 35b used in a case of contracting the boom cylinder 11. In these two tables, correlations between the target velocity and the current values for the solenoid valves 35a and 35b are specified in such a manner that the current values for the solenoid valves 35a and 35b monotonically increase in proportion to an increase in a magnitude of the boom cylinder target velocity on the basis of a relationship between the current values for the solenoid valves 35a and 35b and an actual velocity of the boom cylinder 11 obtained by an experiment or a simulation in advance.
In relation to control over the bucket cylinder 13, the target velocity of the bucket cylinder 13 computed by the limiting velocity determination section 38 is input to the flow control valve control section 40, and the flow control valve control section 40 computes and outputs control commands to the bucket spool drive solenoid valves 34a and 34b (specifically, command current values specifying valve opening degrees of the bucket spool drive solenoid valves 34a and 34b) corresponding to the target velocity. In computing the control commands given to the bucket spool drive solenoid valves 34a and 34b, the flow control valve control section 40 in the present embodiment uses tables in which one-to-one correlations between the target velocity of the bucket cylinder 13 and the control commands given to the bucket spool drive solenoid valves 34a and 34b are specified. These tables include a table for the bucket spool drive solenoid valve 34a used in a case of expanding the bucket cylinder 13 and a table for the bucket spool drive solenoid valve 34b used in a case of contracting the bucket cylinder 13. In these two tables, correlations between the target velocity and the current values for the solenoid valves 34a and 34b are specified in such a manner that the current values for the solenoid valves 34a and 34b monotonically increase in proportion to an increase in a magnitude of the bucket cylinder target velocity on the basis of a relationship between the current values for the solenoid valves 34a and 34b and an actual velocity of the bucket cylinder 13 obtained by an experiment or a simulation in advance.
In the case, for example, in which the commands about the arm cylinder target velocity and the boom cylinder target velocity are present, the flow control valve control section 40 generates the control commands given to the solenoid valves 32, 33, and 35 and drives the first arm spool 28, the second arm spool 29, and the boom spool 31.
In Procedure S2, the control point position computing section 53 computes the position data about the bucket tip end P4 (control point) in the global coordinate system on the basis of data about the inclination angles θ1, θ2, θ3, and θ4 from the work device posture sensor 50, position data, posture data (angle data), and azimuth data about the hydraulic excavator 1 computed from navigation signals output from the GNSS antennas 21 and 22, dimension data L1, L2, and L3 about the front members stored in advance, and the like. Next, the distance computing section 37 extracts and acquires position data (target surface data) about design surfaces falling in the predetermined ranges with reference to the position data about the bucket tip end P4 in the global coordinate system computed by the control point position computing section 53 (or by use of the position data about the hydraulic excavator 1), from the design surface storage section 54. In addition, the distance computing section 37 sets the design surface located at a position closest to the bucket tip end P4 as the design surface 60 of an object to be controlled, that is, the design surface 60 for which the distance D is computed from among the design surfaces.
In addition, the distance computing section 37 computes the distance D on the basis of the position data about the bucket tip end P4 and the position data about the design surface 60, and the processing goes to Procedure S3.
In Procedure S3, the angle computing section 71 computes the angle α formed between the ground angle αbk of the bucket bottom surface and the angle αsf of the design surface 60. In computing the angle α, the angle computing section 71 computes first the ground angle (bucket angle) abk of the bucket bottom surface from the data acquired from the work device posture sensor 50 and the angle β of the bucket stored in the storage device of the controller 25 in advance. Next, the angle computing section 71 computes the angle αsf (design surface angle) of the design surface 60 on the basis of the positions of the two points on the design surface 60 for which the distance D is stored and which is stored in the design surface storage section 54. In addition, the angle computing section 71 computes the angle α formed between the ground angle αbk of the bucket bottom surface and the angle αsf of the design surface 60 by subtracting the angle αsf of the design surface 60 from the ground angle αbk of the bucket bottom surface.
In Procedure S4, the work phase determination section 72 determines whether a work phase of the work device 7 is compaction work on the basis of the angle α computed in Procedure S3 and any of the operation signals acquired in Procedure S1. In determining the work phase, the work phase determination section 72 determines first whether the angle α computed in Procedure S3 is equal to or greater than the predetermined value φ0 (=0), outputs 1 as the compaction work flag in a case in which the angle α is equal to or greater than the predetermined angle φ0, and outputs 0 as the compaction work flag in a case in which the angle α is smaller than the predetermined angle φ0. In a case of outputting 1 as the compaction work flag, the work phase determination section 72 determines whether any of the operation signals acquired in Procedure S1 is an operation signal for giving an instruction of boom lowering, arm dumping, or arm crowding. In a case in which the operation signal corresponds to any one of these actions, then the work phase determination section 72 determines that the current work phase is the compaction work, and the processing goes to Procedure S6. On the other hand, in a case in which the compaction work flag is 0 or in a case in which the compaction work determination flag is 1 but any of the operation signals is an operation signal corresponding to an action other than the three types of actions described above, then the work phase determination section 72 determines that the current work phase is the ordinary work, and the processing goes to Procedure S5.
In Procedure S5, the limiting velocity determination section 38 computes the velocity correction coefficient k1 during the ordinary work corresponding to the distance D computed in Procedure S2 by using the table (solid line) of
In Procedure S6, the limiting velocity determination section 38 computes the velocity correction coefficient k2 during the compaction work corresponding to the distance D computed in Procedure S2 by using the table (broken line) of
In Procedure S7, the flow control valve control section 40 computes signals for driving the flow control valves 28 to 31 corresponding to the cylinders 11, 12, and 13 from the target velocities (limiting velocities) of the cylinders 11, 12, and 13 computed in Procedure S5 or S6, and outputs the signals to the corresponding solenoid valves 32 to 35. Specifically, the flow control valve control section 40 computes signals for driving the first flow control valve (first arm spool) 28 and the third flow control valve (second arm spool) 29 from the target velocity of the arm cylinder velocity, and outputs the signals to either the solenoid valves 32a and 33a or the solenoid valves 32b and 33b. The flow control valve control section 40 computes a signal for driving the second flow control valve (boom spool) 31 from the target velocity of the boom cylinder velocity, and outputs the signal to either the solenoid valve 35a or 35b, and the processing goes to Procedure S12. The flow control valve control section 40 computes a signal for driving the flow control valve (bucket spool) 30 from the target velocity of the bucket cylinder velocity, and outputs the signal to either the solenoid valve 34a or 34b.
When the processing in Procedure S7 is ended, then the processing returns to Start upon confirming that the operation on the operation device 24 continues, and the processing in and after Procedure S1 is repeated. It is noted that the processing is ended and waits until start of a next operation on the operation device 24 in a case in which the operation on the operation device 24 is finished even halfway along the flow of
During excavation work included in the ordinary work, the excavation work is started normally by moving the bucket 10 up to an excavation start position located in front of the excavator by an arm dumping operation, and inputting an arm crowding operation from a state of standing the bucket claw tip on the design surface 60. At this time, the angle α formed between the bucket bottom surface and the design surface 60 is a value closer to—90 degrees, and 0 is output as the compaction work determination flag. Owing to this, it is determined that the work phase is the ordinary work in Procedure S4 of
During bumping work included in the compaction work, the work is started by making the posture of the bucket 10 fixed to a state in which the angle α formed between the bucket bottom surface and the design surface 60 is close to zero (that is, a state in which the bucket bottom surface and the design surface 60 are nearly parallel to each other), and inputting a boom lowering operation. In the present embodiment, the compaction work determination flag is 1 when the angle α formed between the bucket bottom surface and the design surface 60 is equal to or greater than zero (that is, when the bucket bottom surface is parallel to the design surface 60 or when the bucket 10 has a posture in which the bucket claw tip is located above the bucket bottom surface). In a case in which the compaction work determination flag is 1 and yet a boom lowering operation is input, it is determined in Procedure S4 of
During leveling compaction work included in the compaction work, the work is started by inputting an arm crowding operation or an arm dumping operation in a state in which a bucket back surface is brought into contact with the ground after the design surface 60 is almost formed (that is, in a state in which the angle α formed between the bucket bottom surface and the design surface 60 is close to zero). In addition, the design surface 60 is compacted by moving the bucket 10 while pushing the bucket back surface against the ground by the arm operation. During the leveling compaction work, the bucket claw tip is not infrequently, already located onto the design surface 60 at a time of starting compaction from the nature of the work that is quite often conducted after formation of the design surface. In that case, normally, the bucket claw tip is moved slightly below the design surface 60 by a compaction action (arm operation). In the present embodiment, the work phase is determined to be the compaction work in Procedure S4 of
As described so far, according to the present embodiment, the work phase is determined to be the compaction work when the angle α formed between the bucket bottom surface and the design surface 60 is equal to or greater than the predetermined value φ0 and the arm operation signal or the boom lowering operation signal is output; thus, it is possible to accurately determine the compaction work. Furthermore, during the compaction work (bumping) by the boom lowering operation, setting the velocity correction coefficient of the work device 7 to be greater than that during the ordinary work when the distance D falls in the first region (D2≤D≤D1) makes it possible to favorably conduct the compaction work by the bumping. Moreover, during the compaction work (leveling compaction work) by the arm operation, setting the velocity correction coefficient k to the positive value when the distance D falls in the second region (D3≤D≤0) makes it possible to generate the velocities in the design surface vertical direction and favorably conduct the leveling compaction work.
Embodiment 2 of the present invention will be described. Since hardware configurations are the same as those in Embodiment 1, description of the hardware configurations will be omitted and different respects will be described herein.
Furthermore, as depicted in
In Procedure S11, the detection signal of the boom rod pressure sensor 61 is input to the limiting velocity determination section 38 and the limiting velocity determination section 38 acquires the rod pressure of the boom cylinder 11.
In Procedure S14, the limiting velocity determination section 38 determines whether the boom rod pressure acquired in Procedure S11 is lower than a predetermined value P1, goes to Procedure S6 in a case in which the boom rod pressure is lower than P1, and goes to Procedure S16 in a case in which the boom rod pressure is equal to or higher than P1.
In Procedure S16, the limiting velocity determination section 38 computes the velocity correction coefficient k3 during the compaction work at the high boom rod pressure corresponding to the distance D computed in Procedure S2 by using a table (dot-and-dash line) of
During the leveling compaction work for pushing the bucket bottom surface against a current configuration of the ground and compacting the ground by the arm operation, a force for supporting compaction by the arm 9 acts on a hydraulic chamber on a rod side of the boom cylinder 11, thus the boom rod pressure rises. Owing to this, in a case of an excessive compaction force by the arm 9, the travel structure 2 of the excavator possibly floats from the ground. To address the problem, in the present embodiment, the velocity correction coefficient k3 during the compaction work in the case in which the boom rod pressure is equal to or higher than P1 is set to be smaller than that in the case in which the boom rod pressure is lower than P1. Changing the velocity correction coefficient in this way makes it possible to prevent the travel structure 2 from floating from the ground due to the excessive compaction force during the leveling compaction work.
It is noted that the problem of floating of the travel structure 2 occurs during the leveling compaction work by the arm operation. Owing to this, a configuration of setting to be smaller the velocity correction coefficient k3 in the case in which the boom rod pressure is equal to or higher than P1 may be limited to the second region (that is, when D3≤D≤0), and of using the same velocity correction coefficient k2 as that in Embodiment 1 in the other regions may be adopted.
Furthermore, while it has been described above that the velocity correction coefficient k3 during the compaction work is set to be smaller only in the case of the boom cylinder velocity equal to or higher than P1, the velocity correction coefficient k3 during the compaction work may be set to be gradually smaller in proportion to an increase in the boom rod pressure, that is, magnitudes of the limiting velocities of the cylinders may be set to be reduced in proportion to the increase in the boom rod pressure. In yet other words, a configuration of changing the magnitudes of the limiting velocities of the cylinders on the basis of the boom rod pressure during the compaction work may be adopted.
Moreover, while the velocity correction coefficient k3 during the compaction work at the high pressure is set to be smaller than k2 only in the range (D3≤D≤D1) where the velocity correction coefficient k2 during the compaction work is positive in the example of
Embodiment 3 of the present invention will be described. The present embodiment is characterized by determining whether a work phase is compaction work on the basis of the posture of the bucket 10 with respect to the design surface 60 in a case in which the operation device 24 instructs the work device 7 to approach the design surface 60. Specifically, in the present embodiment, a bucket rear end P5 (refer to
The control point position computing section 53A computes positions of the bucket tip end P4 and the bucket rear end P5 (refer to
The distance computing section 37A computes the distances Dp4 and Dp5 (refer to
The work phase determination section 72A determines whether the work phase of the work device 7 is compaction work on the basis of the distances Dp4 and Dp5 computed by the distance computing section 37A and the operation signals output from the operation device 24. The work phase determination section 72A outputs the compaction work determination flag to the limiting velocity determination section 38A in response to the distances Dp4 and Dp5. The compaction work determination flag is one of conditions for determining by the work phase determination section 72 that the work phase is compaction work. 1 is output as the compaction work flag when the distance Dp4 is equal to or greater than the distance Dp5 (that is, the bucket rear end P5 is closer to the design surface 60 than the bucket tip end P4), and 0 is output as the compaction work flag when the distance Dp4 is smaller than the distance Dp5 (that is, the bucket tip end P4 is closer to the design surface 60 than the bucket rear end P5).
The work phase determination section 72A determines that the work phase of the work device 7 is compaction work when the compaction work flag described above is 1 and yet any of the operation signals is an operation signal instructing the work device 7 to approach the design surface 60.
The limiting velocity determination section 38A is a section that computes the target velocities (limiting velocities) of the hydraulic cylinders 11, 12, and 13 on the basis of the smaller distance out of the two distances Dp4 and Dp5 in such a manner that the action range of the work device 7 is limited onto or above the design surface 60 when the operation device 24 is operated. In other words, the limiting velocity determination section 38A calculates the target velocities with reference to the control point closer to the design surface 60 out of the two control points P4 and P5. In yet other words, the limiting velocity determination section 38A uses the distance Dp5 in a case in which 1 is input from the work phase determination section 72A as the compaction work flag, and uses the distance Dp4 in a case in which 0 is input as the compaction work flag.
First, the limiting velocity determination section 38 calculates the demanded velocity of the boom cylinder 11 (boom cylinder demanded velocity) from the voltage value (boom operation amount) input from the operation lever 24a, calculates the demanded velocity of the arm cylinder 12 from the voltage value (arm operation amount) input from the operation lever 24b, and calculates the demanded velocity of the bucket cylinder 13 from the voltage value (arm operation amount) input from the operation lever 24c. The limiting velocity determination section 38A calculates the velocity vector (demanded velocity vector) V0 of the work device 7 at the control point P4 or P5 from these three demanded velocities and the postures of the front members 8, 9, and 10 of the work device 7 computed by the control point position computing section 53. The limiting velocity determination section 38A then also calculates the velocity component V0z in the design surface vertical direction and the velocity component V0x in the design surface horizontal direction of the velocity vector V0.
Next, the limiting velocity determination section 38 computes the correction coefficients k1 and k2 determined in response to the smaller distance out of the two distances Dp4 and Dp5. A computing process is the same as that in Embodiment 1 except that the distance used to compute the correction coefficients k1 and k2 is the smaller distance out of the two distances Dp4 and Dp5.
Next, the limiting velocity determination section 38 calculates the velocity component V1z by multiplying the velocity component V0z of the velocity vector V0 in the design surface vertical direction by the correction coefficient k1 or k2 determined in response to the smaller distance out of the two distances Dp4 and Dp5. The limiting velocity determination section 38A calculates the resultant velocity vector (target velocity vector) V1 by combining the velocity component V1z with the velocity component V0x of the velocity vector V0 in the design surface horizontal direction, and computes the boom cylinder velocity, the arm cylinder velocity (Va1), and the bucket cylinder velocity at which the resultant velocity vector V1 can be generated as the target velocities (limiting velocities). At the time of computing these target velocities, the limiting velocity determination section 38A may use the postures of the front members 8, 9, and 10 of the work device 7 computed by the control point position computing section 53A.
In Procedure S2, the control point position computing section 53A computes first the position data about the bucket tip end P4 (first control point) in the global coordinate system on the basis of the information about the inclination angles θ1, θ2, θ3, and θ4 from the work device posture sensor 50, the position data, the posture data (angle data), and the azimuth data about the hydraulic excavator 1 computed from the navigation signals output from the GNSS antennas 21 and 22, the dimension data L1, L2, and L3 about the front members stored in advance, and the like. Next, the distance computing section 37A extracts and acquires the position data (target surface data) about design surfaces falling in the predetermined ranges with reference to the position data about the bucket tip end P4 in the global coordinate system computed by the control point position computing section 53A, from the design surface storage section 54. In addition, the distance computing section 37A sets the design surface located at the position closest to the bucket tip end P4 as the design surface 60 of an object to be controlled, that is, the design surface 60 for which the distance Dp4 is computed from among the design surfaces. The distance computing section 37A then computes the distance Dp4 on the basis of the position data about the bucket tip end P4 and the position data about the design surface 60, and the processing goes to Procedure S21.
In Procedure S21, the control point position computing section 53A computes position data about the bucket rear end P5 (second control point) in the global coordinate system on the basis of the data about the inclination angles θ1, θ2, θ3, and θ4, the position data, the posture data (angle data), and the azimuth data about the hydraulic excavator 1, the dimension data L1, L2, and L3 about the front members, and the like, similarly to Procedure S2. Next, the distance computing section 37A extracts and acquires the position data (target surface data) about design surfaces falling in the predetermined ranges with reference to the position data about the bucket rear end P5 computed by the control point position computing section 53A, from the design surface storage section 54. In addition, the distance computing section 37A sets the design surface located at the position closest to the bucket rear end P5 as the design surface 60 of the object to be controlled. The distance computing section 37A then computes the distance Dp5 on the basis of the position data about the bucket rear end P5 and the position data about the design surface 60, and the processing goes to Procedure S22.
In Procedure S22, the work phase determination section 72 determines whether a work phase of the work device 7 is compaction work on the basis of the distance Dp4 computed in Procedure S2, the distance Dp5 computed in Procedure S21, and any of the operation signals acquired in Procedure S1. In determining the work phase, the work phase determination section 72A determines first whether the distance Dp4 is equal to or greater than the distance Dp5, outputs 1 as the compaction work flag in the case in which the distance Dp4 is equal to or greater than the distance Dp5, and outputs 0 as the compaction work flag in the case in which the distance Dp4 is smaller than the distance Dp5. In the case of outputting 1 as the compaction work flag, the work phase determination section 72A determines whether any of the operation signals acquired in Procedure S1 is an operation signal for giving an instruction of boom lowering, arm dumping, or arm crowding. In a case in which the operation signal corresponds to any one of these actions, then the work phase determination section 72A determines that the current work phase is the compaction work, and the processing goes to Procedure S24. On the other hand, in the case in which the compaction work flag is 0 or in the case in which the compaction work determination flag is 1 but any of the operation signals is an operation signal corresponding to an action other than the three types of actions described above, then the work phase determination section 72A determines that the current work phase is the ordinary work, and the processing goes to Procedure S23.
In Procedure S23, the limiting velocity determination section 38A computes the velocity correction coefficient k1 during the ordinary work corresponding to the distance Dp4 computed in Procedure S2 by using the table (solid line) of
In Procedure S24, the limiting velocity determination section 38A computes the velocity correction coefficient k2 during the compaction work corresponding to the distance Dp5 computed in Procedure S21 by using the table (broken line) of
According to the present embodiment configured as described so far, the work phase is determined to be the compaction work when the distance Dp4 is equal to or greater than the distance Dp5 and the arm operation signal or the boom lowering operation signal is output; thus, it is possible to accurately determine the compaction work, similarly to Embodiment 1. Furthermore, during the compaction work (bumping) by the boom lowering operation, setting the velocity correction coefficient of the work device 7 to be greater than that during the ordinary work when the distance Dp5 falls in the first region (D2≤D≤D1) makes it possible to favorably conduct the compaction work by the bumping. Moreover, during the compaction work (leveling compaction work) by the arm operation, setting the velocity correction coefficient k to the positive value when the distance Dp5 falls in the second region (D3≤D≤0) makes it possible to generate the velocities in the design surface vertical direction and favorably conduct the leveling compaction work.
A modification of Embodiment 1 will now be described. As depicted in
In Procedure S31, the controller 25 determines whether the ON/OFF switch 80 is ON on the basis of an ON/OFF signal input from the ON/OFF switch 80. In a case herein in which the ON/OFF switch 80 is ON, the processing goes to Procedure S3 and the processing in and after Procedure S3 is executed, similarly to the case of
In a case of configuring the hydraulic excavator 1 in this way, it is possible to change whether to execute the limiting velocity change processing in response to an operator's desire. It is thereby possible to flexibly handle various work needs. While a case of mounting the ON/OFF switch 80 in Embodiment 1 has been described herein, it goes without saying that the limiting velocity change processing can be made ON/OFF in response to the operator's desire by mounting the ON/OFF switch 80 in the other embodiments.
The present invention is not limited to the above embodiments but encompasses various modifications without departing from the spirit of the invention. For example, the present invention is not limited to the work machine configured with all the configurations described in the above embodiment but encompasses the work machine from which part of the configurations are deleted. Furthermore, a part of the configurations according to a certain embodiment can be added to or can be replaced with configurations according to the other embodiment.
While the velocity correction coefficient k2 is set to have a shape of connecting two straight lines having different inclinations before and after D=0 in the examples of
In Embodiment 1, for configuring the work machine capable of both the bumping work and the leveling compaction work, the second region is designed to be contained in the first region by setting a lower end (D2) of the first region where the velocity correction coefficient k changes in response to the work phase to be smaller than a lower end (D3) of the second region where the velocity correction coefficient k2 is set to be positive in the range in which the velocity correction coefficient k1 is set to be negative in relation to setting of the velocity correction coefficients k1, k2, and k3. Alternatively, the first region and the second region can be provided individually. For example, the lower end of the first region can be made coincident with an upper end (O) of the second region so that there is no containment relationship between the first and second regions. Furthermore, in a case of configuring the work machine specialized in either the bumping work or the leveling compaction work, any one of the first region and the second region can be provided.
A part of or all of the configurations related to the controller 25 and functions, executed processing, and the like of the configurations described above may be realized by hardware (by designing logic for executing the functions, for example, by an integrated circuit, or the like). Furthermore, the configurations related to the controller 25 described above may be implemented as a program (software) for realizing the functions related to the configurations of the controller 25 by causing an arithmetic processor (for example, a CPU) to read and execute the program. Data related to the program can be stored in, for example, a semiconductor memory (such as a flash memory or an SSD), a magnetic storage device (such as a hard disk drive), or a recording medium (such as a magnetic disk or an optical disk).
Number | Date | Country | Kind |
---|---|---|---|
2018-162052 | Aug 2018 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2019/022624 | 6/6/2019 | WO | 00 |