Servo press control method based on differential homeomorphism

By establishing a dynamic model in a servo press using the Lagrange equation and differential homeomorphism transformation, and combining it with a PI control algorithm, high-precision trajectory tracking control of the servo press was achieved, solving the problems of nonlinear inertia influence and poor trajectory accuracy in traditional methods.

CN118927704APending Publication Date: 2024-11-12李琦
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411333159.5
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-24
Publication Date
2024-11-12

AI Technical Summary

Technical Problem

Traditional servo press motor control methods suffer from the nonlinearity of rotational inertia in the model affecting the PI parameter adjustment response, and relying solely on kinematic relationships leads to poor trajectory tracking control accuracy.

Method used

The dynamic equations of the servo press are established using the Lagrange equations. The system is then transformed into an affine nonlinear system through differential homeomorphism transformation. State feedback is designed to eliminate nonlinear terms, and a PI control algorithm is used for linear control. The given torque and current of the motor are calculated, and PWM wave control is performed in conjunction with the stator voltage equation.

Benefits of technology

It improves the trajectory tracking control accuracy of servo presses and is suitable for servo presses with various transmission structures.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118927704A_ABST
    Figure CN118927704A_ABST
Patent Text Reader

Abstract

The invention belongs to the field of power electronics and motor control, and particularly relates to a differential homeomorphism-based servo press control method, which comprises the following steps of: performing dynamic model modeling on a servo press, converting a dynamic model with an affine nonlinear system into a linear dynamic model by adopting a differential homeomorphism nonlinear system control method, and performing differential homeomorphism on the linear dynamic model. Then, a PI control algorithm is adopted as a control strategy of a linear control algorithm, the linear control algorithm is adopted to complete accurate track control over the servo press, the control precision is remarkably improved, and the method is suitable for servo presses of various transmission structures.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention belongs to the field of power electronics and motor control, and in particular relates to a servo press control method based on differential homeomorphism. Background Art

[0002] The servo press is an important component of the industrial machine, and high-precision flexible trajectory tracking is an important feature of the servo press. The motor control method in the traditional servo press is mainly cascade magnetic field oriented control. For example, the invention patent with announcement number CN117227242B of Shenzhen Tianliyue Technology Co., Ltd. discloses a cascade magnetic field oriented control method. Since the traditional cascade magnetic field oriented control adopts position loop PI, speed loop PI, current loop PI, plus coordinate transformation matrix and SVPWM for control, the traditional servo press control method has the following problems:

[0003] (1) The moment of inertia in the servo press model is a typical nonlinear problem, which will affect the adjustment response of the PI parameters to the system;

[0004] (2) If we rely solely on kinematic relationships without considering the transmission of force and acceleration, and only consider the corresponding relationship of position, the trajectory tracking control accuracy of the system will deteriorate. Summary of the invention

[0005] In order to solve the deficiencies of the prior art, the present invention provides a servo press control method based on differential homeomorphism.

[0006] The present invention is achieved through the following technical solutions:

[0007] A servo press control method based on differential homeomorphism comprises the following steps:

[0008] Step 1: Use the Lagrange equation to establish the dynamic equation of the servo press.

[0009] Step 2: Express the dynamic equation of the servo press as an affine nonlinear system of differential homeomorphic transformation, gradually differentiate the output function y until the input u appears, design the state feedback v to eliminate the nonlinear term, and calculate the nonlinear state feedback expression of the system.

[0010] Step 3: Use the PI control algorithm as the control strategy of the linear control algorithm to set the crank to a given angle and crank feedback angle θ c As the input of the proportional-integral link, the state feedback v of the linear control algorithm is obtained.

[0011] Step 4: Substitute the state feedback v obtained in step 3 into the nonlinear state feedback expression of the system in step 2 to obtain u. Divide u by the reduction ratio of the reducer to obtain the motor given torque T. e * , through the motor given torque T e * The given current of the motor at the k+1th moment is calculated.

