NONLINEAR RESONANCE MODEL-BASED ACTIVE FILTERING CRANE STEEL ROPE RESONANCE ELIMINATION CONTROL METHOD
20220144596 · 2022-05-12
Assignee
- Wuhan University of Science and Technology (Wuhan, CN)
- Sinosteel Wuhan Safey&Environment Protection Research (Wuhan, CN)
Inventors
- Huikang LIU (Wuhan, CN)
- Sen LIN (Wuhan, CN)
- Xianhua WANG (Wuhan, CN)
- Qiangguang LU (Wuhan, CN)
- Lin CHAI (Wuhan, CN)
- Yikang ZU (Wuhan, CN)
- Zhou ZHOU (Wuhan, CN)
- Dongtian LIU (Wuhan, CN)
- Qing Yu (Wuhan, CN)
- Weijia WANG (Wuhan, CN)
Cpc classification
B66C13/16
PERFORMING OPERATIONS; TRANSPORTING
International classification
B66C13/16
PERFORMING OPERATIONS; TRANSPORTING
Abstract
A nonlinear resonance model-based active filtering crane steel rope resonance elimination control method, including: constructing a two-dimensional dynamic model of a bridge crane according to a Lagrange's equation; constructing a steel wire rope-motor nonlinear resonance model to detect a harmonic; and eliminating the harmonic by means of active filtering. The present disclosure makes in-depth study on positioning of a crane and intelligent control of an anti-swing and resonance elimination control system and uses active filtering to eliminate resonance between a heavy object and the steel wire rope, thereby reducing a swinging angle and achieving the rapid resonance elimination and anti-swing effect. The active filtering technology can quickly and effectively detect a resonance current so as to effectively suppress resonance between the heavy object and the steel wire rope, and further helps a controller quickly and accurately position a trolley to further improve anti-swing performance.
Claims
1. A nonlinear resonance model-based active filtering crane steel rope resonance elimination control method, comprising the following steps: S1: constructing a two-dimensional dynamic model of a bridge crane according to a Lagrange's equation; S2: constructing a steel wire rope-motor nonlinear resonance model to detect a harmonic; and S3: eliminating the harmonic by means of active filtering.
2. The nonlinear resonance model-based active filtering crane steel rope resonance elimination control method according to claim 1, wherein the dynamic model in S1 is specifically as follows:
3. The nonlinear resonance model-based active filtering crane steel rope resonance elimination control method according to claim 1, wherein the steel wire rope-motor nonlinear resonance model in S2 comprises a motor-drum model and a drum-steel wire rope model; a resonance torque on the motor shaft is not completely equal to the resonance torque on steel wire rope, a non-linear functional relationship exists, and through derivation and calculation, an equation is a second-order differential equation:
T.sub.eh=f(T.sub.Lh) (1-4) where the resonance torque on the motor shaft is represented by T.sub.eh, and the resonance torque on the steel wire rope is represented by T.sub.Lh; the motor-drum model is obtained by simplifying a main transmission system of the crane to a two-mass system composed of an alternating current asynchronous motor and a drum which are connected via an elastic shaft, and ignoring a damping of a connecting shaft; kinetic energy E and potential energy V of the two-mass system are as follows, respectively:
E=1/2J.sub.m(k{dot over (θ)}.sub.d).sup.2+1/2J.sub.L{dot over (θ)}.sub.d.sup.2 (1-5)
V=1/2K.sub.s(Kθ.sub.d−θ.sub.d) (1-6) a Lagrange function L of the two-mass system is expressed as:
L=T−V (1-7) two-mass system damping is ignored, and a generalized torque is defined as:
T.sub.e−T.sub.L=J.sub.mk{umlaut over (θ)}.sub.d+J.sub.L{umlaut over (θ)}.sub.d (1-12) in practice, the resonance torque generated by the resonance between a hoisted object and the steel wire rope cannot be ignored. The output torque of the motor is required to be T.sub.e, but due to a resonance, an actual output of the motor is as follows:
T.sub.eΣ=T.sub.e+T.sub.eh (1-13) T.sub.eΣ represents a sum of the torque on the motor shaft; equation (1-13) still satisfies (1-12), then:
T.sub.eΣ−T.sub.LΣ=J.sub.mk{umlaut over (θ)}.sub.d+J.sub.L{umlaut over (θ)}.sub.d (1-14) T.sub.LΣ represents the sum of a torque on the steel wire rope;
T.sub.LΣ=T.sub.L+T.sub.Lh (1-15) to make the output torque of the motor still be, the torque generated by a resonance needs to be eliminated, and the output torque of the motor after resonance elimination control is as follows:
T′.sub.eΣ=T.sub.eΣ−T.sub.eh=T.sub.e+T.sub.eh−T.sub.eh=T.sub.e (1-16) because T.sub.L represents the load torque, in a process of hoisting a heavy object by the crane, the mass of the heavy object does not change, and T.sub.L does not change. However, the resonance torque T.sub.Lh will be affected by wind force, an unsmooth gear and other factors, so T.sub.Lh changes all the time, where:
T.sub.Lh=m.Math.{umlaut over (φ)}(x,y,z).Math.l.sub.F (1-17) where {umlaut over (φ)}(x,y,z) represents a vibration acceleration, a second-order derivative of a vibration equation φ(x,y,z) with respect to time, of the steel wire rope; l.sub.F represents an arm of force of the resonance torque on the steel wire rope; and m represents the mass of the steel wire rope; because a vibration in a z axis direction is small and can be ignored, and the torque in an x axis direction and a y axis direction are substantially the same, a vibration equation φ(x) in the x axis direction and a vibration equation φ(y) in the y axis direction on the steel wire rope are the same; therefore, the resonance torque T.sub.Lh on the steel wire rope can be obtained only by knowing the vibration equation, equation φ(x), of the steel wire rope; the drum-steel wire rope model comprises construction of motion equations, simplification of the motion equations and an analytical solution of a vibration equation; the construction of the motion equations is that: an equivalent dynamic model for the vibration of the steel wire rope in the process of hoisting the heavy object by the steel wire rope at a uniform speed is analyzed according to Hamilton principle, and a mathematical model is constructed; and the simplification of the motion equations is that: a time variable and a space variable in derived motion equations are coupled. To separate the time variable and the space variable in the motion equations and eliminate the time variable, it is assumed that a time function is a harmonic function, and a Kantorovich time averaging method is used to obtain a dynamic nonlinear equation with only the space variable.
4. The nonlinear resonance model-based active filtering crane steel rope resonance elimination control method according to claim 3, wherein the construction of the motion equations is specifically as follows: the equivalent dynamic model for the vibration of the steel wire rope in the process of hoisting the heavy object by the steel wire rope at a uniform speed is analyzed according to the Hamilton principle, the mathematical model is constructed, and kinetic energy T.sub.1 of a Euler beam moving axially is as follows:
U.sub.2=∫.sub.0.sup.LP.sub.0(u.sub.,l+1/2w.sub.,l.sup.2)dl (1-22) according to the Hamilton variational principle:
δ∫.sub.t.sub.
ρAu.sub.,tt+(ρAv.sub.0.sup.2−EA)u.sub.,ll+2ρAv.sub.0u.sub.,lt−EAw.sub.,lw.sub.,ll=0 (1-24)
ρAw.sub.,tt+EIw.sub.,llll+(ρAv.sub.0.sup.2−P.sub.0)w.sub.,ll+2ρAv.sub.0w.sub.,lt−EA(w.sub.,lu.sub.,l+u.sub.,llw.sub.,l+3/2w.sub.,l.sup.2w.sub.,ll)=0 (1-25) where u.sub.,ll represents a second-order partial derivative of the function u with respect to l; and w.sub.,llll represents a fourth-order partial derivative of the function w with respect to l; because an axial strain torque of the Euler beam is equal to the inertia torque of the fixed-axis rotating drum, boundary conditions are as follows:
(ρAv.sub.0.sup.2−EA)u.sub.,ll−EAw.sub.,lw.sub.,ll=0 (1-30)
5. The nonlinear resonance model-based active filtering crane steel rope resonance elimination control method according to claim 3, wherein the simplification of the motion equations is that: w=
u=
R=−ω.sup.2ρA
EI
(v.sup.2−1)φ.sub.,ll−φ.sub.,lφ.sub.,ll=0 (1-39)
φ.sub.,llll+(Sv.sup.2−P)φ.sub.,ll−
6. The nonlinear resonance model-based active filtering crane steel rope resonance elimination control method according to claim 3, wherein the analytical solution of the vibration equation is that: all nonlinear terms in equation (1-40) are moved to a right side of the equation and are omitted, and then equation (1-40) can be transformed into:
φ.sub.,llll−
φ=a.sub.0M.sub.0(x)+a.sub.1N.sub.0(x)+a.sub.2I.sub.0(x)+a.sub.3K.sub.0(x) (1-46) where
Description
BRIEF DESCRIPTION OF DRAWINGS
[0040]
[0041]
[0042]
[0043]
[0044]
[0045]
[0046]
DETAILED DESCRIPTION OF THE EMBODIMENTS
[0047] The present disclosure will be further described below with reference to the accompanying drawings.
[0048] In
[0049] m represents the mass of hoisted goods (unit: kg);
[0050] x represents a displacement of the trolley (unit: m);
[0051] l represents the length of a steel rope (unit: m);
[0052] F represents the traction on the trolley (unit: N);
[0053] f.sub.r represents the friction on the trolley (unit: N);
[0054] f.sub.l represents the tension on the steel wire rope (unit: N);
[0055] θ represents a swinging angle of the load, i.e. a first-grade swinging angle (unit: rad); and
[0056] g represents the gravitational acceleration (unit: n/kg).
[0057] Step 1: a two-dimensional dynamic model of a bridge crane is constructed according to a Lagrange's equation:
[0058] therefore, the dynamic model of the crane is:
[0059] if the output torque of a motor is represented by T.sub.m, according to an equation of T.sub.m=F*r.sub.1, the following equation is obtained:
[0060] where r.sub.1 represents a radius of a motor shaft.
[0061] Therefore, the size of the traction on the trolley may be controlled by the output torque of the motor.
[0062] The output torque is reflected by a current, so the output torque can be controlled by the current.
[0063] Step 2: a steel wire rope-motor nonlinear resonance model is constructed to detect a harmonic, and the harmonic is eliminated by means of active filtering.
[0064] A power supply is connected, a rotation speed of the motor is controlled by a frequency converter, the rotation of the motor generates one torque, the trolley is driven forward by a gearbox, and the forward movement of the trolley will drive the load to move; an unsmooth mechanical arm, anti-swing control and external interference such as wind and wave make the heavy object resonate with the steel wire rope to generate a resonance signal which is transmitted to the motor shaft through the mechanical transmission and reflected on the operating torque of the motor.
[0065] Because the steel wire rope is in mechanical flexible hard connection with the motor, the torque on the steel wire rope is in one-to-one correspondence with the torque on the motor shaft, and when the resonance occurs on the steel wire rope, the resonance signal will be transmitted to the motor shaft via the trolley and the gearbox to make the motor shaft generate one resonance torque. If mechanical equipment such as the mechanical arm and the gear box are smooth, the resonance torque on the steel wire rope has a linear functional relationship with the resonance torque on the motor shaft; and however, because the trolley moves on the unsmooth mechanical arm, the gearbox cannot be completely smooth, and when the resonance torque on the steel wire rope is transmitted to the motor shaft, signal attenuation may exist, so the resonance torque on the motor shaft is not completely equal to the resonance torque on the steel wire rope, a non-linear functional relationship exists, and through derivation and calculation, an equation is a second-order differential equation:
T.sub.eh=f(T.sub.Lh) (1-4)
[0066] where the resonance torque on the motor shaft is represented by T.sub.eh, and the resonance torque on the steel wire rope is represented by T.sub.Lh.
[0067] For a fixed crane system, the motor shaft and the steel wire rope are respectively provided with a torque sensor, and a functional relationship is approximately fitted through a large number of experimental data. However, the method is not universal, and the fitted function is not accurate. Therefore, the present disclosure derives the second-order differential equation by means of theoretical analysis and modeling, obtains its numerical solution, determines the nonlinear resonance torque of the steel wire rope in real time, reduces it to the resonance torque on the motor shaft, and then determines the size of a nonlinear resonance current on the motor shaft.
[0068] To facilitate the study on a resonance phenomenon in a main transmission system of the crane, the main transmission system may be simplified to a shafting system composed of a plurality of inertia elements and elastic elements, and then a dynamic model of the main transmission system of the crane is constructed.
[0069] Simplification rules are as follows: in the main transmission system of the crane, an element with relatively large mass and relatively small elasticity is simplified as an inertia element by ignoring the elasticity; and an element with relatively large elasticity and relatively small mass is simplified as an elastic element by ignoring the mass. Through these rules, the main transmission system may be represented by a four-mass spring system, as shown in
[0070] I. Motor-Drum Model
[0071] To facilitate the analysis and study, the main transmission system of the crane is further simplified to a two-mass system composed of an alternating current asynchronous motor and a drum which are connected via an elastic shaft, the damping of the connecting shaft is ignored, and the two-mass system is shown in
[0072] T.sub.e, T.sub.s, and T.sub.L represent the electromagnetic torque of the motor, the torque of the connecting shaft, and the load torque of the drum (N.Math.m), respectively;
[0073] J.sub.m and J.sub.L represent the rotational inertia of the motor and the rotational inertia of the drum (kg.Math.m.sup.2), respectively;
[0074] ω.sub.m and ω.sub.L represent an angular speed of the motor and an angular speed of the drum (rad/s), respectively;
[0075] kθ.sub.d and θ.sub.d represent a rotation angle of the motor and a rotation angle of the drum (k is a constant) (rad), respectively;
[0076] θ.sub.x and θ.sub.y represent swinging angles of the steel wire rope in x and y axis directions (rad), respectively; and
[0077] K.sub.s represents a stiffness coefficient of the elastic shaft (N.Math.m/rad).
[0078] Kinetic energy E and potential energy V of the two-mass system are as follows, respectively:
E=1/2J.sub.m(k{dot over (θ)}.sub.d).sup.2+1/2J.sub.L{dot over (θ)}.sub.d.sup.2 (1-5)
V=1/2K.sub.s(Kθ.sub.d−θ.sub.d) (1-6)
[0079] A Lagrange function L of the system is expressed as:
L=T−V (1-7)
[0080] System damping is ignored, and the generalized torque is defined as:
[0081] where i=1,2; j=1,2; θ.sub.1=kθ.sub.d; θ.sub.2=θ.sub.d, q.sub.j represents a generalized coordinate; F.sub.i and represents the generalized external torque.
[0082] In an ideal case (that is, without considering the resonance), the generalized external torque is defined as:
[0083] According to the Lagrange theorem, a Lagrange equation of the system is as follows:
[0084] Equations (1-5) to (1-9) are substituted into equation (1-10), and an electromechanical coupling nonlinear dynamic equation of the main transmission system of the crane can be obtained:
[0085] where k{umlaut over (θ)}.sub.d and {umlaut over (θ)}.sub.d represent the rotational angular acceleration of the motor and the rotational angular acceleration of the drum (rad/s.sup.2), respectively.
[0086] Equation (1-11) is simplified to obtain the following equation:
T.sub.e−T.sub.L=J.sub.mk{umlaut over (θ)}.sub.d+J.sub.L{umlaut over (θ)}.sub.d (1-12)
[0087] However, in practice, the resonance torque generated by the resonance between the hoisted object and the steel wire rope cannot be ignored. The output torque of the motor is required to be T.sub.e, but due to the resonance, the actual output of the motor is as follows:
T.sub.eΣ=T.sub.e+T.sub.eh (1-13)
[0088] T.sub.eΣ represents the sum of the torque on the motor shaft.
[0089] equation (1-13) still satisfies equation (1-12), then:
T.sub.eΣ−T.sub.LΣ=J.sub.mk{umlaut over (θ)}.sub.d+J.sub.L{umlaut over (θ)}.sub.d (1-14)
[0090] T.sub.LΣ represents the sum of the torque on the steel wire rope.
T.sub.LΣ=T.sub.L+T.sub.Lh (1-15)
[0091] Therefore, to make the output torque of the motor still be T.sub.e, the torque T.sub.eh generated by the resonance needs to be eliminated, and then the output torque of the motor after resonance elimination control is as follows:
T′.sub.eΣ=T.sub.eΣ−T.sub.eh=T.sub.e+T.sub.eh−T.sub.eh=T.sub.e (1-16)
[0092] Because T.sub.L represents the load torque, in the process of hoisting the heavy object by the crane, the mass of the heavy object does not change, and T.sub.L does not change. However, the resonance torque T.sub.Lh will be affected by wind force, the unsmooth gear and other factors, so T.sub.Lh changes all the time, where:
T.sub.Lh=m.Math.{umlaut over (φ)}(x,y,z).Math.l.sub.F (1-17)
[0093] where
[0094] Because a vibration in a Z axis direction is small and can be ignored, and the sizes of the torque in the X axis direction and the Y axis direction are substantially the same, a vibration equation φ(x) in the X axis direction and a vibration equation φ(y) in the y axis direction on the steel wire rope are the same.
[0095] Therefore, the resonance torque T.sub.Lh on the steel wire rope can be obtained only by knowing the vibration equation (i.e. the equation φ(x)) of the steel wire rope. The vibration equation of the steel wire rope will be derived below by analyzing a drum-steel wire rope model.
[0096] II. Drum-Steel Wire Rope Model
[0097] As the steel wire rope is an elastic continuum, the steel wire rope can be considered as an isotropic uniform beam when studying the transverse and longitudinal motion of the steel wire rope, and vibrations of the steel wire rope are equivalent to transverse and longitudinal vibrations of a Euler beam. The drum is equivalent to a rigid inertia element, i.e. a fixed-axis rotating disk with the same width as the Euler beam. Therefore, the vibrations of the steel wire rope on the drum are equivalent to the transverse and longitudinal vibrations of the Euler beam moving axially under the inertial boundary conditions, and the drum-steel wire rope dynamic model is shown in the FIG. In the FIG, a longitudinal motion direction of the steel wire rope can be regarded as an axial motion direction of the Euler beam, if the steel wire rope moves at a constant speed, the tensions at upper and lower ends of the steel wire rope are represented by F1 and F2, respectively, it is assumed that F.sub.1=F.sub.2=P.sub.0, P.sub.0 represents a tension value, ω.sub.L represents the angular speed of the drum, J.sub.L represents the rotational inertia of the drum, w and u represent displacement components of horizontal and vertical coordinates, respectively, and l represents the length of the Euler beam (the initial length thereof is represented by L), i.e. the length of the steel wire rope between the drum and the heavy object, as shown in
[0098] 1. Construction of Motion Equations
[0099] An equivalent dynamic model for the vibration of the steel wire rope in the process of hoisting the heavy object by the steel wire rope at an uniform speed is analyzed according to the Hamilton principle, a mathematical model is constructed, and kinetic energy T.sub.1 of the Euler beam moving axially is as follows:
[0100] where ρ represents the density of the steel wire rope;
[0101] A represents a cross-sectional area of the Euler beam;
[0102] v.sub.0 represents an axial motion speed of the Euler beam;
[0103] w.sub.,t represents a first-order partial derivative of a function w with respect to a variable t;
[0104] w.sub.,l represents a first-order partial derivative of the function w with respect to a variable l;
[0105] u.sub.,t represents a first-order partial derivative of a function u with respect to the variable t; and
[0106] u.sub.,l represents a first-order partial derivative of the function u with respect to the variable l;
[0107] by analogy, other same symbols indicate similar meanings.
[0108] Deformation potential energy U.sub.1 of the Euler beam is as follows:
[0109] where ε.sub.l represents the strain of the beam;
[0110] E represents an elasticity modulus;
[0111] I represents the inertia torque; and
[0112] w.sub.,ll represents a second-order partial derivative of the function w with respect to l.
[0113] Kinetic energy T.sub.2 of the drum is as follows:
[0114] where r.sub.2 represents a radius of the drum.
[0115] Potential energy U.sub.2 generated by the tension P.sub.0 acting in an l direction is as follows:
[0116] where s represents an actual motion direction of the vibration of the steel wire rope.
[0117] The Taylor series expansion is used and higher order terms above the third order are omitted, and axial tension potential energy U.sub.2 of the Euler beam is as follows:
U.sub.2=∫.sub.0.sup.LP.sub.0(u.sub.,l+1/2w.sub.,l.sup.2)dl (1-22)
[0118] According to the Hamilton variational principle:
δ∫.sub.t.sub.
[0119] where t.sub.1,t.sub.2 represent the starting and ending time of motion.
[0120] The motion equations of the Euler beam can be derived:
ρAu.sub.,tt+(ρAv.sub.0.sup.2−EA)u.sub.,ll+2ρAv.sub.0u.sub.,lt−EAw.sub.,lw.sub.,ll=0 (1-24)
ρAw.sub.,tt+EIw.sub.,llll+(ρAv.sub.0.sup.2−P.sub.0)w.sub.,ll+2ρAv.sub.0w.sub.,lt−EA(w.sub.,lu.sub.,l+u.sub.,llw.sub.,l+3/2w.sub.,l.sup.2w.sub.,ll)=0 (1-25)
[0121] where u.sub.,ll represents a second-order partial derivative of the function u with respect to l; and
[0122] w.sub.,llll represents a fourth-order partial derivative of the function w with respect to l.
[0123] Because the axial strain torque of the Euler beam is equal to the inertia torque of the fixed-axis rotating drum rotating, the boundary conditions are as follows:
[0124] where w(0) represents a vibration displacement of the steel wire rope when l=0.
[0125] w(L) represents a vibration displacement of the steel wire rope when l=L;
[0126] w.sub.,ll(0) represents a second-order partial derivative of the vibration displacement of the steel wire rope when l=0 with respect to l;
[0127] w.sub.,ll(L) represents a second-order partial derivative of the vibration displacement of the steel wire rope when l=L with respect to l;
[0128] w.sub.max represents the maximum displacement of the steel wire rope in the x axis direction; and
[0129] φ.sub.m represents the maximum amplitude of the steel wire rope.
[0130] Usually, the kinetic energy of the axial motion caused by the vibration of the steel wire rope is relatively small, so u.sub.,t=u.sub.,tt=0 is satisfied, and equation (1-24) can be simplified to:
(ρAv.sub.0.sup.2−EA)u.sub.,ll−EAw.sub.,lw.sub.,ll=0 (1-30)
[0131] 2. Simplification of the Motion Equations
[0132] A time variable and a space variable in the motion equations derived above are coupled. To separate the time variable and the space variable in the motion equations and eliminate the time variable, it is assumed that a time function is a harmonic function, and a Kantorovich time averaging method is used to obtain a dynamic nonlinear equation with only the space variable.
[0133] w=
u=
[0134] where
[0135]
[0136] the determined u and w are respectively substituted into equation (1-25), and the equation is transformed into:
R=−ω.sup.2ρA
[0137] where
[0138]
[0139]
[0140]
[0141]
[0142] The Kantorovich time averaging method is applied to an interval of [0,2π/
[0143] that is
EI
[0144] Similarly, u and w are respectively substituted into equations (1-26) to (1-29), and according to an equation of
[0145] the boundary conditions are simplified to:
[0146] where
[0147]
[0148]
[0149]
represents a vibration amplitude of the steel wire rope when
and
[0150]
[0151] To simplify the following calculation, dimensionless quantities are introduced:
[0152] The above equations are substituted into equations (1-30) and (1-34) and the boundary conditions (1-35) to (1-38) for nondimensionalization, and the motion equations of the Euler beam are sorted as follows:
(v.sup.2−1)φ.sub.,ll−φ.sub.,lφ.sub.,ll=0 (1-39)
φ.sub.,llll+(Sv.sup.2−P)φ.sub.,ll−
[0153] where φ.sub.,l represents the first-order partial derivative of φ with respect to l;
[0154] φ.sub.,ll represents the second-order partial derivative of φ with respect to l;
[0155] φ.sub.,llll represents the fourth-order partial derivative of φ with respect to l;
[0156] ϕ.sub.,l represents the first-order partial derivative of ϕ with respect to l; and
[0157] ϕ.sub.,ll represents the second-order partial derivative of ϕ with respect to l;
[0158] the boundary conditions are as follows:
[0159] where φ(0) represents the vibration amplitude of the steel wire rope when l=0;
[0160] φ(1) represents the vibration amplitude of the steel wire rope when l=1;
[0161] φ.sub.,ll(0) represents the second-order partial derivative of the vibration amplitude of the steel wire rope when l=0 with respect to l;
[0162] φ.sub.,ll(1) represents the second-order partial derivative of the vibration amplitude of the steel wire rope when l=1 with respect to l;
[0163] φ(½) represents the vibration amplitude of the steel wire rope when l=½; and
[0164] φ.sub.m represents a maximum vibration amplitude of the steel wire rope.
[0165] 3. Analytical Solutions of the Motion Equations
[0166] First, all non-linear terms in equation (1-40) are moved to the right side of the equation and are omitted, and then equation (1-40) can be transformed into:
φ.sub.,llll−
[0167] A series expansion solution of equation (1-45) when x=0 is determined:
φ=a.sub.0M.sub.0(x)+a.sub.1N.sub.0(x)+a.sub.2I.sub.0(x)+a.sub.3K.sub.0(x) (1-46)
[0168] where
[0169] Then, φ(x) is substituted into the boundary conditions (1-43) and (1-44) to determine coefficients:
[0170] So that the following equation is obtained:
is satisfied,
[0171] and then an amplitude at a position l satisfies φ(l)=φ.sub.m.Math.k(l).
[0172] Swinging angles in the x and y axis directions are measured by a tilt sensor and are subject to Fourier transformation to calculate
[0173] Because φ(l.sub.0)=(l(k)−l.sub.0).Math.θ.sub.max,
[0174] where l.sub.0 represents a distance from the tilt sensor to a main hook;
[0175] φ(l.sub.0) represents a vibration amplitude at a position l.sub.0; and [0176] θ.sub.max represents the maximum θ.sub.x or θ.sub.y measured by the tilt sensor.
[0177] D.sub.k=φ.sub.m.Math.(−
[0178] Based on above, a steel wire rope-motor shaft nonlinear resonance torque model can be obtained:
[0179] T.sub.eh represents the torque size of the nonlinear resonance torque on the steel wire rope transmitted to the motor shaft.
[0180] The length l(k) of the rope and the rotation angle θ.sub.d(k) of the drum in the process of hoisting the heavy object can be measured by an absolute value encoding disc; the swinging angles θ.sub.x(k) and θ.sub.y(k) of the steel wire rope can be measured by the tilt sensor, and then the vibration frequency
[0181] III. Resonance Current Elimination by Means of Active Filtering
[0182] The relationship between the resonance torque on the steel wire rope and the resonance torque on the motor shaft has been derived above, and the resonance torque on the steel wire rope can be eliminated by eliminating the resonance torque on the motor shaft, while the torque actually output by the motor is reflected by a current:
T.sub.eΣ=C.sub.mϕi.sub.Σ=C.sub.mϕ(i.sub.T+i.sub.h) (1-50)
[0183] where i.sub.T represents an armature torque current, i.sub.h represents a harmonic current generated by the resonance, C.sub.m represents a torque coefficient, and ϕ represents the magnetic flux.
[0184] The harmonic current generated by the resonance on the steel wire rope will be added to an operating torque current of the motor, and the measured resonance torque on the wire rope is fed back to the system through the resonance current i.sub.Lh by using the continuity and immutability characteristics of the current.
[0185] How to eliminate the resonance on the steel wire rope? When the heavy object resonates with the steel wire rope, a resonance signal is generated, which is regarded as an external interference. The interference signal can be completely reproduced only by knowing the phase and amplitude of the interference signal, and a desired signal component is obtained by deducting the interference signal from an original signal. Therefore, the resonance current generated on the motor shaft due to the resonance on the steel wire rope can be counteracted by generating a current with a size equal to and a phase opposite to the resonance current on the motor shaft, thereby eliminating the resonance on the motor shaft and further eliminating the resonance on the steel wire rope. The method is called active filtering.
[0186] By measuring a current resonance current i.sub.h(k) on the motor shaft and because of the continuity, immutability and derivability of the current, a resonance current i.sub.h(k+1) on the motor shaft in the next sampling period can be estimated:
[0187] where T represents a sampling period of the motion control of the motor.
[0188] The operation of the trolley is controlled by a vector which is adjusted according to the constant magnetic flux, and a magnetic flux current is constant and does not change, so that the resonance elimination and anti-swing purpose can be achieved by adding a current with a size equal to and a direction opposite to the resonance current to the armature current i.sub.T:
i′.sub.T(k+1)=i.sub.T(k+1)+[−i.sub.h(k+1)] (1-52)
[0189] where i.sub.T(k+1) represents an armature current on the motor shaft in the next period without control; and
[0190] i′.sub.T(k+1) represents an armature current on the motor shaft in the next period with control.
[0191] For the convenience of control, a three-phase current output from the motor needs to be converted into direct-axis and quadrature-axis currents, and a two-phase rotating current also needs to be converted into a three-phase current capable of controlling PWM through vector transformation, so the vector transformation is needed.
[0192] The vector transformation control is based on coordinate transformation according to the following three principles:
[0193] 1. Magnetomotive forces generated at different coordinates are the same;
[0194] 2. Power does not change before and after transformation; and
[0195] 3. A current transformation matrix and a voltage transformation matrix are unified.
[0196] (1) CLARK Transformation
[0197] The transformation between a three-phase static winding A-B-C and a two-phase static winding α-β, or the transformation between a three-phase static coordinate system and a two-phase static coordinate system, is called CLARK transformation, which is called 3/2 transformation for short, as shown in
[0198] The α axis is coincided with the A axis, and instantaneous magnetomotive forces of the two sets of windings in the α axis and β axis are equal.
[0199] A matrix is written as follows:
[0200] where i.sub.α,i.sub.β represent currents in the two-phase static coordinate system: and i.sub.a,i.sub.b,i.sub.c represent currents in the three-phase static coordinate system.
[0201] The inverse transformation of the matrix is as follows:
[0202] (2) PARK Transformation
[0203] The transformation from the two-phase static coordinate system α-β to a two-phase rotating coordinate system d-q is called two-phase rotation transformation or PARK transformation, which is called C.sub.2r/2s transformation for short, where s represents a stationary state and r represents rotation.
[0204] The two coordinate systems are drawn together to obtain
[0205] It can be seen from the FIG. that relationships between i.sub.α, i.sub.β, i.sub.d, and i.sub.q are as follows:
[0206] where i.sub.d,i.sub.q represent currents in the two-phase rotating coordinate system; and θ.sub.l represents an included angle between the d, α axes.
[0207] A matrix is written as follows:
[0208] where:
[0209] The inverse transformation is as follows:
[0210] In step 2, the steel wire rope-motor shaft nonlinear resonance torque model is derived, and the resonance torque and resonance current on the motor shaft are derived through the model. Meanwhile, how to use the current to control the output torque of the motor to further control the crane model in step 1 so as to quickly achieve the anti-swing and resonance elimination effect is introduced in details, and step 3 is a specific description of a design method of resonance elimination control.
[0211] Step 3: resonance elimination control is designed based on an active filtering technology.
[0212] A principle of the system is shown in
[0213] In the FIG, n* represents a per-unit value of a given rotation speed, n.sub.f represents a per-unit value of a feedback rotation speed, T.sub.e* represents a per-unit value of the armature torque, i.sub.T* represents a per-unit value of an armature current, ø* represents a per-unit value of the magnetic flux, i.sub.ø* represents a per-unit value of a magnetic flux current, T.sub.f represents the feedback torque, and it represents a feedback current.
[0214] When a rotation speed n of the motor is given, the magnetic flux ϕ is also determined according to following equation:
[0215] where f represents a supply frequency; and
[0216] E represents an electromotive force of a coil.
[0217] A relationship between the armature current i.sub.T and the armature torque T.sub.e is as follows:
T.sub.e=C.sub.eϕi.sub.T (1-60)
[0218] where C.sub.e represents a constant of the electromagnetic torque.
[0219] A relationship between the magnetic flux current i.sub.ø is and the rotation speed n is as follows:
E=C.sub.eni.sub.ϕ (1-61)
[0220] It can be seen from
[0221] The basic principles and main features of the present disclosure as well as the advantages of the present disclosure are described above. Those skilled in the art should understand that the present disclosure is not limited to the above embodiments, the above embodiments and the description are merely used to explain the principles of the present disclosure, various changes and improvements may further be made to the present disclosure without departing from the spirit and scope of the present disclosure, and all of these changes and improvements shall fall within the scope of protection of the present disclosure. Therefore, the scope of protection of the present disclosure shall be defined by the appended claims and equivalents thereof.