The present invention relates to a control system for an elevating device or transfer means. Specifically, it relates to a control system in a transfer means that moves a load with an assist force of an operator in the operator's desired direction and at the operator's desired velocity when the operator imposes the force (an operating physical force) on the load, which load is suspended by a rope in a position or is vertically moved by winding a hoist drum up and down in one direction and a reverse direction by a servomotor driven in those directions, or which load is horizontally carried by a crane.
A Japanese prior-art published patent, JP H11-147699A, discloses a control system for a device that vertically transfers a load. This load-transfer device includes a mechanism for vertically carrying the load, a drive source for driving the mechanism, and a control part and a handling part, for controlling the drive source, and further includes a control system, wherein a sensor provided in the handling part detects the magnitude of the lifting force of an operator created when he or she holds the handling part and pushes the load upward against the gravity, and the hoisting power of the load-transfer device is amplified in response to the magnitude of the lifting force of the operator, thereby vertically moving the load by the amplified hoisting power and the lifting force. That control system in the load-transfer device controls the amount of air to be supplied to a cylinder by always or approximately increasing the ratio of the hoisting power to the lifting force as the lifting force become greater.
When this control system is used, for example, to manually carryout aligning and fitting the bushings of a cope on the pins of a drag for mating them, it is necessary to place the cope, which is suspended by an overhead traveling crane or the like, just above the drag first by depressing or controlling the operating buttons of the control panel of the crane first, and then necessary to lower the cope onto the drag.
On the other hand, there is a power assistance system developed as a research power assistance system for use in factories (as taught in “Development of the Power Assistance System for Transportation” by Hisashi Nakamura, the System Integration Division Science Lecture Meeting '01, Lecture Meeting Thesis Collection 2001, pp. 515-516), where the man's operating physical force (imposed force) is measured by a force sensor to obtain an assistance force (supplementary force) that will correspond to the imposed force. Further, other power assistance systems are known, such as one (as taught in “Trial for Safety of Skill Assistance” by Youji Yamada, the System Integration division Science Lecture Meeting '01, Lecture Meeting Thesis Collection 2001, pp. 519-520), where the skill assistance (technological assistance) is carried out considering not only reducing the burden of the worker but also his or her operational feeling, and the COBOTO (“Cobots for the Automobile Assembly Line” by P Akella, Proc. IEEE Int. Conf. Rob Autom 1999, pp. 728-733), where a man operates the system with an acceleration pedal and a steering wheel.
However, since in the former control system of the device for hoisting the load the instructions for moving the load at a velocity and in a direction are given by handling an operating lever by a operator, which lever is disposed apart from the load, the operator cannot simultaneously hold the load and operates the lever, giving the operator a non-excellent operational feeling when he or she hoists the load. Further, in a cope-and-rag mating operation, the cope sways when it is moved to a position above the drag, causing a difficulty with mating them precisely. Accordingly, the operator had to repeatedly depress the buttons of a control panel to precisely position the cope relative to the drag. This was inefficient. Further since the operator had to operate with his or her both hands simultaneously holding the cope and the control panel, the operation was difficult, causing a problem in that the physical burden on him or her would be great.
Further, since in the latter power assistance system a sensor for measuring the operational physical force imposed on the load by the operator is disposed in a position separated from the load, he or she cannot direct touch the load or cannot feel a response from it when he or she operates to transfer it. Accordingly, an excellent operational feeling is not given. Further, since the power assistance system requires a special-purpose device, it cannot be introduced in the existing overhead traveling cranes used in factories.
Further, since in the control systems for the conventional devices for hoisting a load or the conventional transfer means the instructions for moving the load in a given direction and at a given velocity are to be generated by operating the operation lever by the operator, he or she cannot simultaneously holds the load and operate it, causing a problem in that he or she cannot hoist the load in an excellent operational feeling.
Further, since in a cope-and-drag mating operation, the cope sways when it is moved to a position above the drag, causing a difficulty with mating them precisely and requiring repeated fine adjustments of the position of the cope by depressing the buttons of a control panel many times. This was inefficient. Further since the operator has to operate with his or her both hands simultaneously holding the cope and the control panel, the operation is extremely difficult, causing a problem in that the physical burden on him or her will be great.
Further, there were problems in that the operator cannot hoist the load in an excellent operational feeling, and in that further the operator cannot horizontally move the load, since he or she simultaneously carries out both holding the load and operating the control lever.
The present invention aims to solve the prior-art problems discussed above.
The control system for an elevating or hoisting device of the first embodiment of the present invention is a system for controlling a servomotor so as to vertically move a load in an operator's desired direction and at the operator's desired velocity when the operator imposes a force on the load, which load is suspended in a position by a rope or is vertically moved by winding the rope up and down by the servomotor driven in one direction and a reverse direction, comprising: a force measuring means for measuring the magnitude of the force acting on a lower pant of the rope that is caused by the imposed force of the operator, the mass of the load, and an acceleration of the load; and a control means having a computing unit, the computing unit computing a direction and a velocity of the servomotor to be driven, based on the measured result from the force measuring means, and outputting a signal that corresponds to the measured result to the servomotor.
It the system so arranged, when the operator imposes a force on the load to raise or lower the load in the operator's desired directions, the force measuring means measures the magnitude of the force acting on the lower part of the rope, which force is caused by the imposed force of the operator, the mass of the load, and a force due to the acceleration of the load, and send the measured result to the control means. The control means then computes a rotational direction and a velocity for the servomotor to be driven from the measured result from the force measuring means, which rotational direction and velocity correspond to the measured result, and then sends a directional signal to the servomotor to drive it. Accordingly, a force that corresponds to the force imposed by the operator is added to the load, and this assists the operator, so that the load is moved in the operator's desired direction and at the operator's desired velocity.
Further, in an operation of placing a filling frame on a flask, when the operator imposes a force or forces on the filling frame to move it vertically, horizontally, and/or frontward and rearward directions to place it on the flask, the force measuring means measures the magnitude of the force generated by the imposed force by the operator, the mass of the cope, and the acceleration of the cope, and then send the measured result to the control means. The control means then computes a rotational direction and a velocity for the servomotor to be driven from the measured result from the force measuring means, which rotational direction and velocity correspond to the measured result. Accordingly, a force that corresponds to the force imposed by the operator is added to the cope, and this assists the operator, so that the cope is moved in the operator's desired direction and at the operator's desired velocity.
In the first embodiment of the present invention, by storing in the computing unit a controller Kf represented by the expression Kf=kpωn2/(s2+2ζωns+ωn2), the computing unit can compute an elevating velocity for a minimum time due to the controller Kf based on the measured information from the force measuring means, namely, the information on the force caused by the mass of the load, the imposed force by the operator, and the acceleration of the load, so that the system is not dispersed even if a resonance such as a sway of the load is caused.
With this arrangement of the first embodiment, the operator can simultaneously carries out both holding the load and operating it, generating a practicable great effect in that the operator can obtain an excellent operational feeling and can elevate the load in his or her desired direction and at the desired velocity.
A control system for a transfer means, of the second embodiment of the present invention, is a control system for a transfer means that carries a load with an assist force of an operator when the operator imposes the assist force on the load as an operating physical force, in the operator's desired direction at the operator's desired velocity, which load is suspended by a rope in a position or is vertically moved by winding the rope up and down by a hoist drum driven in one direction and a reverse direction by a servomotor driven in those directions, and which load is horizontally transferred by a crane, comprising a force measuring means for measuring the magnitude of the force acting on a lower part of the rope, which force is caused by the imposed force of the operator, the mass of the load, and an acceleration of the load; a first control means having a first computing unit, the first computing unit computing a rotational direction and a velocity of the servomotor to be driven, based on the measured result from the force measuring means, and outputting to the servomotor a signal that corresponds to the measured result to drive the servomotor. a length measuring means for measuring the length of the rope wound down from the hoist drum; a weight measuring means for measuring the weight of the load suspended from the rope; an angle measuring means for measuring the angle of the rope relative to a vertical plane when the operator laterally pushes the load; and a second control means having a second computing unit, the second computing unit computing operation conditions for the crane based on the measured information from the length measuring means, the weight measuring means, and the angle measuring means, and outputting to the crane a signal that corresponds to the computed result to drive the crane.
In the control system so arranged, when an operator imposes a force on a load, which has a given weight, and which is suspended by a given length of a rope, which is in turn wound down from a hoist drum, so as to raise or lower the load in a desired direction, the force measuring means measures the magnitude of a force acting on the rope generated by the imposed force by the operator, the mass of the load, and an acceleration of the load, and the sends the measured result to the first control means. When receiving the measured result from the force measuring means, the first control means computes a rotational direction and a velocity for the servomotor to be driven that correspond to the measured result and then sends an instruction signal to the servomotor to drive it. Accordingly, the operator can raise or lower the load in his or her desired direction and at the desired velocity with the added force corresponding the operator's imposed force.
Further, when the operator horizontally pushes the load, which has a given weight, and which is suspended by a given length of the rope, the information on the length the wound-down rope from the length measuring means, the information on the weight of the load form the weigh measuring means, and the information on the swaying angle of the rope at that time from the angle measuring means, are input to the second control means. An electric power that is necessary to move the crane in the direction to cancel the swaying angle of the rope at that time is input to the electric motor of the crane. Accordingly, the operator can horizontally transfer the load by directly operating it in the high operative condition.
Further, in the second embodiment of the present invention, by storing in the computing unit the controller Kf represented by the expression Kf=kpωn2/(s2+2ζωns+ωn2), the computing unit can compute an elevating velocity for a minimum time due to the controller Kf based on the measured information from the force measuring means, namely, the information on the force caused by the mass of the load, the imposed force by the operator, and the acceleration of the load, so that the system is not dispersed even if a resonance such as a sway of the load is caused.
Due to the second embodiment so arranged, a practicable great effect is produced in that the operator can elevate the load in the desired direction and at the desired velocity while obtaining an excellent operational feeling, and further, he or she can horizontally transfer it in the high operative condition, while directly operating it.
The best mode for carrying out the invention is now explained with reference to the accompanying drawings, where the invention is applied to a transfer means, the winding-up machine of which is installed in an overhead traveling crane. The mode is explained for a load that includes a flask-tight mold that holds therein a mold or a mold with a core or cores. This mode is similarly applicable to a cope flask.
As shown in
Further, as shown in
The operation of this transfer means is now explained for the case where the operator transfers the load W to an arbitrary place using the transfer means arranged as explained above. First, the procedure for raising or lowering a load W, which is suspended by a rope 2, in the operators desired direction and at the operator's desired velocity by pushing the load W upward or downward by the operator is explained. When the operator pushes the load W upward or downward, the load cell 3 measures the magnitude of the force acting on the rope 2 and sends it to the first control means 4. The computer of the first control means 4 then carries out some necessary computations on the basis of the following principle so as to assist the operator for elevating the load W by the winding-up machine through the winding-up machine to elevating of load W.
Specifically, in that basic principle the load cell 3 detects the force fm [N] when the operator imposes an operational physical force fh [N] to load W as shown in
The above action is performed by the following theory. Specifically, the following relational expression is established.
The controlled elevating velocity for the load W,
v=rv=Kffm (1)
Since the force fm is here the value of the operational physical force fh minus the apparent weight due to the acceleration dv/dt of the load, it is expressed as follows:
fm=fh−mdv/dt (2)
Thus the load W obtains the elevating velocity that is expressed by the following transfer function due to the operational physical force fh.
Rv(s)=Kf(s)Fh(s)/[1+msKf(s)] (3)
where s is a Laplacian operator [l/s], and Fh is the imposed operational physical force [N]. Therefore, the operator can elevate the load with his or her less force if the gain of Kf(s) is made greater.
Now, from the operational physical force the coefficient of transformation kp [(m/s/N)] of the winding-up or winding-down velocity is defined as the controller's parameter, which velocity is to be the controlled velocity rv=kpfh of the load W in the steady state, where kp denotes the transfer velocity [m/s] per the unit operational physical force (1[N]).
This variable is decided depending on user requirements. A less kp may be selected if the transfer velocity of the load W is made less to perform a more precise positioning of it, or a greater kp may be selected if the load is to be carried at a higher velocity by a less force.
Further, the following expression is obtained if the variation in the resonance frequency of the winding-up machine and its peak gain are considered as multiplication variations.
{tilde over (P)}=P(1+Δ) (4)
In expression (4), P with an upper wave bar is an actual transfer function, P is a normal transfer function expressed by P(s)=Fm(s)/Rv=ms, and Δ is a variation.
Further, the relation between the modeling error margin and the estimate of the weight function is shown in
Wr=ωps/ωc(s+ωp) (5)
where Wr is a weight function, and |Wr|>Δ.
In
Further, as in this invention, the block diagram for controlling the mixture sensibility problem can be one shown in
minimize ∥Twz
The transfer function Twz1 between w(=fh) and z1 corresponds to the error margin of the operational physical force fh and the velocity rv of the load. Sine the purpose of this computing means is to design the controller Kf so that it can give the steady velocity kp (m/s/N) as fast as possible for the stepped operational physical force, the weight function Ws is determined as the following expression.
Ws=l/s (7)
Above-mentioned controller Kf is obtained as follows. Specifically, since the sum of the order of the weight functions Wr, Ws and the normal transfer function P(s) is 2, the optimum controller is secondary. Therefore, the structure of the controller can be expressed as follows:
Kf=kp(as2+bs+c)/(s2+2ζωns+ωn2) (8)
where a and b are constants, c is a variable, s is a Laplacian operator [l/s], ζ is a damping coefficient, and ωn is a natural angular frequency.
Further, from the viewpoint of the robust stability, a=b=0. If assuming a≠0 and b≠0, there will be a case where the robust stability condition is not satisfied.
To satisfy the expression v=kp f in the steady state, the variable c is obtained as follows.
Accordingly, the analytical solution of the controller will be the following equation.
Kf=kpωn2/(s2+2ζωns+ωn2) (10)
At this time, the transfer function Twvr, Twz1, and Twz can be expressed as follows.
By the way, since the residual vibration or the transient overshoot of load W is very dangerous, and thus ζ′ should be more than 1.0. Accordingly, ζ is restricted as follows.
ζ>1.0−kpmωn/2 (12)
Further, from the robustness stability condition the norm |Twz2| of the transfer function is less than 1 as shown below.
The second term and the third term are less than 1 under the condition ζ′>=1. Accordingly, the following relation is obtained for ωn.
ωn<the square root of ωc/mkp (14)
Further, the controller should be designed so that the H2 norm of Twz1 is minimized. By the simple mathematics, the following expression is obtained from expression (11)
For that minimization, ζ′ should be as small as possible under the restriction. ζ′>=1.0, and ωn should be as large as possible under the restriction of expression (14). Accordingly, the following is obtained.
From the above consideration, the optimum robust controller as the computing unit is determined as follows.
At this time, the optimum H2 norm is expressed as follows.
The procedure to move the load W, suspended by the rope 2, by horizontally pushing it by the operator, is now explained. When the operator rightwardly pushes the load suspended by the rope 2, the computer of the second control means 7 carries out the following calculations to assist the operator in transferring the load W with the overhead traveling crane.
Specifically, the motion equations of the overhead traveling crane shown in
m·l
2
·d
2
θ/dt
2
−m·l·d
2
x/dt
2·cos θ+m·l·g·sin θ=F·l; and p=x+l·sin θ,
where m [kg] is the mass of the load, l [m] is the length of the rope, g [m/s2] is the gravitational acceleration, θ[rad] is the swaying angle of the rope, x [m] is the position of the truck 6, d2x/dt2 [m/s2] is the acceleration of the truck 6, F [N] is the operational physical force of the operator, and p [m] is the position of the load W.
Expression (1) is then linearly approximated by approaching the swaying angle θ to zero (θ→0), and the velocity of the truck 6 is further determined from swaying angle θ [rad] using the feedback gain Kf, as in the expression dx/dt=−Kfθ. Accordingly, the following expression (19) is obtained.
Further, the PID control action is carried out in the second control means 7. The term “a PID control action” herein denotes the combination of a P control action, which is a control action where the control input is proportional to the control error, an I control action, which is a control action where the control input is proportional to the integration value of the control error, and a D control action, which is a control action where the control input is proportional to the differentiation value. Accordingly, by replacing Kf in of expression (19) with Kf=Kp+Kds+Ki/s, expressions (20) and (21) are obtained.
When assuming Ki=0 in expression (21) for simplicity, expression (20) can be transformed into the following expression (22).
If the operator imposes an operational physical force on the load W that is suspended by a flexible structure having a small damping resistance such as the rope 2, the residual vibration of the load W may be feared. However, by giving the appropriate Kp by expression (22), ζ becomes greater than 0.707, allowing the load W to be operated with no vibration.
Further, the relation between the transfer velocity by the overhead traveling crane and the operational physical force by the operator becomes dp/dt=Kp/mg·F from expression (21) in ω<<ωn, and the transfer velocity proportional to the operational physical force is obtained.
Further, it is important that the overhead traveling crane reacts well in response to the change in the operational physical force of the operator to lighten his or her burden. In a word, making (on in expression (22) greater will allow the entire overhead traveling crane to quickly react. This will be achieved by setting the derivative gain Kd to be negative within the range of −1<the derivative gain Kd<0 from expression (22).
This can be explained as follows. The derivative gain Kd<0 means that the operator tries to move the truck 1 (the overhead traveling crane) in the direction opposite the direction of the operational physical force. Specifically, when the truck 6 is accelerated leftward in the negative direction in
Further, in the right term of expression (21) both the denominator and the numerator are secondary rational expressions that slightly differ. Accordingly, it can be linearly approximated the same as expression (23) in the area where ω is smaller than con.
This expression (23) is just a motion equation of the load W having the mass m·(Ki+g)/Ki [kg] when it is moved with no friction caused. Accordingly, if once the operator imposes the operational physical force F [N] on the load W, it will advance as if it were pushed in the zero gravity.
The experimental conditions on the controller are as shown in Table 1.
Further, in
An operation was carried out for placing a cope flask on a drag flask on the conditions similar to those for the above experiment, wherein both flasks were sized about 0.8 m in width and depth and about 0.4 m in height, weighed about 30 kg, and had pins or bushes for their registration. The cope flask was stably put on the flask with no vibration caused. The operator could raise and lower the flask-tight mold weighing from 10 to 500 kg, while he or she did not feel any burden. However, undesirably the system was sometimes unstably operated when the weight of the flask-tight mold exceeded 500 kg, due to the noise to the operational physical force. Further, the crane is unnecessary if the weight is less than 10 kg.
Further, some experiments were carried out to actually transfer the load W using the overhead traveling crane shown in
The PD control action used herein denotes a combination of a P control action, which is a control action where the control input (the operational physical force) is proportional to the control error, and a D control action, which is a control action where the control input (the operational physical force) is proportional to the differentiation value. Further, the PI control action denotes a combination of the P control action and an I control action, which is a control action where the control input (the operational physical force) is proportional to the integration value of the control error.
These gains are set as the values within an appropriate range, since they would be greatly influenced by higher-order modes that do not appear in the model if they were too large.
First, in a transfer experiment that uses the P control action, the operator imposed a staged constant operational physical force, and the transfer velocity of truck 1 (overhead traveling crane) was examined.
Further, a transfer experiment that uses the PD control action and a transfer experiment that uses the PI control action were conducted. The results of them are shown in
Further, it is confirmed that in the experiment for transferring the load of 10 kg in weight the load can be transferred by the operational physical force of 4N at the maximum. Further, though some swaying angle was influenced by the higher-order modes, the behavior of the experiment was in unison with that of the simulation, and the effectiveness of the model was verified.
Further, to verify the effect of the derivative gain, the difference of the behavior of it from the P control action was simulated, and the simulated results were shown in
The present invention can be used for many places provided with an overhead traveling cane. For instance, it can be used in the molding field for transferring and assembling flask and cores, also for welfare equipments and for the assembly sites in various industries such as assembly of automobiles.
a) is a graph showing an experiment of the transfer of the PD control action, and
Number | Date | Country | Kind |
---|---|---|---|
2004-335500 | Nov 2004 | JP | national |
2004-335721 | Nov 2004 | JP | national |
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/JP2005/021279 | 11/18/2005 | WO | 00 | 11/9/2007 |