[0012] Step 5: Calculate the feedback value of the quadrature-axis current at the k+1th moment and the feedback value of the direct-axis current at the k+1th moment according to the stator voltage equation.

[0013] Step 6: Substitute the given current of the motor at the k+1th moment, the feedback value of the quadrature-axis current at the k+1th moment, and the feedback value of the direct-axis current at the k+1th moment into the value function, and apply the voltage vector that obtains the minimum value of the value function to the power module to output a PWM wave to control the motor operation.

[0014] Further, as a preferred solution:

[0015] In the step 1, the dynamic equation of the servo press is established using the Lagrange equation:

[0016]

[0017] Among them, τ c is the crank load torque; M(θ c ) is the inertia coefficient; N(θ c ) is the eccentricity coefficient of the press; is the crank feedback angular acceleration; is the crank feedback angular velocity.

[0018] The step 2 specifically includes the following steps:

[0019] The dynamic equation of the servo press can be transformed into:

[0020]

[0021] Then, formula (35) is expressed as the affine nonlinear system of differential homeomorphism transformation as follows:

[0022]

[0023] y=h (36),

[0024] in, h=[x1](40);u=[τ c ](41); Among them, f and g are smooth vector fields on the second-order system; h is a smooth scalar function on the second-order system;

[0025] The output function y is gradually differentiated until the input u appears.

[0026]

[0027] Design status feedback v:

[0028]

[0029] Among them, β0, β1, and β2 are configuration parameters;

[0030]

[0031] The nonlinear state feedback expression of the system is obtained:

[0032]

[0033] in,

[0034] In step 3, the state feedback v expression of the linear control algorithm is:

[0035]

[0036] Among them, k p Represents the position error coefficient, which is a constant; k i Represents the speed error coefficient, which is a constant; Indicates the given crank angle; θ c Indicates the crank feedback angle; Acc indicates the angle within each control cycle The accumulation of values.

[0037] The step 4 specifically includes the following steps:

[0038] Motor given torque T e * The expression is:

[0039]

[0040] The given current i of the motor at the k+1th moment q *(k+1) is expressed as:

[0041]

[0042] Among them, ψ f is the permanent magnet flux; p is the number of motor pole pairs; according to formula (56) and formula (57), the given current i of the motor at the k+1th moment can be calculated: q *(k+1).

[0043] The specific steps of step five are:

[0044] The stator voltage equation is:

[0045]

[0046] in:

[0047] ψ d =L d i d +ψ f (60),

[0048] ψ q =L q i q (61),

[0049] Above, V d is the direct-axis voltage; V q is the quadrature axis voltage; i d is the direct axis current; i q is the quadrature axis current; R is the stator resistance; ω e is the electrical angular velocity; ψ d is the direct-axis stator flux; ψ q is the quadrature-axis stator flux; ψ f is the permanent magnet flux; L d is the direct-axis inductance; L q is the quadrature-axis inductance.

[0050] According to the stator voltage equation, using Euler's forward approximation rule, the current value at the kth moment can be calculated to get the current value at the k+1th moment:

[0051]

[0052] Among them, i q (k) is the feedback value of the quadrature-axis current at the kth moment; i q (k+1) is the feedback value of the quadrature axis current at the k+1th moment; i d (k) is the feedback value of the direct axis current at the kth moment; i d (k+1) is the feedback value of the direct-axis current at the k+1th moment; T s is the control period; V d (k) is the direct-axis voltage at the kth moment; V q (k) is the quadrature axis voltage at the kth moment.

[0053] In step 6, the value function is:

[0054] g=|i q *(k+1)-i q (k+1)|+|i d *(k+1)-i d(k+1)| (66),

[0055] Among them, i d * (k+1) represents the given value of the direct-axis current at the k+1th moment, i d * (k+1)=0.

[0056] Beneficial effects of the present invention:

