This application is a U.S. National Phase Application under 35 USC 371 of International Application PCT/JP2005/021012 filed Nov. 16, 2005.
The present invention relates to a swing control device of a rotary body that is rotated by an electric motor and a construction machine.
Recently, hybrid electric rotary excavators have been being developed, in which a rotary body is driven by an electric motor and other members such as a work equipment and a carrier are driven by a hydraulic actuator (see, for instance, Patent Document 1).
Since the rotation of the rotary body is driven by the electric motor in such electric rotary excavators, even when the rotary body is rotated while a boom and an arm that are driven hydraulically are lifted up, the rotation of the rotary body is not affected by the lifting of the boom and the arm. Accordingly, an energy loss at control valves or the like can be reduced as compared to an arrangement in which the rotary body is hydraulically driven, thereby enhancing energy efficiency.
[Patent Document 1] JP-A-2001-11897
Meanwhile, in the electric rotary excavator, acceleration and deceleration are typically performed using a torque output based on a torque command value that is obtained by a deviation from a comparison between a speed command according to a lever signal from a swing lever and an actual speed. With the arrangement, when a leading edge or a trailing edge of the lever signal is sharp due to a quick operation of the swing lever or the like, the speed command value changes substantially linearly in a short time and the deviation from the actual speed becomes large, which causes a large torque to be suddenly output. Accordingly, the sudden output of the torque also causes a sudden acceleration or deceleration, which likely gives a strong impact to an operator.
An object of the present invention is to provide a swing control device and a construction machine that can reduce an impact in acceleration or deceleration of a rotary body even when a swing lever is operated quickly.
A swing control device according to an aspect of the present invention that controls a rotary body rotated by an electric motor provides a predetermined gradient to a leading edge and a trailing edge of a torque output of the electric motor based on a lever signal from a swing lever.
According to the aspect of the present invention, even when a leading edge or a trailing edge of the lever signal becomes sharp due to a quick operation of the swing lever, the gradient is provided to the leading edge or the trailing edge of the torque output that is output based on the lever signal so as to somewhat easing the edge, thereby suppressing acceleration or deceleration causing an impact.
In the swing control device according to the aspect of the present invention, it is preferable that a gradient having a specific magnitude is provided in each of an acceleration operation, a stop deceleration operation and an intermediate deceleration operation of the rotary body.
Note that the acceleration operation refers to a state in which the swing lever is tilted from a neutral position by a predetermined angle; the stop deceleration operation refers to a state in which the swing lever that is tilted by a predetermined angle is returned to the neutral position; and the intermediate deceleration operation refers to a state in which the swing lever that is tilted by a predetermined angle is returned to an arbitrary position before the neutral position.
In addition, a different gradient may be provided in an intermediate acceleration operation where the swing lever that is tilted by a predetermined angle is further tilted.
According to the aspect of the present invention, a specific gradient is provided for each of the acceleration operation, the stop deceleration operation and the intermediate deceleration operation, which can cope with difference in magnitudes of an impact among the operations or a problem unique to an operation.
In the swing control device according to the aspect of the present invention, it is preferable that a maximum acceleration having a specific magnitude is provided in each of the acceleration operation, the stop deceleration operation and the intermediate deceleration operation of the rotary body.
According to the aspect of the present invention, settings of the maximum acceleration (including acceleration in increasing the speed and a negative acceleration in decreasing the speed) are different among the acceleration operation, the stop deceleration operation and the intermediate deceleration operation. For example, by setting the maximum acceleration in the stop deceleration operation to large, the maximum torque to be output also increases, which enhances responsivity in stopping. By setting the maximum acceleration in the intermediate deceleration operation to small, the deceleration can be performed more smoothly.
In the swing control device according to the aspect of the present invention, it is preferable that: a gradient for the leading edge of the torque output in the acceleration operation is provided such that a rise time required when the torque output reaches a maximum value from zero becomes 0.15 seconds or more; a gradient for the trailing edge of the torque output in the stop deceleration operation is provided such that a fall time required when the torque output reaches a maximum value from zero becomes 0.10 seconds or more; and a gradient for the trailing edge of the torque output in the intermediate deceleration operation is provided such that a fall time required when the torque output reaches a maximum value from zero becomes 0.15 seconds or more.
The trailing edge of the torque output in the stop deceleration operation or in the intermediate deceleration operation is generated when a brake torque is applied.
According to the aspect of the present invention, since the gradient in the acceleration is provided such that the rise time becomes 0.15 seconds or more, thereby securely suppressing the impact generated in the acceleration operation. With the rise time shorter than 0.15 seconds, the impact in the acceleration operation may not be securely suppressed. By providing the gradient in the stop deceleration operation such that the fall time becomes 0.1 seconds or more, an impact generated when performing the stop deceleration operation can be securely suppressed. By providing the gradient in the intermediate deceleration operation such that the fall time becomes 0.15 seconds or more, an impact unique to the intermediate deceleration operation can also be securely suppressed.
A construction machine according to another aspect of the present invention includes: a rotary body that is rotated by an electric motor; and the above-described swing control device of the present invention, the swing control device controlling the rotary body.
According to the aspect of the present invention, as described above, the impact in the acceleration or the deceleration of the rotary body can be reduced even when the swing lever is quickly operated.
1: electric rotary excavator (construction machine)
4: rotary body
5: electric motor
10: swing lever
50: swing control device
Ta1: rise time
Tb1, Tc1: fall time
Ga_max, Gb_max, Gc_max: maximum rotation acceleration
[1-1] Overall Arrangement
A first embodiment of the present invention will be described below with reference to the attached drawings.
In
As shown in
Referring to
The swing lever 10 (typically serving also as a work equipment lever for operating the arm 7) outputs a lever signal according to a tilt angle to the controller 11. The controller 11 issues a command to the hydraulic pump 12 and the hydraulic control valve 13 that drives the hydraulic cylinders 6A, 7A, 8A in accordance with a value of the lever signal, thereby controlling a drive of the work equipment 9. The controller 11 issues, as needed, a command for adjusting an engine speed to the engine 14 and a command for adjusting power generation to the generator 15.
The controller 11 controls rotation of the rotary body 4 by controlling a torque output of the electric motor 5. For this purpose, the controller 11 includes a swing control device 50. The swing control device 50 generates a torque command value Ttar for the electric motor 5 in accordance with the lever signal value and an actual speed Vact (
[1-2] Control Structure of Rotation Control Device 50
Now, a control structure of the swing control device 50 will be described through an explanation of a control method.
Conventionally, when a lever signal that is upright substantially at right angle like a rectangular wave is input (e.g., when the swing lever 10 is directly and quickly tilted from a neutral position by a predetermined angle), the speed command value that is linearly increased from “0 (zero)” is generated. A rotation state of the rotary body in such a case is shown in
In
When the swing lever 10 is directly and quickly returned to the neutral position from the constant rotation state at the constant speed command value, the trailing edge of the lever signal becomes sharp (t2) and the speed command value is generated so as to decrease linearly.
In such a case, a predetermined acceleration G2 on a speed-decrease side is suddenly generated simultaneously with the linear decrease of the speed command value and the brake is applied to the rotary body 4 at the predetermined rotation acceleration G2, in a manner opposite to the above case. The speed command value slightly becomes gentle due to the gain characteristics immediately before reaching zero according to the lever signal and then becomes zero. Accordingly, the rotation acceleration also rises gently and becomes zero in a short time.
Meanwhile, in the related art control, when the acceleration or the deceleration is performed by a quick operation of the swing lever 10, the rotation acceleration is suddenly generated. Accordingly, peak amounts J1 to J4 of jerk values obtained by differentiation of the rotation acceleration, especially the peak amount J1 of the leading edge of the rotation acceleration and the peak amount J3 of the trailing edge of the rotation acceleration (t1, t2), become large. As a result, a large impact is generated when the rotary body 4 starts the acceleration and the deceleration, which is not preferable. In short, a small peak amount of the jerk value like the jerk values shown in other zones contributes to reduction of the impact.
As shown in
As shown in
The speed-command-value generating means 51 generates a speed command value Vo(t) for the electric motor 5 based on the lever signal value and a fed-back preceding speed command value Vo(t−1) in order to rotate the rotary body 4 at a targeted rotation acceleration. For this purpose, the speed-command-value generating means 51 includes a lever-command-speed-value generating means 511, a region judging section 512, a target acceleration calculator 513, a target acceleration storage section 514, a speed-command-value generator 515 and a speed-command-value storage section 516.
The lever-command-speed-value generating means 511 converts the lever signal value to a speed to generate a lever command speed value Vi(t), which is output to the region judging section 512. The lever command speed value Vi(t) is a reference value of the speed command value Vo(t), the speed command value Vo(t) and basically a value obtained by filtering or limiting a change amount of the lever command speed value Vi(t). In the first embodiment, the lever signal value and the lever command speed value Vi(t) are proportional to each other.
The region judging section 512 judges which region (i.e., the acceleration operation, the stop deceleration operation or the intermediate deceleration operation) the rotation state of the rotary body 4 falls into based on a relationship between the preceding speed command value Vo(t−1) and the lever command speed value Vi(t) and a relationship between a preceding target rotation acceleration G(t−1) and a predetermined maximum rotation acceleration Ga_max, Gb_max. In the description, the acceleration operation refers to a state in which the swing lever 10 is tilted from a neutral position by a predetermined angle. The stop deceleration operation refers to a state in which the swing lever 10 tilted by a predetermined tilt angle is returned to the neutral position, and the intermediate deceleration operation refers to a state in which the swing lever 10 tilted by a predetermined angle is returned to an arbitrary position before the neutral position.
The target acceleration calculator 513 calculates a value of the target rotation acceleration G(t) in accordance with the judgment result of the region judging section 512. As shown in
In the deceleration, the target acceleration calculator 513 calculates the target rotation acceleration G(t) such that a fall time Tb1 required when the torque output reaches from zero to the maximum torque output Tb_max becomes 0.1 seconds or more. Based on the calculation, a gradient is provided to the trailing edge of the torque output (α2). With the fall time shorter than 0.1 seconds, the impact becomes large, which gives uncomfortableness to an operator.
As shown in
In the first embodiment, as shown in
On the other hand, an absolute value of the maximum rotation acceleration Gc_max in the intermediate deceleration operation shown in
Referring back to
The speed-command-value generator 515 generates speed command value Vo(t) such that the change amount from the fed-back preceding speed command value Vo(t−1) becomes equal to the value of the target rotation acceleration G(t) calculated by the target acceleration calculator 513. Specifically, the speed-command-value generator 515 adds a value obtained by multiplying the target rotation acceleration G(t) by a time period of a calculation step to the preceding speed command value Vo(t−1) to generate the speed command value Vo(t).
The speed-command-value storage section 516 stores the speed command value Vo(t) generated by the speed-command-value generating means 51. The stored value is used by the region judging section 512 and the speed-command-value generator 515 as the preceding speed command value Vo(t−1) in the next calculation.
The torque-command-value generating means 52 generates the torque command Ttar in accordance with a deviation between the current speed command value Vo(t) generated by the speed-command-value generator 515 of the speed-command-value generating means 51 and the fed-back actual speed Vact. Accordingly, when the actual speed Vact does not increase relative to the speed command value Vo(t), the torque-command-value generating means 52 performs a control such that the torque output is increased so as to increase the actual speed Vact to be close to the target speed. Note that such control is a speed control performed by a typical P (Proportional) control.
[1-3] Control Operation of Rotation Control Device 50
Next, a control operation of the swing control device 50, specifically how the speed-command-value generating means 51 calculates and outputs the speed command value Vo(t) based on the input lever signal, will be described with reference to
In
When receiving the lever command speed value Vi(t), the region judging section 512 performs region judgment based on a plurality of judgment conditions. Specifically, the region judging section 512 first judges whether or not the current lever command speed value Vi(t) is larger than the preceding speed command value Vo(t−1) (ST2). From this judgment, it is determined whether the rotary body 4 is rotated in an acceleration region or in a deceleration region.
When the current lever command speed value Vi(t) is judged to be larger than the preceding speed command value Vo(t−1), the region judging section 512 judges whether or not a value obtained by subtracting the preceding speed command value Vo(t−1) from the current lever command speed value Vi(t) is larger than a predetermined value Va2 (ST3) and then judges whether or not a preceding target rotation acceleration G(t−1) is smaller than the maximum rotation acceleration Ga (ST4).
Specifically, in
Next, referring back to
On the other hand, when the current lever command speed value Vi(t) is judged to be equal to or smaller than the preceding speed command value Vo(t−1), the region judging section 512 judges whether or not a value obtained by subtracting the current lever command speed value Vi(t) from the preceding speed command value Vo(t−1) is larger than a predetermined value Vb1 (ST8) and then judges whether or not the preceding target rotation acceleration G(t−1) is larger than the maximum rotation acceleration Gb in the deceleration side (ST9).
Specifically, In
Next, referring back to
The target acceleration storage section 514 stores the target rotation acceleration G(t) thus calculated by the target acceleration calculator 513 (ST13). Thereafter, the speed-command-value generator 515 calculates the speed command value Vo(t) based on the target rotation acceleration G(t) and the preceding speed command value Vo(t−1) using Equation (8). The calculated speed command value Vo(t) is substituted with the preceding speed command value Vo(t−1), which is used in ST2 (ST15). The speed command value Vo(T) is continuously used by the torque-command-value generating means 52 to generate the torque command Ttar.
Vo(t)=Vo(t−1)+G(t)·step (8)
As described above, by controlling the electric motor 5 at the speed command value Vo(t) obtained by Equation (8), targeted rise times Ta1, Tb2 and fall times Ta2, Tb1 are provided to the torque output and the acceleration, thereby suppressing the impact.
Note that the maximum rotation accelerations Ga, Gb are preset by taking into account a degree of impact that an operator typically feels. However, the maximum rotation accelerations Ga, Gb are in relations of Ga=Ta_max/I, Gb=Tb_max/I (I representing the inertia of the rotary body 4, Ta_max and Tb_max representing the maximum torque outputs of the electric motor 5), so that the actual maximum rotation acceleration may be changed when the inertia I changes due to extension/contraction of the boom 6 or the arm 7.
In the first embodiment, the inertia I is constantly detected and the maximum torque output Ta_max, Tb_max is controlled to increase when the inertia I increases and controlled to decrease when the inertia I decreases, thereby maintaining the actual maximum rotation acceleration to be substantially constant.
In such an arrangement, the inertia I of the rotary body 4 can be obtained, for instance, based on position information of the work equipment 9 that is acquired from an angle sensor provided to the boom 6 or the arm 7 or can be obtained from the rotation acceleration during the acceleration or deceleration and the torque output (see the above-described relational equation).
[1-4] Advantages of Embodiment
According to the first embodiment, the following advantages can be attained.
Specifically, even when the leading edge or the trailing edge of the lever signal becomes sharp due to a quick operation of the swing lever 10, the gradient as the rise time Ta1 or the fall time Tb1, Tc1 is provided to the leading edge or the trailing edge of the torque output and the acceleration that are output based on the lever signal so as to somewhat ease the edge, thereby suppressing an impact in acceleration or deceleration of the rotary body 4.
In addition, a specific gradient is provided for each of the acceleration operation, the stop deceleration operation and the intermediate deceleration operation, which can securely cope with difference in magnitudes of impact among the operations or a problem unique to an operation.
Specifically, by providing the gradient in the acceleration operation such that the rise time Ta1 becomes 0.15 seconds or more, the impact generated in the acceleration can be securely suppressed; by providing the gradient in the stop deceleration operation such that the fall time Tb1 becomes 0.1 seconds or more, the impact generated in the stop deceleration operation can be securely suppressed; and by providing the gradient in the intermediate deceleration operation such that the fall time Tc1 becomes 0.15 seconds or more, the impact unique to the intermediate deceleration operation can be securely suppressed.
The value of the maximum torque output Ta_max, Tb_max is variable depending on the inertia I. Accordingly, by arranging such that the maximum torque output Ta_max, Tb_max increases when the inertia I of the rotary body 4 increases while the maximum torque output Ta_max, Tb_max decreases when the inertia I decreases, the rotary body 4 can be rotated at the maximum torque output Ta_max, Tb_max according to the inertia I of the rotary body 4, which causes the acceleration to be substantially constant and enhances ride comfort.
In the first embodiment, the target rotation acceleration reflecting the rise time Ta1 or the fall time Tb1, Tc1 is calculated based on the input lever signal and the speed command value is calculated from the target rotation acceleration, thereby obtaining the torque output and the acceleration having the targeted gradient.
In the second embodiment, a speed command value obtained from the lever signal (which is equivalent to the speed command value shown in
In
The above-described control is also performed in the regions Ta2, Tb1, Tb2, though the description thereof is omitted.
The second embodiment also provides advantages in which the targeted gradient is provided to the torque output and the impact can be securely suppressed even when the swing lever 10 is quickly operated.
It should be noted that the present invention is not limited to the embodiments described above, but includes other components or the like that can achieve an object of the present invention, and also includes modifications as shown below. It should be noted that, while the present invention has been described with reference to the specific embodiments and the drawings thereof, various modifications may be made to the described embodiments by those of ordinary skill in the art without departing from a spirit and a scope of the object of the invention.
The present invention is applicable to various construction machines in which a rotary body is rotated by an electric motor.
Number | Date | Country | Kind |
---|---|---|---|
2004-333677 | Nov 2004 | JP | national |
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/JP2005/021012 | 11/16/2005 | WO | 00 | 5/17/2007 |
Publishing Document | Publishing Date | Country | Kind |
---|---|---|---|
WO2006/054581 | 5/26/2006 | WO | A |
Number | Name | Date | Kind |
---|---|---|---|
5835874 | Hirata et al. | Nov 1998 | A |
6732458 | Kurenuma et al. | May 2004 | B2 |
7067999 | Sugano et al. | Jun 2006 | B2 |
Number | Date | Country |
---|---|---|
2001-10783 | Jan 2001 | JP |
2001-11897 | Jan 2001 | JP |
2004-169466 | Jun 2004 | JP |
Number | Date | Country | |
---|---|---|---|
20070277986 A1 | Dec 2007 | US |