Shovel control method and shovel control device
11248361 · 2022-02-15
Assignee
Inventors
Cpc classification
E02F3/437
FIXED CONSTRUCTIONS
E02F3/436
FIXED CONSTRUCTIONS
E02F9/2012
FIXED CONSTRUCTIONS
International classification
Abstract
A shovel control method includes performing a plane position control or a height control of an end attachment by an operation of one lever. The plane position control is performed while maintaining a height of the end attachment. The height control is performed while maintaining a plane position of the end attachment.
Claims
1. A shovel comprising: a running body; a turning body turnably held on the running, body; an attachment mounted on the turning body, the attachment including a boom, an arm connected to the boom, and a bucket connected to the arm; a boom angle sensor provided on the boom; an arm angle sensor provided on the arm; a boom cylinder configured to drive the boom; a boom control valve connected to the boom cylinder via a high-pressure hydraulic line; a boom electromagnetic proportional valve configured to output a pilot pressure corresponding to a boom control current to the boom control valve; an arm cylinder configured to drive the arm; an arm control valve connected to the arm cylinder via a high-pressure hydraulic line; an arm electromagnetic proportional valve configured to output a pilot pressure corresponding to an arm control current to the arm control valve; a lever having a stick shape and configured to be tilted in a plurality of directions with a grip portion of the lever protruding upward, the plurality of directions including a forward direction, a rearward direction, a leftward direction, and a rightward direction; and a controller configured to create a command value specific to an end of the bucket based on an amount of operation of the lever in a first direction, create a boom command value for the boom and an arm command value for the arm based on the created command value, and move the bucket along a predetermined straight line by creating a boom cylinder pilot pressure command through first feedback control on the boom and outputting the boom control current according to the boom cylinder pilot pressure command to the boom electromagnetic proportional valve and by creating an arm cylinder pilot pressure command through second feedback control on the arm and outputting the arm control current according to the arm cylinder pilot pressure command to the arm electromagnetic proportional valve in response to tilting of the lever in the first direction, wand to move the bucket along a direction to cross the predetermined straight line in response to tilting of the lever in a second direction different from the first direction, the first feedback control being based on an output value of the boom angle sensor and the boom command value, the second feedback control being based on an output value of the arm angle sensor and the arm command value, the first direction being one of the forward direction and the rearward direction or one of the leftward direction and the rightward direction, the second direction being one of the rightward direction and the leftward direction when the first direction is the one of the forward direction and the rearward direction and being one of the forward direction and the rearward direction when the first direction is the one of the rightward direction and the leftward direction.
2. The shovel as claimed in claim 1, wherein the lever includes a first lever and a second lever, and the controller is configured to move the bucket along the predetermined straight line in response to tilting of the first lever in the first direction, and to move the bucket along a straight line that crosses the predetermined straight line in response to tilting of the second lever in the second direction.
3. The shovel as claimed in claim 1, wherein the lever includes a plurality of levers, and one of the plurality of levers is configured to be tilted in the first direction and a third direction among the plurality of directions, the third direction being different from the first direction.
4. The shovel as claimed in claim 1, wherein the lever includes a plurality of levers, and one of the plurality of levers is configured to be tilted in the second direction and a fourth direction among the plurality of directions, the fourth direction being different from the second direction.
5. The shovel as claimed in claim 1, wherein the lever includes a plurality of levers, and the controller is configured to simultaneously perform at least two operations among an operation of moving the bucket along the predetermined straight line, an operation of moving the bucket along a straight line that crosses the predetermined straight line, an operation of turning the turning body, and an operation of opening or closing the bucket, in response to simultaneous tilting of two of the plurality of levers.
6. The shovel as claimed in claim 1, further comprising: a switch configured to switch a first operational state and a second operational state different from the first operational state, wherein the controller is configured to move the bucket along the predetermined straight line in the first operational state, and wherein the controller is configured to cause only the boom to operate in response to the tilting of the lever in the first direction and to cause only the arm to operate in response to the tilting of the lever in the second direction in the second operational state.
7. The shovel as claimed in claim 1, wherein the boom control valve is configured to supply operating oil discharged from a hydraulic pump to the boom cylinder with a direction of flow and an amount of flow corresponding to the pilot pressure output by the boom electromagnetic proportional valve, and the arm control valve is configured to supply operating oil discharged from the hydraulic pump to the arm cylinder with a direction of flow and an amount of flow corresponding to the pilot pressure output by the arm electromagnetic proportional valve.
8. The shovel as claimed in claim 1, wherein each of the boom command value and the arm command value changes in accordance with the amount of operation of the lever.
9. The shovel as claimed in claim 1, wherein the controller is configured to calculate a pump discharge amount for each of the boom and the arm based on the boom command value and the arm command value.
10. The shovel as claimed in claim 9, wherein the controller is configured to calculate a pump flow amount based on the pump discharge amount for the boom and the pump discharge amount for the arm.
11. The shovel as claimed in claim 1, wherein the controller is configured to move the bucket along the predetermined straight line included in a slope in response to the tilting of the lever in the first direction, in a case of working on the slope, the slope forming a predetermined angle to an installation surface of the shovel.
12. A shovel comprising: a running body; a turning body turnably held on the running body; an attachment mounted on the turning body, the attachment including a boom, an arm connected to the boom, and a bucket connected to the arm; a boom angle sensor provided on the boom; an arm angle sensor provided on the arm; a boom cylinder configured to drive the boom; a boom control valve connected to the boom cylinder via a high-pressure hydraulic line; a boom electromagnetic proportional valve configured to output a pilot pressure corresponding to a boom control current to the boom control valve; an arm cylinder configured to drive the arm; an arm control valve connected to the arm cylinder via a high-pressure hydraulic line; an arm electromagnetic proportional valve configured to output a pilot pressure corresponding to an arm control current to the arm control valve; and a controller configured to create a command value specific to an end of the bucket based on an amount of operation of a lever having a stick shape in a first direction, create a boom command value for the boom and an arm command value for the arm based on the created command value, and move the bucket along a predetermined straight line by creating a boom cylinder pilot pressure command through first feedback control on the boom and outputting the boom control current according to the boom cylinder pilot pressure command to the boom electromagnetic proportional valve and by creating an arm cylinder pilot pressure command through second feedback control on the arm and outputting the arm control current according to the arm cylinder pilot pressure command to the arm electromagnetic proportional valve in response to tilting of the lever in the first direction, and to move the bucket along a direction to cross the predetermined straight line in response to tilting of the lever in a second direction different from the first direction, the first feedback control being based on an output value of the boom angle sensor and the boom command value, the second feedback control being based on an output value of the arm angle sensor and the arm command value, the lever being configured to be tilted in a plurality of directions with a grip portion of the lever protruding upward, the plurality of directions including a forward direction, a rearward direction, a leftward direction, and a rightward direction, the first direction being one of the forward direction and the rearward direction or one of the leftward direction and the rightward direction, the second direction being one of the rightward direction and the leftward direction when the first direction is the one of the forward direction and the rearward direction and being one of the forward direction and the rearward direction when the first direction is, the one of the rightward direction and the leftward, direction.
13. The shovel as claimed in claim 12, wherein the boom control valve is configured to supply operating oil discharged from a hydraulic pump to the boom cylinder with a direction of, flow and an amount of flow corresponding to the pilot pressure output by the boom electromagnetic proportional valve, and the arm control valve is configured to supply operating oil discharged from the hydraulic pump to the arm cylinder with a direction of flow and an amount of flow corresponding to the pilot pressure output by the arm electromagnetic proportional valve.
14. A shovel comprising: a running body; a turning body turnably held on the running body; an attachment mounted on the turning body, the attachment including a boom, an arm connected to the boom, and a bucket connected to the arm; a boom angle sensor provided on the boom; an arm angle sensor provided on the arm; a boom cylinder configured to drive the boom; a boom control valve connected to the boom cylinder via a high-pressure hydraulic line; a boom electromagnetic proportional valve configured to output a pilot pressure corresponding to a boom control current to the boom control valve; an arm cylinder configured to drive the arm; an arm control valve connected to the arm cylinder via a high-pressure hydraulic line; an arm electromagnetic proportional valve configured to output a pilot pressure corresponding to an arm control current to the arm control valve; and a controller configured to create a command value specific to an end of the bucket based on an amount of operation of a first lever in one direction among a plurality of directions, create a boom command value for the boom and an arm command value for the arm based on the created command value, and move the bucket along a predetermined straight line by creating a boom cylinder pilot pressure command through first feedback control on the boom and outputting the boom control current according to the boom cylinder pilot pressure command to the boom electromagnetic proportional valve and by creating an arm cylinder pilot pressure command through second feedback control on the arm and outputting the arm control current according to the arm cylinder pilot pressure command to the arm electromagnetic proportional valve in response to tilting of the first lever in said one direction, the plurality of directions including a forward direction, a rearward direction, a leftward direction, and a rightward direction, and to move the bucket in a direction to cross the predetermined straight line in response to tilting of a second lever different from the first lever, the first feedback control being based on an output value of the boom angle sensor and the boom command value, the second feedback control being based on an output value of the arm angle sensor and the arm command value, the first lever and the second lever having a stick shape and being configured to tilt in the plurality of directions with respective grip portions thereof protruding upward.
15. The shovel as claimed in claim 14, wherein the controller is configured to move the bucket along a straight line that crosses the predetermined straight line in response to the tilting of the second lever.
16. The shovel as claimed in claim 14, wherein the controller is configured to simultaneously perform at least two operations among an operation of moving the bucket along the predetermined straight line, an operation of moving the bucket along a straight line that crosses the predetermined straight line, an operation of turning the turning body, and an operation of opening or closing the bucket in response to simultaneous tilting of the first lever and the second lever.
17. The shovel as claimed in claim 14, further comprising: a switch configured to switch a first operational state and a second operational state different from the first operational state, wherein the controller is configured to move the bucket along the predetermined straight line in the first operational state, and wherein the controller is configured to move only the arm in response to the tilting of the first lever in said one direction and move only the boom in response to tilting of the second lever in said one direction in the second operational state.
18. The shovel as claimed in claim 14, wherein the boom control valve is configured to supply operating oil discharged from a hydraulic pump to the boom cylinder with a direction of flow and an amount of flow corresponding to the pilot pressure output by the boom electromagnetic proportional valve, and the arm control valve is configured to supply operating oil discharged from the hydraulic pump to the arm cylinder with a direction of flow and an amount of flow corresponding to the pilot pressure output by the arm electromagnetic proportional valve.
19. The shovel as claimed in claim 14, wherein each of the boom command value and the arm command value changes in accordance with the amount of operation of the first lever.
20. The shovel as claimed in claim 14, wherein the controller is configured to switch a setting of the first lever or the second lever between an automatic leveling mode and a normal mode.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1)
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
(10)
(11)
(12)
(13)
(14)
(15)
(16)
(17)
DETAILED DESCRIPTION
(18) According to a hydraulic shovel equipped with the above-mentioned excavation locus control device, an operator uses individual operation levers corresponding to respective operations when operating an arm and a boom. Thus, the operator must operate simultaneously two operation levers when moving a bucket in the straight drawing operation or the leveling and grading operation. Thus, the straight drawing operation and the leveling and grading operation are still difficult operations for an operator who is inexperienced in operating a hydraulic shovel, and, a support to such an operator is not sufficient. Thus, it is preferable to provide a shovel control method and a shovel control device that enables an easier operation of a front attachment including, for example, a boom, arm and bucket.
(19) A description will now be given, with reference to the drawings, of embodiments according to the present invention.
(20)
(21) A lower running body 1 of the hydraulic shovel is mounted with an upper turning body 3 via a turning mechanism 2. A boom 4 as an operating body is attached to the upper turning body 3. An arm 5 as an operating body is attached to an end of the boom 4, and a bucket 6 as an operating body, which is an end attachment, is attached to an end of the arm 5. The boom 4, arm 5 and bucket 6 constitute a front attachment, and are hydraulically driven by a boom cylinder 7, arm cylinder 8 and bucket cylinder 9, respectively. The upper turning body 3 is provided with a cabin 10, and also mounted with a power source such as an engine or the like.
(22)
(23) A main pump 14 and a pilot pump 15 as hydraulic pumps are connected to an output axis of an engine 11 as a mechanical drive part. The main pump 14 is connected with a control valve 17 via a high-pressure hydraulic line 16. The main pump 14 is a variable capacity hydraulic pump of which a discharged amount of flow per one pump revolution is controlled by a regulator 14A.
(24) The control valve 17 is a hydraulic control device for performing a control of a hydraulic system in the hydraulic shovel. Hydraulic motors 1A (right) and 1B (left) for the lower running body 1, a turning hydraulic motor 21B, the boom cylinder 7, arm cylinder 8 and bucket cylinder 9 are connected to the control valve 17 via high-pressure hydraulic lines. The pilot pump 15 is connected with an operation device 26 via a pilot line 25.
(25) The operation device 26 includes a lever 26A, lever 26B and pedal 26C. The lever 26A, lever 26B and pedal 26C are connected to the control valve 17 and a pressure sensor 29 via hydraulic lines 27 and 28, respectively. The pressure sensor 29 is connected to a controller 30, which performs a drive control of an electric system.
(26) In the present embodiment, an attitude or posture sensor for detecting an attitude or posture of each operating body is attached to each operating body. Specifically, a boom angle sensor 4S for detecting an inclination angle of the boom 4 is attached to a support axis of the boom 4. An arm angle sensor 5S for detecting an open/close angle of the arm 5 is attached to a support axis of the arm 5. A bucket angle sensor 6S for detecting an open/close angle of the bucket 6 is attached to a support axis of the bucket 6. The boom angle sensor 4S supplies a detected boom angle to the controller 30. The arm angle sensor 5S supplies a detected arm angle to the controller 30. The bucket angle sensor 6S supplies a detected bucket angle to the controller 30.
(27) The controller 30 is a shovel control device as a main control part for performing a drive control of the hydraulic shovel. The controller 30 is configured by an operation processing device including a CPU (Central Processing Unit) and an internal memory, and is a device materialized by the CPU executing a drive control program stored in the internal memory.
(28) Next, a description is given, with reference to
(29) As illustrated in
(30) Moreover, the X-axis orthogonal to the Z-axis extends in an extending direction of the front attachment, and the Y-axis orthogonal to the Z-axis extends in a direction perpendicular to an extending direction of the front attachment. That is, the X-axis and the Y-axis rotate about the Z-axis with turning of the hydraulic shove. It should be noted that, in a turning angle θ of the hydraulic shovel, a counterclockwise direction with respect to the X-axis is set to a plus direction in the top view as illustrated in
(31) Moreover, as illustrated in
(32) Moreover, a length of a line segment SG1 connecting the boom pin position P1 and the arm pin position, P2 is represented by a predetermined value L.sub.1 as a boom length. A length of a line segment SG2 connecting the arm pin position P2 and the bucket pin position P3 is represented by a predetermined value L.sub.2 as an arm length. A length of a line segment SG3 connecting the bucket pin position P3 and the bucket end position P4 is represented by a predetermined value L.sub.3 as a bucket length.
(33) An angle formed between the line segment SG1 and a horizontal plane is represented by a ground angle β.sub.1. An angle formed between the line segment SG2 and a horizontal plane is represented by a ground angle β.sub.2. An angle formed between the line segment SG3 and a horizontal plane is represented by a ground angle β.sub.3. Hereinafter, the ground angles β.sub.1, β.sub.2 and β.sub.3 may be referred to as the boom rotation angle, arm rotation angle, and bucket rotation angle, respectively.
(34) Here, on the assumption that a three-dimensional coordinate of the boom pin position P1 is represented by (X, Y, Z)=(H.sub.0X, 0, H.sub.0Z) and a three-dimensional coordinate of the bucket end position P4 is represented by (X, Y, Z)=(Xe, Ye, Ze), Xe and Ze are represented by formulas (1) and (2), respectively.
Xe=H.sub.0X+L.sub.1 cos β.sub.1+L.sub.2 cos β.sub.2+L.sub.3 cos β.sub.3 (1)
Ze=H.sub.0Z+L.sub.1 sin β.sub.1+L.sub.2 sin β.sub.2+L.sub.3 sin β.sub.3 (2)
(35) It should be noted that Ye is zero because the bucket end position P4 lies on the XZ-plane.
(36) Moreover, because the coordinate value of the boom pin position P1 is a fixed value, if the ground angles β.sub.1, β.sub.2 and β.sub.3 are determined, the coordinate value of the bucket end position P4 is uniquely determined. Similarly, if the ground angles β.sub.1, is determined, the coordinate value of the arm pin position P2 is uniquely determined, and if the ground angles β.sub.1 and β.sub.2 are determined, the coordinate value of the bucket pin position P3 is uniquely determined.
(37) Next, a description is given, with reference to
(38) As illustrated in
(39) Moreover, the boom angle sensor 4S detects and outputs an angle α.sub.1 formed between the line segment SG1 and a vertical line. The arm angle sensor 5S detects and outputs an angle α.sub.2 formed between an extension line of the line segment SG1 and the line segment SG2. The bucket angle sensor 6S detects and outputs an angle α.sub.3 formed between an extension line of the line segment SG2 and the line segment SG3. It should be noted that, in
(40) According to the above-mentioned relationship, the boom rotation angle β.sub.1, arm rotation angle β.sub.2 and bucket rotation angle β.sub.3 are represented by formulas (3), (4) and (5) using the angles α.sub.1, α.sub.2 and α.sub.3, respectively.
β.sub.1=90−α.sub.1 (3)
β.sub.2=β.sub.1−α.sub.2=90−α.sub.1−α.sub.2 (4)
β.sub.3=β.sub.2−α.sub.3=90−α.sub.1−α.sub.2−α.sub.3 (5)
(41) As mentioned above, β.sub.1, β.sub.2 and β.sub.3 are represented as inclinations of the boom 4, arm 5 and bucket 6, respectively, with respect to a horizontal plane.
(42) Accordingly, using the formulas (1) through (5), if the angles α.sub.1, α.sub.2 and α.sub.3 are determined, the boom rotation angle β.sub.1, arm rotation angle β.sub.2 and bucket rotation angle β.sub.3 are uniquely determined and the coordinate value of the bucket end position P4 is uniquely determined. Similarly, if the angle α.sub.1 is determined, the boom rotation angle β.sub.1 and the coordinate value of the arm pin position P2 are uniquely determined, and if the angles α.sub.1 and α.sub.2 are determined, the boom rotation angle β and the coordinate value of the bucket pin position P3 are uniquely determined.
(43) It should be noted that the boom angle sensor 4S, arm angle sensor 5S and bucket angle sensor 6S may directly detect the boom rotation angle β.sub.1, arm rotation angle β.sub.2 and bucket rotation angle β.sub.3, respectively. In this case, operations according to the formulas (3) through (5) may be omitted.
(44) Next, a description is given, with reference to
(45) Specifically, in the normal mode of
(46) On the other hand, in the automatic leveling mode of
(47) Moreover, in the automatic leveling mode of
(48) Moreover, in the automatic leveling mode of
(49)
(50) First, the controller 30 judges whether the automatic leveling mode is selected in a mode change switch installed near the driver's seat in the cabin 10 (step S1).
(51) If the controller 30 determines that the automatic leveling mode is selected (YES in step S1), the controller 30 detects a lever operation amount (step S2).
(52) Specifically, the controller 30 detects amounts of operations of the levers 26A and 26B based on, for example, outputs of the pressure sensor 29.
(53) Thereafter, the controller 30 judges whether an X-direction operation is performed (step S3). Specifically, the controller 30 judges whether an operation of the lever 26B in a forward or rearward direction is performed.
(54) If the controller 30 judges that the X-direction operation is performed (YES in step S3), the controller 30 performs an X-direction movement control (plane position control) (step S4).
(55) If the controller 30 judges that the X-direction operation is not performed (NO in step S3), the controller 30 judges whether a Z-direction operation is performed (step S5). Specifically, the controller 30 judges whether an operation of the lever 26A in a forward or rearward direction is performed.
(56) If the controller 30 judges that the Z-direction operation is performed (YES in step S5), the controller 30 performs a Z-direction movement control (height control) (step S6).
(57) If the controller judges that the Z-direction operation is not performed (NO in step S5), the controller 30 judges whether a θ-direction operation is performed (step S7). Specifically, the controller 30 judges whether a leftward or rightward operation of the lever 26A is performed.
(58) If the controller 30 judges that a θ-direction operation is performed (YES in step S7), the controller 30 performs a turning operation (step S8).
(59) If the controller 30 judges that a θ-direction operation is not performed (NO in step S7), the controller judges whether β.sub.3-direction operation is performed (step S9). Specifically, the controller 30 judges whether a leftward or rightward operation of the lever 26B is performed.
(60) If the controller 30 judges that β.sub.3-direction operation is performed (YES in step S9), the controller 30 performs a bucket opening or closing operation (step S10).
(61) It should be noted that although the control flow illustrated in
(62) Next, a description is given, with reference to
(63) When an X-direction operation is performed by the lever 26B, as illustrated in
(64) Thereafter, the controller 30 creates command values β.sub.1r, β.sub.2r and β.sub.3r for the boom rotation angle β.sub.1, arm rotation angle β.sub.2 and bucket rotation angle β.sub.3, respectively, based on the created command value Xer.
(65) Specifically, the controller 30 creates the command values β.sub.1r, β.sub.2r and β.sub.3r using the above-mentioned formulas (1) and (2). As indicated by the formulas (1) and (2), the values Xe and Ze of the X coordinate and Z coordinate of the bucket end position P4 are functions of the boom rotation angle β.sub.1, arm rotation angle β.sub.2 and bucket rotation angle β.sub.3. Moreover, a present value is used in the value Zer of the Z coordinate of the bucket end position P4 after movement. Accordingly, if the command value β.sub.3r of the bucket rotation angle β.sub.3 is maintained at a present value, the created command value Xer is substituted for Xe in the formula (1), and a present value is substituted for β.sub.3 in the formula (1). Additionally, a present value is substituted for Ze in the formula (2), and a present value is also substituted for β.sub.3 in the formula (2). As a result, the values of the boom rotation angle β.sub.1 and arm rotation angle β.sub.2 are derived by solving the simultaneous equations of the formulas (1) and (2) containing the two unknown quantities β.sub.1 and β.sub.2. The controller 30 sets the derived values to the command values β.sub.1r and β.sub.2r.
(66) Thereafter, as illustrated in
(67) Specifically, the controller 30 creates a boom cylinder pilot pressure command corresponding to a difference Δβ.sub.1 between a present value and the command value β.sub.1r of the boom rotation angle β.sub.1. Then, a control current corresponding to the boom cylinder pilot pressure command is output to a boom electromagnetic proportional valve. In the automatic leveling mode, the boom electromagnetic proportional valve outputs a pilot pressure corresponding to the control current according to the boom cylinder pilot pressure command to a boom control valve. It should be noted that, in the normal mode, the boom electromagnetic proportional valve outputs to the boom control valve a pilot pressure corresponding to an amount of operation of the lever 26B in a forward or rearward direction.
(68) Thereafter, upon receipt of the pilot pressure from the boom electromagnetic proportional valve, the boom control valve supplies the operating oil, which is discharged from the main pump 14, to the boom cylinder 7 with a direction of flow and an amount of flow corresponding to the pilot pressure. The boom cylinder 7 extends or retracts due to the operating oil supplied via the boom control valve. The boom angle sensor 4S detects the angle α.sub.1 of the boom 4, which is moved by the extending/retracting boom cylinder 7.
(69) Thereafter, the controller 30 computes the boom rotation angle β.sub.1 by substituting the angle α.sub.1, which is detected by the boom angle sensor 4S, into the formula (3). Then, the computed value is fed back as a present value of the boom rotation angle β.sub.1, which is used when creating the boom cylinder pilot pressure command.
(70) It should be noted that although the above description is directed to the operation of the boom according to the command value β.sub.1r, the same is applicable to the operation of the arm 5 based on the command value β.sub.2r and the operation of the bucket 6 based on the command value β.sub.3r. Thus, descriptions of the operation of the arm 5 based on the command value β.sub.2r and the operation of the bucket 6 based on the command value β.sub.3r will be omitted.
(71) Moreover, as illustrated in
(72) As a result, the controller 30 can distribute an appropriate amount of operating oil to the boom cylinder 7, arm cylinder 8 and bucket cylinder 9 by performing a control of opening the bucket control valve and a control of an amount of discharge of the main pump 14.
(73) Thus, the controller 30 performs the X-direction movement control of the bucket end position P4 by repeating a control cycle, which includes the creation of the command value Xer, the creation of the command values β.sub.1r, β.sub.2r and β.sub.3r, the control of an amount of discharge of the main pump 14, and the feedback control of the operating bodies 4, 5 and 6 based on the outputs of the angle sensors 4S, 5S and 6S.
(74) In the above description, a present value of the bucket rotation angle β.sub.3 is used as it is as the command value β.sub.3r of the bucket rotation angle β.sub.3. However, a value uniquely determined in response to a value of the arm rotation angle β.sub.2, that is, for example, a value of the arm rotation angle β.sub.3r added with a fixed value may be used as the command value β.sub.3r of the bucket rotation angle β.sub.3.
(75) Moreover, in the X-direction movement control, a displacement in the X coordinated of the bucket end position P4 is open-loop controlled while fixing the Y coordinate and Z coordinate of the bucket end position P4. However, a displacement in the X coordinate of the bucket pin position P3 may be open-loop controlled while fixing the Y coordinate and Z coordinate of the bucket pin position P3. In this case, the creation of the command value β.sub.3r and the control of the bucket 6 are omitted.
(76) A description is given, with reference to
(77) When the Z-direction operation is performed with the lever 26A, the controller 30 open-loop controls, as illustrated in
(78) Thereafter, the controller 30 creates command values β.sub.1r, β.sub.2r and β.sub.3r for the boom rotation angle β.sub.1, arm rotation angle β.sub.2 and bucket rotation angle β.sub.3, respectively, based on the created command value Zer.
(79) Specifically, the controller 30 creates the command values β.sub.1r, β.sub.2r and β.sub.3r using the above-mentioned formulas (1) and (2). As indicated by the formulas (1) and (2), the values Xe and Ze of the X coordinate and Z coordinate of the bucket end position P4 are functions of the boom rotation angle β.sub.1, arm rotation angle β.sub.2 and bucket rotation angle β.sub.3. Moreover, a present value is used as it is for the value Xer of the X coordinate of the bucket end position P4 after movement. Accordingly, if the command value β.sub.3r of the bucket rotation angle β.sub.3 is maintained at a present value, the present value is substituted for Xe in the formula (1), and the present value is also substituted for β.sub.3 in the formula (1). Additionally, the created command value Zer is substituted for Zr in the formula (2), and a present value is substituted for β.sub.3 in the formula (2). As a result, the values of the boom rotation angle β.sub.1 and arm rotation angle β.sub.2 are derived by solving the simultaneous equations of the formulas (1) and (2) containing the two unknown quantities β.sub.1 and β.sub.2. The controller 30 sets the derived values to the command values β.sub.1r and β.sub.2r.
(80) Thereafter, as illustrated in
(81) Thus, the controller 30 performs a Z-direction movement control of the bucket end position P4 by repeating a control cycle, which includes the creation of the command value Zer, the creation of the command values β.sub.1r, β.sub.2r and β.sub.3r, the control of an amount of discharge of the main pump 14, and the feedback control of the operating bodies 4, 5 and 6 based on the outputs of the angle sensors 4S, 5S and 6S.
(82) In the above description, a present value of the bucket rotation angle β.sub.3 is used as it is as the command value β.sub.3r of the bucket rotation angle β.sub.3. However, a value uniquely determined in response to a value of the arm rotation angle β.sub.2, that is, for example, a value of the arm rotation angle β.sub.3r added with a fixed value may be used as the command value β.sub.3r of the bucket rotation angle β.sub.3.
(83) Moreover, in the Z-direction movement control, a displacement in the Z coordinate of the bucket end position P4 is open-loop controlled while fixing the Y coordinate and Z coordinate of the bucket end position P4. However, a displacement in the Z-direction of the bucket pin position P3 may be open-loop controlled while fixing the X coordinate and Y coordinate of the bucket pin position P3. In this case, the creation of the command value β.sub.3r and the control of the bucket 6 are omitted.
(84) As explained above, in the shovel control method according to the embodiment of the present invention, amounts of operations of the levers are used not for the extension/retraction control of the respective boom cylinder 7, arm cylinder 8 and bucket cylinder 9 but for the position control of the bucket end position P4. Thus, the present control method can materialize the operation of increasing/decreasing the value of the Z coordinate by an operation of a single lever while maintaining the bucket rotation angle β.sub.3 and the values of the X coordinate and Y coordinate of the bucket end position P4. Additionally, the operation of increasing/decreasing the value of the X coordinate can be materialized by an operation of a single lever while maintaining the bucket rotation angle β.sub.3 and the values of the Y coordinate and Z coordinate of the bucket end position P4.
(85) Moreover, according to the present control method, the lever operation amount can be used in a position control of the bucket pin position P3 by setting a plane position of the end attachment and a height of the end attachment to the bucket pin position P3. In this case, the present control method can materialize the operation of increasing/decreasing the value of the Z coordinate by an operation of a single lever while maintaining the values of the X coordinate and Y coordinate of the bucket pin position P3. Additionally, the operation of increasing/decreasing the value of the X coordinate can be materialized by an operation of a single lever while maintaining the values of the Y coordinate and Z coordinate of the bucket pin position P3. In this case, on the assumption that the three-dimensional coordinate of the bucket pin position P3 is represented by (X, Y, Z)=(X.sub.P3, Y.sub.P3, Z.sub.P3), X.sub.P3 and Z.sub.P3 are represented by the following formulas (6) and (7), respectively.
X.sub.P3=H.sub.0X+L.sub.1 cos β.sub.1+L.sub.2 cos β.sub.2 (6)
Z.sub.P3=H.sub.0Z+L.sub.1 sin β.sub.1+L.sub.2 sin β.sub.2 (7)
(86) It should be noted that Y.sub.P3 is zero. This is because the bucket pin position P3 is on the XZ plane.
(87) Additionally, in this case, the command value β.sub.3r is not created from the command value Xer in the X-direction movement control, and the command value β.sub.3r is not created from the command value Zer in the Z-direction movement control.
(88) Next, a description is given, with reference to
(89) In
(90) The electric storage system (electric storage device) 120 including a capacitor 19 as an electric accumulator is connected to the motor generator 12 via the inverter 18.
(91) The electric storage system 120 is arranged between the inverter 18 and the inverter 20. Thereby, when at least one of the motor generator 12 and turning electric motor 21 is performing a power running operation, the electric storage system 120 supplies an electric power necessary for the power running operation, and when at least one of them is performing a generating operation, the electric storage system 120 accumulates an electric power generated by the generating operation as an electric energy.
(92)
(93) The up/down voltage converter 100 performs a control of switching a voltage-up operation and a voltage-down operation in accordance with operating states of the motor generator 12 and the turning electric motor 21 so that a DC bus voltage value falls within a fixed range. The DC bus 110 is arranged between the inverters 18 and 20 and the up/down voltage converter 100, and performs transfer of an electric power between the capacitor 19, the motor generator 12 and the turning electric motor 21.
(94) Returning to
(95) The turning electric motor 21 may be an electric motor that is capable of performing both a power running operation and generating operation, and is provided to drive the turning mechanism of the upper turning body 3. When performing a power running operation, a rotational drive force of the turning electric motor 21 is amplified by the turning transmission 24, and the upper turning body 3 is acceleration/deceleration controlled to perform a rotating operation. On the other hand, when performing a generating operation, a number of revolutions of inertial rotation of the upper turning body 3 is increased by the turning transmission 24 and transmitted to the turning electric motor 21, which can generate a regenerative electric power. Here, the turning electric motor 21 is an electric motor that is alternate-current-driven by the inverter 20 according to a PWM (Pulse Width Modulation) control signal. The turning electric motor 21 can be constituted by, for example, an IPM motor of embedded magnet type. According to this, a greater electromotive force can be generated, which can increase an electric power generated by the turning electric motor 21 when performing a regenerative operation.
(96) It should be noted that the charge/discharge control for the capacitor 19 of the electric storage system 120 is performed by the controller 30 based on a charged state of the capacitor 19, an operating state (a power running operation or generating operation) of the motor generator 12 and an operating state (a power running operation or generating operation) of the turning electric motor 21.
(97) The resolver 22 is a sensor for detecting a rotation position and rotation angle of a rotation axis 21A of the turning electric motor 21. Specifically, the resolver 22 detects a rotation angle and rotating direction of the rotation axis 21A by detecting a difference between a rotation position of the rotation position before a rotation of the turning electric motor 21 and a rotation position after a leftward rotation or a rightward rotation. By detecting a rotation position and rotating direction of the rotation axis 21A of the turning electric motor 21, a rotation angle and rotating direction of the turning mechanism 2 can be derived.
(98) The mechanical brake 23 is a brake device for generating a mechanical braking force to mechanically stop the rotation axis 21A of the turning electric motor 21. Braking/releasing of the mechanical brake 23 is switched by an electromagnetic switch. The switching is performed by the controller 30.
(99) The turning transmission 24 is a transmission for mechanically transmitting the rotation of the rotation axis 21A of the turning electric motor 21 by reducing a, rotating speed. Accordingly, when performing a power running operation, a greater rotating force can be boosted by boosting the rotating force of the turning electric motor 21. On the contrary, when performing a regenerative operation, the rotation generated in the upper turning body 3 can be mechanically transmitted to the turning electric motor 21 by increasing the rotating speed.
(100) The turning mechanism 2 can be turned in a state where the mechanical brake 23 of the turning electric motor 21 is released, and, thereby, the upper turning body 3 is turned in a leftward direction or a rightward direction.
(101) The controller 30 performs a drive control of the motor generator 12, and also performs a charge/discharge control of the capacitor 19 by controlling driving the up/down voltage converter 100 as an up/down voltage control part. The controller 30 performs the switching control of a voltage-up operation and a voltage-down operation of the up/down voltage converter 100 based on a charged state of the capacitor 19, an operating state (a power assist operation or generating operation) of the motor generator 12 and an operating state (a power running operation or regenerative operation) of the turning electric motor 21 so as to perform the charge/discharge control of the capacitor 19. Additionally, the controller 30 performs a control of an amount of charge (a charge current or a charge electric power) to the capacitor 19.
(102) The switching control between the voltage-up operation and the voltage-down operation by the up/down voltage converter 100 is performed based on a DC bus voltage value detected by the DC bus voltage detecting part 111, a capacitor voltage value detected by the capacitor voltage detecting part 112 and a capacitor current value detected by the capacitor current detecting part 113.
(103) The electric power generated by the motor generator 12, which is an assist motor, is supplied to the DC bus 110 of the electric storage system 120 through the inverter 18, and then supplied to the capacitor 19 through the up/down voltage converter 100. Moreover, the regenerative electric power generated by the regenerative operation of the turning electric motor 21 is supplied to the DC bus 110 of the electric storage system 120 through the inverter 20, and then supplied to the capacitor 19 through the up/down voltage converter 100.
(104) Next, a description is given, with reference to
(105) The control method according to the embodiment of the present invention is applicable to the hybrid shovel having the above-mentioned structure.
(106) Next a description is given, with reference to
(107) Here, on the assumption that the three-dimensional coordinate (U, V, W) of the boom pin position P1 is set as (U, V, W)=(H.sub.0U, 0, H.sub.0W) and the three-dimensional coordinate (U, V, W) of the bucket end position P4 is set as (U, V, W)=(Ue, Ve, We), Ue and We are represented by formulas (1)′ and (2)′, similar to the above-mentioned formulas (1) and (2). It should be noted that Ue and Ve represent a position of the end attachment on a UV-plane, and We represents a distance of the end attachment from the UV-plane.
Ue=H.sub.0U+L.sub.1 cos β.sub.1′+L.sub.2 cos β.sub.2′+L.sub.3 cos β.sub.3′ (1)′
We=H.sub.0W+L.sub.1 sin β.sub.2′+L.sub.2 sin β.sub.2′+L.sub.3 sin β.sub.3′ (2)′
(108) It should be noted that Ve is equal to zero because the bucket end position P4 exists on the UW plane. Additionally, the angle β.sub.1′ is an angle of the ground angle β.sub.1′ added with the slope angle γ.sub.1. Similarly, the angle β.sub.2′ is an angle of the ground angle β.sub.2 added with the slope angle γ.sub.2, and the angle β.sub.3′ is an angle of the ground angle β.sub.3 added with the slope angle γ.sub.3.
(109) Moreover, on the assumption that the three-dimensional coordinate of the bucket pin position P3 is set as (U, V, W)=(U.sub.P3, V.sub.P3, W.sub.P3), U.sub.P3 and W.sub.P3 are represented by the formulas (6)′ and (7)′.
U.sub.P3=H.sub.0U+L.sub.1 cos β.sub.1′+L.sub.2 cos β.sub.2′ (6)′
W.sub.P3=H.sub.0W+L.sub.1 sin β.sub.1′+L.sub.2 sin β.sub.2′ (7)′
(110) In the slope shaping mode, when the lever 26B is tilted in a forward direction, at least one of the boom 4, arm 5 and bucket 6 moves so that the value Ue of the U coordinate is increased while the value Ve of the V coordinate and the value We of the W coordinate of the bucket end position P4 are maintained unchanged.
(111) Moreover, in the slope shaping mode, when the lever 26B is tilted in a rearward direction, at least one of the boom 4, arm 5 and bucket 6 moves so that the value Ue of the U coordinate is decreased while the value Ve of the V coordinate and the value We of the W coordinate of the bucket end position P4 are maintained unchanged.
(112) That is, the bucket end position P4 is moved in the U-axis direction in response to an operation of the lever 26B in the forward/rearward direction (corresponding to the X-direction operation of
(113) It should be noted that the operations of the levers 26A and 26B in a forward/rearward direction in the slope shaping mode, that is, a control performed in response to the W-direction operation and U-direction operation of the bucket 6 as an end attachment is referred to as the “slope position control”. Additionally, a control performed in response to the operation of the lever 26A in a leftward/rightward direction and the operation of the lever 26B in a leftward/rightward direction in the slope shaping mode is the same as that of the automatic leveling mode.
(114) As mentioned above, an operator can easily achieve a desired movement of the bucket along a slope by using the slope position control in the slope shaping mode, which is an example of the X-direction movement control (plane position control) in the automatic leveling mode.
(115) Next, a description is given, with reference to
(116) In the slope shaping mode, when the lever 26B is tilted in a forward direction, at least one of the boom 4, arm 5 and bucket 6 moves so that the value Xe of the X coordinate is increased while the value Ye of the Y coordinate is maintained unchanged and a distance between a slope SF1 of the angle γ.sub.1 and the bucket end position P4 is maintained unchanged. That is, the bucket end position P4 moves in a direction perpendicular to the Y-axis and in a direction away from the shovel on a plane SF2 parallel to the slope SF1. In this respect, the value Ze of the Z-axis increases in a case where the slope has an uphill grade when viewed from the shovel, and decreases in a case where the slope has a downhill grade when viewed from the shovel. It should be noted that
(117) Moreover, in the slope shaping mode, when the lever 26B is tilted in a rearward direction, at least one of the boom 4, arm 5 and bucket 6 moves so that the value Xe of the X coordinate is decreased while the value Ye of the Y coordinate is maintained unchanged and the distance between the slope SF1 and the bucket end position P4 is maintained unchanged. That is, the bucket end position P4 moves in a direction perpendicular to the Y-axis and in a direction approaching the shovel on the plane SF2 parallel to the slope SF1. In this respect, the value Ze of the Z-axis decreases in a case where the slope has an uphill grade when viewed from the shovel, and increases in a case where the slope has a downhill grade when viewed from the shovel.
(118) Here, on the assumption that the three-dimensional coordinate (X, Y, Z) of the bucket end position P4 is set as (X, Y, Z)=(Xe, Ye, Ze) and the three-dimensional coordinate (X, Y, Z) of the bucket end position P4′ after movement is set as (X, Y, Z)=(Xe′, Ye′, Ze′) and an amount of movement in the X-axis direction is set as ΔXe(=Xe′−Xe), an amount of movement ΔZe(=Ze′−Ze) is represent by the formula (8)
ΔZe=ΔXe×tan γ.sub.1 (8)
(119) Moreover, in the slope shaping mode, a position control of the bucket pin position P3 may be performed instead of the position control of the bucket end position P4. In this case, at least one of the boom 4, arm 5 and bucket 6 moves so that the value X.sub.P3 of the X coordinate changes while the value Y.sub.P3 of the Y coordinate of the bucket pin position P3 is maintained unchanged and a distance between the slope SF1 having the angle γ.sub.1 and the bucket pin position P3 is maintained unchanged. That is, the bucket pin position P3 moves in a direction perpendicular to the Y-axis on a plane parallel to the slope SF1.
(120) Here, on the assumption that the three-dimensional coordinate (X, Y, Z) of the bucket pin position P3 is set as (X, Y, Z)=(X.sub.P3, Y.sub.P3, Z.sub.P3) and the three-dimensional coordinate (X, Y, Z) of the bucket pin position P3′ after movement is set as (X, Y, Z)=(X.sub.P3′, Y.sub.P3′, Z.sub.P3′) and an amount of movement in the X-axis direction is set as ΔX.sub.P3(=X.sub.P3′−X.sub.P3), an amount of movement ΔZ.sub.P3(=Z.sub.P3′−Z.sub.P3) is represent by the formula (9).
ΔZ.sub.P3=ΔX.sub.P3×tan γ.sub.1 (9)
(121) It should be noted that in the present embodiment, the operation of the lever 26B in a forward/rearward direction in the slope shaping mode, that is, a control performed in response to the X-direction operation of the bucket 6 as an end attachment is referred to as the “slope position control”. Additionally, a control performed in response to the operation of the lever 26A and the operation of the lever 26B in a leftward/rightward direction in the slope shaping mode is the same as that of the case of the automatic leveling mode.
(122) Thus, an operator can easily achieve a desired movement of the bucket 6 along a slope by using the slope position control in the slope shaping mode, which is an example of the X-direction movement control (plane position control) in the automatic leveling mode.
(123) Although the bucket 6 is used as an end attachment in the above-mentioned embodiments, a lifting magnet, a breaker, etc., may be used.
(124) The present invention is not limited to the above-mentioned embodiments, and variations and modifications may be made without departing from the scope of the present invention.