[0057] The present invention conducts dynamic modeling of a servo press, adopts a differential homeomorphism nonlinear system control method, converts the dynamic model with an affine nonlinear system into a linear dynamic model, and then adopts a linear control method to complete precise trajectory control of the servo press, thereby significantly improving control accuracy and being applicable to servo presses of various transmission structures. BRIEF DESCRIPTION OF THE DRAWINGS

[0058] Figure 1 This is a control algorithm block diagram of the present invention. DETAILED DESCRIPTION

[0059] Specific embodiments of the present invention are given below. It should be noted that the present invention is not limited to the following specific embodiments, and all equivalent changes made on the basis of the technical solution of this application fall within the protection scope of the present invention.

[0060] The technical solution for implementing the present invention is as follows:

[0061] Step 1: Use the Lagrange equation to establish the dynamic equation of the servo press.

[0062] The dynamic equation of the servo press is established using the Lagrange equation:

[0063]

[0064] Among them, τ c is the crank load torque; Γ is the Lagrangian function, Γ=E k -E p (2), E k is the kinetic energy of the crank-connecting rod mechanical structure, E p is the gravitational potential energy of the press transmission system, which can be regarded as E p =0;

[0065] The kinetic energy E of the crank-connecting rod mechanical structure in the above formula (2) is k The calculation is as follows:

[0066] E k =E c +E l +E s +E m (3)

[0067] Where E c Represents the kinetic energy of the crank; E l Represents the kinetic energy of the connecting rod; E s Represents the kinetic energy of the slider; E m Represents the kinetic energy of the motor and reducer; the expressions of each kinetic energy are:

[0068]

[0069] in,

[0070] Among them, J p J is the moment of inertia of the servo press viewed from the crank side; c is the moment of inertia of the crank rotating around the central rotation point of the crank structure; J l is the moment of inertia of the connecting rod rotating around the center of mass of the slider; J g is the moment of inertia of the motor and reducer; v l is the velocity of the connecting rod midpoint; v s is the speed of the slider; ω m is the angular velocity of the motor; m s is the mass of the slider; m l is the mass of the connecting rod; θ c is the crank feedback angle; is the crank feedback angular velocity; φ is the angle of the connecting rod rotating clockwise from the top dead center to the current position; r is the crank radius; l is the connecting rod length; n is the reduction ratio of the reducer.

[0071] Substituting the above formulas (2)-(11) into formula (1), the dynamic equation of the servo press can be changed to the following equation:

[0072]

[0073] Among them, M(θ c ) is the inertia coefficient, i.e. the rotational inertia J of the servo press viewed from the crank side p ; N(θ c ) is the eccentricity coefficient of the press; is the crank feedback angular acceleration; M(θ c ) and N(θ c ) are:

[0074] M(θ c )=A1+A2+A3+A4+A5+A6+J g *n 2 (13)

[0075] N(θc )=B1+B2+B3+B4+B5+B6+B7+B8+B9 (14),

[0076] Among them,

[0077] A1=J c (15),

[0078] A2=J l r 2 cos 2 (i c ) / B0 2 (16),

[0079] A3=2ar 2 sin 2 (i c ) (17),

[0080] A4=2br 3 sin 2 (i c )cos(θ c ) / B0 (18),

[0081] A5=2cr 4 sin 2 (i c )cos 2 (i c ) / B0 2 (19),

[0082] A6=m l r 2 / 4 (20),

[0083] B1=J l r 4 sin(θ c )cos 3 (i c ) / B0 4 (21),

[0084] B2=J l r 2 sin(θ c )cos(θ c ) / B0 2 (22),

[0085] B3=2ar 2 sin(θ c )cos(θ c ) (23),

[0086] B4=blr 3sin(θ c )cos 2 (θ c )*cos(F) / B0 2 (twenty four),

[0087] B5=-br 3 sin(θ c ) / B0 (25),

[0088] B6=2br 5 sin 3 (θ c )cos 2 (θ c ) / B0 3 (26),

