1. Field of the Invention
The present invention relates to a rotation control device of working machine for rotating and driving a rotating body by an electric motor.
2. Description of the Related Art
In a rotation working machine such as an excavator and a crane, a hydraulic motor driven by discharge oil of a hydraulic pump serves as a driving source of a rotating body. However, in recent years, there is a known technique that the driving source is an electric motor (for example, Japanese Patent Laid-Open No. 2001-10783, hereinafter referred to as Patent Document 1).
In such a case, due to speed control for determining a torque instruction with using a deviation between target speed set in accordance with an operation amount of a rotation operating lever and actual rotation speed (what is called speed feedback control), when the above deviation is increased, acceleration torque is radically increased and shock is generated.
Meanwhile, there is a known technique that while PID control is performed, torque restriction is added in accordance with the operation amount as in Japanese Patent Laid-Open No. 2004-36303 (hereinafter, referred to as Patent Document 2), and there is another known technique that with using a jerk probable value calculated by second-order differential of the target speed, the target speed is corrected as in Japanese Patent Laid-Open No. 2004-137702 (hereinafter, referred to as Patent Document 3).
Further, in order to prevent the generation of the shock, there is a known technique that a dynamic characteristic of the electric motor imitates a drive characteristic of a hydraulic motor as in Japanese Patent Laid-Open No. 2003-333876 (hereinafter, referred to Patent Document 4).
However, the techniques of Patent Documents 2 to 4 are to control rotating and driving on the basis of only the operation amount of the rotation lever, and therefore not capable of suppressing effectively the generation of the shock in an actual machine.
That is, in the actual working machine, even when the operation amount of the lever is constant, necessary torque for rotating a rotating body is changed in accordance with a working state thereof (such as a working state of a working attachment and an inclination angle of the working machine itself). Therefore, the working machine has a characteristic that the speed deviation is radically changed in accordance with an amount of the torque.
Therefore, in the techniques according to Patent Documents 2 to 4, with a large amount of the necessary torque, the speed deviation is increased despite of a small operation amount of the lever by an operator, and as a result, there is a fear that the torque given to the electric motor is increased so as to generate the shock.
In the speed feedback control, in order to improve a following property to the speed, in the case of the PID control for example, gain is increased to as a large amount as possible. However, in the case where the gain is increased, the deviation between the target speed and the actual rotation speed is small but instruction torque to the electric motor is excessively increased by a small amount of the lever operation. Therefore, in the case where a rotation pressing work by a bucket is performed, there is sometimes a case where adjustment of the pressing force is difficult. Further, in the case where a radical lever operation is performed, there is sometimes a case where the instruction torque to the electric motor is radically increased so as to generate the shock.
Conversely, in order to facilitate the adjustment of the instruction torque to the electric motor by the lever operation, in the case of the PID control for example, there is sometimes a case where the gain is decreased or integral gain is made to be zero. However, in the case where the gain is decreased, in a working state in an inclined ground (a state of receiving weight of the working machine itself) and the like, the instruction torque to the electric motor is excessively decreased so that it is not possible to ensure sufficient acceleration/deceleration torque and spot-maintenance torque.
As a technique for solving the problem of the speed feedback control, there are known techniques disclosed in Patent Documents 2, 5 to 7. The techniques are to properly switch between the two control systems mentioned above.
Specifically, Patent Document 5 (Japanese Patent Laid-Open No. 2003-328398) discloses a technique of switching between the speed feedback control and torque control taking a fixed operation amount of the operating lever as a border. Patent Document 6 (International Publication No. 2005/111322) discloses a technique of switching between speed control and position control taking a speed threshold value of the target speed in accordance with the operation amount of the lever as a border. Patent Document 7 (Japanese Patent Laid-Open No. 2005-273262) discloses a technique of switching between normal speed control and speed control with proportional gain which is more decreased than the above speed control taking predetermined speed of the rotating body as a border.
Patent Document 2 discloses a technique of performing position maintenance control when the operation amount of the operating lever is in a neutral range which is preliminarily set, while performing the torque control when the operation amount exceeds the neutral range.
However, in the case where the two control systems are switched as in Patent Documents mentioned above, at a point of switching between the control systems, the torque is discontinuously changed (radically changed) in order to fill a gap between the control systems so that it is not possible to smoothly and stably perform the control.
In the technique of Patent Document 2, in a state after the operation amount of the lever exceeds the neutral range, rotating and driving are performed with larger torque among the spot-maintenance torque and the acceleration torque. However, the spot-maintenance torque is torque which is generated in the position maintenance control executed within the neutral range and hence required in the past, and therefore not torque which reflects the working state at the present. Therefore, when the torque for maintaining the rotating body on the spot is larger at the time of executing the torque control than at the time of executing the position maintenance control, there is a fear that the rotating body is adversely moved against intention of the operator.
It is an object of the present invention to provide a rotation control device capable of suppressing generation of shock and a working machine therewith, and further a rotation control device of working machine capable of suppressing a discontinuous change of torque while preventing adverse movement of a rotating body and a working machine therewith.
The present invention is a rotation control device installed in a working machine having a main body, a rotating body rotatably mounted on the main body and a working attachment provided in the rotating body so as to be raised and lowered, comprising an electric motor for rotating and driving the rotating body, operation means for receiving an input operation of a drive instruction to the electric motor, operation amount detection means for detecting an operation amount of the operation means, speed detection means for detecting rotation speed of the electric motor, and control means for setting target speed of the electric motor on the basis of the operation amount detected by the operation amount detection means, setting target torque on the basis of a speed deviation between the target speed and the speed detected by the speed detection means, and operating the electric motor in accordance with the target torque, wherein the control means is provided with correction means for calculating a correction amount which is increased as increasing necessary torque for rotating the rotating body, the necessary torque being changed in accordance with a working state of the rotating body, and subtracting the correction amount from the target speed so as to make new target speed.
According to the present invention, an amount of the target torque of the electric motor is adjusted in accordance with the necessary torque for rotating the rotating body, the necessary torque being changed in accordance with the working state of the rotating body. Therefore, it is possible to effectively suppress the generation of the shock.
That is, in the working machine according to the present invention, in accordance with a working state thereof such as a working state of the working attachment (a working radius of the working attachment, existence or nonexistence of earth and sand within a bucket at the time of working or the like), or an external force received at the time of working (a reaction force received at the time of a pressing work by the bucket, weight of the working machine itself in a inclined ground or the like), the necessary torque for rotating the rotating body is changed. Therefore, as the necessary torque is increased, the speed deviation between the target speed and the actual speed detected by the speed detection means tends to be increased. However, since the correction means is provided in the control means of the present invention, it is possible to prevent the increase in the speed deviation.
The correction means is preferably formed so as to calculate the correction amount which is increased as increasing the necessary torque and subtract the correction amount from the target speed which is already set. It is possible to decrease the speed deviation between the new target speed and the actual speed detected by the speed detection means.
In such a case, as the necessary torque is increased, the speed deviation is decreased. As a result, it is also possible to decrease a value of the target torque given to the electric motor in order to fill the speed deviation. Therefore, it is possible to suppress the generation of the shock.
In the above rotation control device, the correction means preferably calculates a correction amount which is decreased as increasing the operation amount of the operation means.
In such a case, it is possible to suppress an excessive decrease in the target speed after correction as the operation amount of the operation means is increased. Therefore, it is possible to ease an uncomfortable feeling of an operator.
In the above rotation control device, the control means is formed so as to set the target torque for a predetermined cycle, and the correction means is preferably formed so as to utilize the target torque set in the previous cycle as a correspondent to the necessary torque of the rotating body to be used for the present cycle, and calculate the correction amount.
In such a case, it is possible to utilize the target torque set in the previous cycle as it is, and calculate the correction amount. Therefore, it is possible to simplify processing in comparison to the case where the necessary torque of the rotating body is actually calculated.
That is, all the change of the necessary torque is reflected to load torque of the electric motor. Therefore, by calculating the correction value in accordance with an increase/decrease in the load torque so as to calculate the target torque, it is possible to calculate the target torque corresponding to the change of the necessary torque.
The present invention is to provide a rotation control device installed in a working machine having a main body, a rotating body rotatably mounted on the main body and a working attachment provided in the rotating body so as to be raised and lowered, comprising an electric motor for rotating and driving the rotating body, operation means for receiving an input operation of a drive instruction to the electric motor, operation amount detection means for detecting an operation amount of the operation means, speed detection means for detecting rotation speed of the electric motor, and control means for setting first target torque for driving the electric motor at target speed corresponding to the operation amount detected by the operation amount detection means, setting second target torque for maintaining the rotating body on the spot on the basis of actual speed detected by the speed detection means, and operating the electric motor in accordance with torque which has a larger absolute value in the same direction as the first target torque among the first target torque and the second target torque.
According to the present invention, on the basis of the actual speed detected by the speed detection means, the second target torque is set. Therefore, even in the case where a work is performed in an environment in which the working state is changed each time, it is possible to specify spot-maintenance torque (second target torque) which is suitable for the working state at the present. That is, in accordance with the working state of the working attachment (the working radius of the working attachment, the existence or the nonexistence of the earth and sand within the bucket at the time of working or the like), the external force received at the time of working (the external force received at the time of the pressing work by the bucket, the weight of the working machine itself in the inclined ground or the like) or the like, the spot-maintenance torque is changed each time. However, according to the present invention, it is possible to surely prevent the adverse movement of the rotating body even in such a case.
Further, in the present invention, the larger value is selected between the second target torque calculated as above and the first target torque calculated on the basis of the operation amount of the operation means. Therefore, when examining transitioning lines of the first target torque and the second target torque (refer to
Here, the control means is preferably provided with target speed setting means for setting the target speed on the basis of the operation amount detected by the operation amount detection means, first torque calculation means for calculating the first target torque on the basis of a speed deviation between the target speed and actual speed detected by the speed detection means, and target torque setting means for setting the torque which has a larger absolute value in the same direction as the first target torque among the first target torque and the second target torque as the next target torque.
Further, the control means is preferably provided with second torque calculation means for calculating torque to be given to the electric motor in order to make the actual speed zero as the second target torque.
It should be noted that “zero” not only indicates the case where the speed is just zero, but also includes a speed component within a range capable of determining that the speed is substantially zero.
The first torque calculation means and the second torque calculation means are adapted to calculate the first target torque and the second target torque on the basis of expressions having a proportional term and an integral term respectively, and the control means is preferably provided with further gain change means capable of changing an amount of gain by which the proportional term and the integral term are multiplied.
In such a case, it is possible to adjust the gain in proportional and integral control by the gain change means. Therefore, when the working radius of the working attachment is large and when the inertia moment of the rotating body is large as in the work in the inclined ground or the like, it is possible to surely prevent the adverse movement by changing the gain into larger gain. Meanwhile, in the case where the rotation pressing work by the bucket or the like is performed, it is possible to fine-adjust the torque in accordance with an operation of the operation means by changing the gain into smaller gain.
The present invention with the above configuration is to provide a working machine, comprising a main body, a rotating body rotatably mounted on the main body, and the above rotation control device.
Hereinafter, a description will be given to a preferred embodiment of the present invention with reference to the drawings.
Referring to
The working attachment 4 is provided with a boom 5 installed in the upper rotating body 3 so as to be raised and lowered, an arm 6 connected to a front end of the boom 5, a bucket 7 connected to a front end of the arm 6, a boom cylinder 8 for driving the boom 5 to the upper rotating body 3, an arm cylinder 9 for driving the arm 6 to the boom 5, and a bucket cylinder 10 for driving the bucket 7 to the arm 6.
The lower traveling body 2 is provided with a pair of left and right crawlers 11 (one of the crawlers is shown in
The upper rotating body 3 is provided with an engine 14, a hydraulic pump 15 and a generator 16 driven by the engine 14, a battery 17, a rotation motor 18, and a deceleration mechanism 19 of the rotation motor 18.
As shown in
The generator 16 is connected to an output shaft of the engine 14 through an acceleration mechanism 21. Electric power obtained by the generator 16 is charged in the battery 17 through a control instrument 22, and supplied to the rotation motor 18 through an inverter 23. It should be noted that the control instrument 22 is to adjust voltage application and supply of electric current.
The rotation motor 18 is provided with a mechanical brake 24 serving as a negative brake for generating a mechanical brake power. In a state that the mechanical brake 24 is released, since a drive force of the rotation motor 18 is transmitted to the lower traveling body 2 via the rotation deceleration mechanism 19, the upper rotating body 3 is rotated rightwards or leftwards to the lower traveling body 2.
The upper rotating body 3 is provided with an operating lever (rotation operating lever) 25. The operating lever 25 is provided with a lever portion 25a capable of tiltingly operating leftwards and rightwards from a neutral position which is preliminarily set, and an operation portion (such as a potentiometer) 25b for detecting an operation amount of the lever portion 25a. The operating lever 25 outputs an electric signal in accordance with the operation amount of the lever portion 25a to a controller 26 serving as an example of control means.
Further, the upper rotating body 3 is provided with a speed sensor 27 for detecting rotation speed of the rotation motor 18. The speed sensor 27 outputs an electric signal in accordance with the rotation speed of the rotation motor 18 to the controller 26.
The controller 26 is known control means including a CPU for executing various calculation processing, and a ROM for storing an initial setting and the like, a RAM for rewritably storing various information and the like. In the controller 26, a target speed map as shown in
Specifically, the target speed map in
Referring to
The target speed setting portion 28 specifies target speed v0 corresponding to an operation amount a0 of the operating lever 25 from the above target speed map (refer to
The correction amount calculation portion 29 detects necessary torque t0 for rotating the rotation motor 18, the necessary torque t0 being changed in accordance with a working state of the excavator 1 at the present. Here, the “working state of the excavator 1” indicates a working state of the working attachment 4 (a working radius of the working attachment 4, existence or nonexistence of earth and sand within the bucket 7 at the time of working or the like), or a reaction force received at the time of working (a reaction force received at the time of a pressing work by the bucket 7, weight of the excavator 1 itself in a inclined ground or the like). Specifically, in the present embodiment, the correction amount calculation portion 29 utilizes the target torque outputted from the inverter 23 in the previous cycle as a correspondent to the necessary torque t0 of the rotation motor 18, and calculates a correction amount b0 following an expression 1 below on the basis of the necessary torque t0 and the operation amount a0 of the operation portion 25b.
b0=t02×{G0+G1×(1−a0×0.01)} (Expression 1)
Here, G0 and G1 are control gain respectively, and correspond to intercept and a gradient when the operation amount a0 of the operation portion 25b serves as a variable. That is, the control gain G0 regulates a maximum value of the torque to be restricted. As the above control gain G0 is increased, a value of the target torque to be calculated at the end is decreased. Meanwhile, the control gain G1 regulates a ratio of increase/decrease in the torque to be restricted in accordance with a change of the operation amount a0 of the operating lever 25. By adjusting the above control gain G0 and G1, it is possible to obtain an effect corresponding to bleed-off in a hydraulic rotation system.
It should be noted that in the present embodiment, the target torque in the previous cycle is utilized as a correspondent to the necessary torque t0 of the rotation motor 18. However, on the basis of the target torque in the previous cycle and the speed of the rotation motor 18 detected by the speed sensor 27, actual necessary torque of the rotation motor 18 may be calculated.
As shown in an expression 2 below, the correction amount b0 calculated by the correction amount calculation portion 29 and actual speed v1 of the rotation motor 18 detected by the speed sensor 27 are subtracted from the target speed v0 so as to calculate a speed deviation |v.
v=v0−b0−v1 (Expression 2)
The first torque calculation portion 30 calculates first target torque t1 following an expression 3 below on the basis of the speed deviation |v.
t1=G2×|v+G3×∫(|v)dt (Expression 3)
Here, G2 and G3 are proportional gain and integral gain respectively which are preliminarily set.
Meanwhile, when an operation position of the lever portion 25a of the operating lever 25 is within the neutral range mentioned above, the second torque calculation portion 31 calculates second target torque t2 to be given to the rotation motor 18 in order to make the actual speed v1 of the rotation motor 18 detected by the speed sensor 27 zero following an expression 4 below.
t2=G4×(0−v1)+G5×∫(0−v1)dt (Expression 4)
Here, G4 and G5 are proportional gain and integral gain respectively which are preliminarily set.
The target torque setting portion 32 sets the torque which has a larger absolute value in the same direction as the first target torque t1 (hereinafter, a description will be given taking the rightward rotation direction as the “positive” direction and the leftward rotation direction as the “negative” direction) among the first target torque t1 and the second target torque t2 as the next target toque.
Hereinafter, a description will be given to processing executed by the controller 26 with reference to
When the processing is started, firstly, the target speed v0 corresponding to the operation amount a0 of the operating lever 25 is specified on the basis of the map (refer to
Next, the speed v1 of the rotation motor 18 is detected by the speed sensor 27 (Step S2), and the second target torque t2 is calculated following the above expression 4 on the basis of the speed v1 (Step S3).
The correction amount b0 is calculated following the above expression 1, and by utilizing the correction amount b0 and the speed v1, the speed deviation |v is calculated following the above expression 2 (Step S4).
Next, by using the speed deviation |v, the first target torque t1 is calculated following the above expression 3 (Step S5), and it is determined whether or not the first target torque t1 is in the positive direction (rightward rotation direction) (Step S6).
Here, in the case where the first target torque t1 is in the positive direction (rightward rotation direction) (YES in Step S6), the first target torque t1 and the second target torque t2 are compared to each other (Step S7), and the torque which has a larger absolute value in the positive direction among the first target torque t1 and the second target torque t2 is set as the next target toque (Steps S8 and S9). Then, the target torque set as mentioned above is outputted to the inverter 23 (Step S15) and the processing is finished.
Meanwhile, in the case where the first target torque t1 is not in the positive direction (NO in Step S6), it is determined whether or not the first target torque t1 is in the negative direction (leftward rotation direction) (Step S10).
Here, in the case where the first target torque t1 is in the negative direction (leftward rotation direction) (YES in Step S10), the first target torque t1 and the second target torque t2 are compared to each other (Step S11), and the torque which has a larger absolute value in the negative direction, that is, a smaller value in consideration to positive and negative, among the first target torque t1 and the second target torque t2 is set as the next target toque (Steps S12 and S13). Then, the target torque set as mentioned above is outputted to the inverter 23 (Step S15) and the processing is finished.
Further, in the case where it is determined that the first target torque t1 is in neither the positive direction nor the negative direction in Steps S6 and S10 (NO in Steps S6 and S10), that is, in the case where there is a need for maintaining the upper rotating body 3 on the spot, the second target torque t2 is set as the next target torque (Step S14), then, the target torque set as mentioned above is outputted to the inverter 23 (Step S15) and the processing is finished.
By performing the processing mentioned above, as shown in
That is,
As shown in the above expression 1, the correction amount b0 comes close to zero as decreasing the necessary torque t0. Therefore, in the case where the necessary torque t0 is small, it is possible to perform speed control without consideration to the necessary torque t0 as in the related art. For reference,
Further, in the above embodiment, as mentioned above, the torque which has a larger absolute value in the same direction as the first target torque t1 among the first target torque t1 and the second target torque t2 is set as the next target torque. Therefore, it is possible to smoothly change the torque. Hereinafter, a description will be given to the above point in comparison to the conventional configuration.
Hereinafter, a description will be given to a case where the target speed of the rotation motor 18 changes as shown by L2 in accordance with an increase in an operation amount L1 of the operating lever 25 over time as shown in
For example, in the related art disclosed in Japanese Patent Laid-Open No. 2003-328398, while the speed proportional control (PID control) is performed with the operation amount of the operating lever within the range of the dead zone, the torque control is performed in the case where the operation amount of the operating lever exceeds the range of the dead zone. That is, as shown in
Meanwhile, in the above embodiment, as shown in
As mentioned above, according to the above embodiment, on the basis of the actual speed detected by the speed sensor 27, the second target torque t2 is set. Therefore, even in the case where a work is performed in an environment in which the working state is changed each time, it is possible to specify spot-maintenance torque (second target torque t2) which is suitable for the working state at the present. That is, in accordance with the working state of the working attachment 4 (the working radius of the working attachment 4, the existence or the nonexistence of the earth and sand within the bucket 7 at the time of working or the like), the external force received at the time of working (the external force received at the time of the pressing work by the bucket 7, the weight of the working machine itself in the inclined ground or the like) or the like, the spot-maintenance torque is changed each time. However, according to the above embodiment, it is possible to surely prevent the adverse movement of the upper rotating body even in such a case.
Further, in the above embodiment, the larger value is selected between the second target torque t2 calculated as above and the first target torque t1 calculated on the basis of the operation amount of the operating lever 25 (Steps S6 to S14 in
It should be noted that in the above embodiment, the description is given to the configuration in which the preliminarily set values of the gain G2, G3, G4 and G5 in the expression 3 and the expression 4 are fixed. However, it is possible to provide gain change means for changing the gain G2 to G5 in the controller 26.
In such a way, it is possible to adjust the gain G2 to G5 by the gain change means. Therefore, when the working radius of the working attachment 4 is large and when the inertia moment of the rotating body is large as in the work in the inclined ground or the like, it is possible to surely prevent the adverse movement by setting the gain G2 to G5 into larger gain. Meanwhile, in the case where the rotation pressing work by the bucket 7 or the like is performed, it is possible to fine-adjust the torque in accordance with the operation of the operating lever 25 by changing the gain into smaller gain.
In the above embodiment, an amount of the target torque of the rotation motor 18 is adjusted in accordance with the necessary torque t0 for rotating the upper rotating body 3 (target torque in the previous cycle), the necessary torque t0 being changed in accordance with the working state of the upper rotating body 3. Therefore, it is possible to effectively suppress the generation of the shock.
That is, in the excavator 1, the working state thereof such as the working state of the working attachment 4 (the working radius of the working attachment 4, according to the existence or the nonexistence of earth and sand within the bucket 7 at the time of working or the like), or the external force received at the time of working (the reaction force received at the time of the pressing work by the bucket 7, the weight of the excavator 1 itself in the inclined ground or the like), the necessary torque t0 is changed. Therefore, as the necessary torque t0 is increased, the speed deviation |v between the target speed and the actual speed v1 detected by the speed detection means tends to be increased. However, in the above embodiment, it is possible to prevent the increase in the speed deviation |v.
Specifically, in the above embodiment, the correction amount b0 which is increased as increasing the necessary torque t0 is calculated and the correction amount b0 is subtracted from the target speed v0 which is already set. Therefore, it is possible to decrease the speed deviation |v between the new target speed (v0−b0) and the actual speed v1 detected by the speed sensor 27.
Therefore, according to the above embodiment, since it is possible to decrease the speed deviation |v as increasing the necessary torque t0, it is possible to suppress the generation of the shock.
As in the above embodiment, with the configuration in which the correction amount b0 which is decreased as increasing the operation amount a0 of the operating lever 25 is calculated, it is possible to suppress an excessive decrease in the target speed after correction as the operation amount a0 of the operating lever 25 is increased. Therefore, it is possible to ease an uncomfortable feeling of an operator.
As in the above embodiment, with the configuration in which the target torque set in the previous cycle is utilized as the necessary torque t0 used in the present cycle, it is possible to simplify the processing in comparison to the case where the necessary torque t0 of the upper rotating body 3 is actually calculated.
That is, all the change of the necessary torque t0 of the upper rotating body 3 is reflected to load torque (target torque) of the rotation motor 18. Therefore, by calculating the correction value b0 in accordance with an increase/decrease in the load torque so as to calculate the target torque, it is possible to calculate the target torque corresponding to the change of the necessary torque t0.
As in the above embodiment, with the configuration provided with the target torque setting portion 32 for setting the torque which has a larger absolute value in the same direction as the first target torque t1 among the first target torque t1 and the second target torque t2 as the target toque, it is possible to surely prevent the generation of the “adverse movement” in which the upper rotating body 3 is rotated in the adverse direction due to lack of the torque in the case where the rotation is started towards the up side in the inclined ground and in the case where the rotation is started towards the upwind side in strong winds.
Further, in the case where the rotation is stopped in the inclined ground, the torque of the rotation motor 18 is always an amount which is proportional with gravity. Therefore, it is possible to prevent that the control torque is overcome by the gravity so as to adversely move the upper rotating body 3 to the down side.
Although the invention has been described with reference to the preferred embodiments in the attached figures, it is noted that equivalents may be employed and substitutions made herein without departing from the scope of the invention as recited in the claims.
Number | Date | Country | Kind |
---|---|---|---|
2007-041381 | Feb 2007 | JP | national |
2007-221182 | Aug 2007 | JP | national |
2007-221183 | Aug 2007 | JP | national |