[0089] B7=2clr 4 sin(θ c )cos 2 (θ c )cos(F) / B0 3 (27)

[0090] B8=-2cr 4 sin 3 (θ c )cos(θ c ) / B0 2 (28)

[0091] B9=2cr 6 sin 3 (θ c )cos 3 (θ c ) / B0 4 (29),

[0092] F = a sin (rs sin (θ c ) / l) (30),

[0093]

[0094] The above transformation processes are all obtained through transformation through common knowledge. Without the above description, those skilled in the art can obtain the above transformation based on common sense. This embodiment describes the transformation process more clearly, so the process is displayed in detail.

[0095] Step 2: Express the dynamic equation of the servo press obtained in step 1 as an affine nonlinear system of differential homeomorphic transformation, gradually differentiate the output function y until the input u appears, design the state feedback v to eliminate the nonlinear term, and calculate the nonlinear state feedback expression of the system.

[0096] The dynamic equation (12) of the servo press obtained in step 1 can be transformed to:

[0097]

[0098] Then, formula (35) is expressed as the affine nonlinear system of differential homeomorphism transformation as follows:

[0099]

[0100] y=h (36),

[0101] in, h=[x1](40);u=[τ c ](41); Wherein the above f and g are smooth vector fields on the second-order system, and h is a smooth scalar function on the second-order system; the above formulas (41) and (40) show that the dimensions of the input u and the output y are equal, and both dimensions are equal to 1.

[0102] The basic idea of ​​differential homeomorphism transformation is to gradually differentiate the output function y until the input u appears, and then design the state feedback v to eliminate the nonlinear term. Based on the above process, the specific calculation process is as follows:

[0103] Define the Lie derivative of h with respect to f as follows:

[0104]

[0105] The above formula shows that h is the directional derivative along the vector f, and is also a smooth scalar function on the second-order system.

[0106] Similarly, higher-order Lie derivatives can be defined, and each order of Lie derivatives can be expressed recursively as follows:

[0107]

[0108] For the output function y, its relative degree r can be defined i ,satisfy:

[0109]

[0110] because So the relative degree r i =2.

[0111] According to formula (36), the zero-order derivative, first-order derivative, and second-order derivative of the output function y are:

[0112] The zeroth derivative of y:

[0113] The first derivative of y: because: therefore It has nothing to do with u, so we need to continue to find the second-order derivative of y.

[0114] The second derivative of y:

[0115] remember:

[0116]

[0117] Among them, β0, β1, and β2 are all configuration parameters and are positive numbers, which can configure the desired linearized system dynamics.

[0118] The nonlinear state feedback expression of the system can be obtained, that is, the mathematical expression between u and v:

[0119]

[0120] Step 3: Use the PI control algorithm as the control strategy of the linear control algorithm to set the crank to a given angle and crank feedback angle θ c As the input of the proportional-integral link, the state feedback v of the linear control algorithm is obtained.

[0121] Here, the PI control algorithm commonly used in industry is used as the control strategy of the linear control algorithm. The optimal parameters are adjusted to obtain the calculation result v of the linear control algorithm as follows:

[0122]

[0123] Among them, k p Represents the position error coefficient, which is a constant; k i Represents the speed error coefficient, which is a constant; Indicates the given crank angle; θ c Indicates the crank feedback angle; Acc indicates the angle within each control cycle The accumulation of values.

[0124] Step 4: Substitute the state feedback v obtained in step 3 into the nonlinear state feedback expression of the system in step 2 to obtain u. Divide u by the reduction ratio of the reducer to obtain the motor given torque T. e * , through the motor given torque T e * Further get the given current i of the motor at the k+1th moment q *(k+1).

[0125] Since u=τ c , then according to the calculation formula (54) of u, we can get τ c .

[0126] Motor given torque T e * The expression is:

[0127]

[0128] The given current i of the motor at the k+1th moment q *(k+1) is expressed as:

[0129]

[0130] Among them, ψ f is the permanent magnet flux; p is the number of motor pole pairs. Substituting into formula (56), the given current i of the motor at the k+1th moment can be calculated: q *(k+1).

[0131] Step 5: Calculate the feedback value of the quadrature-axis current at the k+1th moment and the feedback value of the direct-axis current at the k+1th moment according to the stator voltage equation.

[0132] The servo press of this embodiment adopts a crank-connecting rod transmission structure, the motor adopts a surface-mounted permanent magnet synchronous motor, and the driver adopts a three-phase two-level inverter.

[0133] The mathematical model of the surface-mounted permanent magnet synchronous motor in the rotating coordinate system, the stator voltage equation is:

[0134]

[0135]

[0136] in:

[0137] ψ d =L d i d +ψ f (60),

[0138] ψ q =L q i q (61),

[0139] Above, V d is the direct-axis voltage; V q is the quadrature axis voltage; i d is the direct axis current; i q is the quadrature axis current; R is the stator resistance; ω e is the electrical angular velocity; ψ d is the direct-axis stator flux; ψ q is the quadrature-axis stator flux; ψ f is the permanent magnet flux; L dis the direct-axis inductance; L q is the quadrature-axis inductance.

[0140] According to the above stator voltage equation, using Euler's forward approximation rule, the current value at the kth moment can be calculated to get the current value at the k+1th moment:

[0141] Euler's forward approximation rule is:

[0142]

[0143] According to the stator voltage equation:

[0144]

[0145] Among them, i q (k) is the feedback value of the quadrature-axis current at the kth moment; i q (k+1) is the feedback value of the quadrature axis current at the k+1th moment; i d (k) is the feedback value of the direct axis current at the kth moment; i d (k+1) is the feedback value of the direct-axis current at the k+1th moment; T s is the control period; V d (k) is the direct-axis voltage at the kth moment; V q (k) is the quadrature axis voltage at the kth moment.

[0146] Step 6: Model prediction current control.

[0147] The current values ​​required by the value function in the above-mentioned predictive current control have been calculated and directly introduced into the corresponding value function, and the voltage vector corresponding to the minimum value of the value function is applied to the power module output to control the motor rotation.

[0148] In the control strategy d * (k+1)=0, here i d * (k+1) represents the given value of the direct-axis current at the k+1th time. The cost function at the k+1th time can be obtained by optimizing the appropriate control rate. The cost function is set as:

[0149] g=|i q *(k+1)-i q (k+1)|+|i d *(k+1)-i d (k+1)| (66),

[0150] In the value function q *(k+1),i q (k+1), i d(k+1) have been calculated through the above steps. Finally, the optimization step is to bring the eight voltage vectors of the three-phase two-level PWM (pulse width modulation) inverter into the value function respectively, and define the voltage vector with the minimum value of g as the optimal vector. The optimal vector acts on the power module to output the PWM wave to control the operation of the motor.

[0151] The present invention may also have many other embodiments. Without departing from the spirit and essence of the present invention, those skilled in the art may make various corresponding changes and modifications based on the present invention, but these corresponding changes and modifications should all fall within the scope of protection of the claims attached to the present invention.

Claims

1. A servo press control method based on differential homeomorphism, characterized in that: The steps include: Step 1: Use Lagrange equation to establish the dynamic equation of servo press; Step 2: Express the dynamic equation of the servo press as an affine nonlinear system of differential homeomorphic transformation, gradually derive the output function y until the input u appears, design the state feedback v to eliminate the nonlinear term, and calculate the nonlinear state feedback expression of the system; Step 3: Use the PI control algorithm as the control strategy of the linear control algorithm to set the crank to a given angle and crank feedback angle θ c As the input of the proportional-integral link, the state feedback v of the linear control algorithm is obtained; Step 4: Substitute the state feedback v obtained in step 3 into the nonlinear state feedback expression of the system in step 2 to obtain u. Divide u by the reduction ratio of the reducer to obtain the motor given torque T. e * , through the motor given torque T e * Calculate the given current of the motor at the k+1th moment; Step 5: Calculate the feedback value of the quadrature-axis current at the k+1th moment and the feedback value of the direct-axis current at the k+1th moment according to the stator voltage equation; Step 6: Substitute the given current of the motor at the k+1th moment, the feedback value of the quadrature-axis current at the k+1th moment, and the feedback value of the direct-axis current at the k+1th moment into the value function, and apply the voltage vector that obtains the minimum value of the value function to the power module to output a PWM wave to control the motor operation.

2. The servo press control method based on diffeomorphism according to claim 1, characterized in that: In the step 1, The dynamic equation of the servo press is established using the Lagrange equation: Among them, τ c is the crank load torque; M(θ c ) is the inertia coefficient; N(θ c ) is the eccentricity coefficient of the press; is the crank feedback angular acceleration; is the crank feedback angular velocity.

3. The servo press control method based on diffeomorphism according to claim 2 is characterized in that: The step 2 specifically includes the following steps: The dynamic equation of the servo press can be transformed into: Then, formula (35) is expressed as the affine nonlinear system of differential homeomorphism transformation as follows: y=h (36), in, h=[x1](40);u=[τ c ](41); Among them, f and g are smooth vector fields on the second-order system; h is a smooth scalar function on the second-order system; The output function y is gradually differentiated until the input u appears. Design status feedback v: Among them, β0, β1, and β2 are configuration parameters; The nonlinear state feedback expression of the system is obtained: in, 4. The servo press control method based on diffeomorphism according to claim 3 is characterized in that: In step 3, the state feedback v expression of the linear control algorithm is: Among them, k p Represents the position error coefficient, which is a constant; k i Represents the speed error coefficient, which is a constant; Indicates the given crank angle; θ c Indicates the crank feedback angle; Acc indicates the angle within each control cycle The accumulation of values.

5. The servo press control method based on diffeomorphism according to claim 4 is characterized in that: The step 4 specifically includes the following steps: Motor given torque T e * The expression is: The given current i of the motor at the k+1th moment q *(k+1) is expressed as: Among them, ψ f is the permanent magnet flux; p is the number of motor pole pairs; according to formula (56) and formula (57), the given current i of the motor at the k+1th moment can be calculated: q *(k+1).

6. The servo press control method based on diffeomorphism according to claim 5 is characterized in that: The specific steps of step five are: The stator voltage equation is: in: ψ d =L d I d +ψ f (60), ψ q =L q I q (61), Above, V d is the direct-axis voltage; V q is the quadrature axis voltage; i d is the direct axis current; i q is the quadrature axis current; R is the stator resistance; ω e is the electrical angular velocity; ψ d is the direct-axis stator flux; ψ q is the quadrature-axis stator flux; ψ f is the permanent magnet flux; L d is the direct-axis inductance; L q is the quadrature-axis inductance; According to the stator voltage equation, using Euler's forward approximation rule, the current value at the kth moment can be calculated to obtain the current value at the k+1th moment: Among them, i q (k) is the feedback value of the quadrature-axis current at the kth moment; i q (k+1) is the feedback value of the quadrature axis current at the k+1th moment; i d (k) is the feedback value of the direct axis current at the kth moment; i d (k+1) is the feedback value of the direct-axis current at the k+1th moment; T s is the control period; V d (k) is the direct-axis voltage at the kth moment; V q (k) is the quadrature axis voltage at the kth moment.

7. The servo press control method based on diffeomorphism according to claim 6 is characterized in that: In step 6, the value function is: g=|i q *(k+1)-i q (k+1)|+|i d *(k+1)-i d (k+1)| (66), Among them, i d * (k+1) represents the given value of the direct-axis current at the k+1th moment, i d * (k+1)=0.