Feedforward control method based on nonlinear inertia system of servo press

By adopting the feedforward control method of a nonlinear inertia system in the servo press, using the dynamic model and the permanent magnet synchronous motor model, the position error problem of the servo press under large load conditions is solved, and higher control accuracy is achieved and robustness.

CN118915573AActive Publication Date: 2024-11-08SHANDONG RUIYI ELECTRIC TECHNOLOGY CO LTD

Patent Information

Application Number
CN202411077220.4
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-07
Publication Date
2024-11-08
Estimated Expiration
2044-08-07

AI Technical Summary

Technical Problem

When the existing servo press control method encounters a large load during the downward forming process of the slider, a large error will occur between the target given position and the feedback position, affecting the workpiece forming quality.

Method used

Using the feedforward control method based on the nonlinear inertia system of servo presses, the dynamic equation is established through the Lagrangian equation, the crank torque is calculated, and the mechanical model of the permanent magnet synchronous motor and the stator voltage equation are used to utilize Euler forward Approximation method and first-order low-pass filter algorithm realize the estimation of motor load torque and the calculation of a given torque, and optimize the current control strategy to reduce position errors.

Benefits of technology

In the case of motor load disturbance, the real-time curve error of the servo press is significantly reduced, the position control accuracy is improved, the position control error is reduced, and the system robustness is improved.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118915573A_ABST
    Figure CN118915573A_ABST
Patent Text Reader

Abstract

The invention belongs to the field of power electronics and motor control, and particularly relates to a feed-forward control method based on a nonlinear inertia system of a servo press, which realizes a control method for torque calculation of the servo press by using a kinetic model of the system, calculates the nonlinear inertia of the servo press on line, and improves the control precision of the servo press. According to the method, the calculation process of a torque observer is accurately adapted, a torque feedforward control method is adopted, the control system shows high robustness under the condition of motor load disturbance, particularly when the servo press meets a large load, the real-time curve error of the servo press is greatly reduced, the position control precision is improved, and the position control error is reduced.
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 feedforward control method based on a nonlinear inertia system of a servo press. Background Art

[0002] There are many control methods for servo presses. For example, one of the control methods is disclosed in the patent with authorization announcement number CN110077028B and titled "Full-closed-loop nonlinear predictive control method and system for servo presses". However, most control methods do not take into account the situation where a large error will occur between the target given position and the feedback position when the servo press slider encounters a large load during the downward forming process, thereby affecting the final workpiece forming quality of the servo press. Summary of the invention

[0003] In order to solve the deficiencies of the prior art, the present invention provides a feedforward control method based on a nonlinear inertia system of a servo press.

[0004] The present invention provides a feedforward control method based on a nonlinear inertia system of a servo press, comprising the following steps:

[0005] Step 1: Use the Lagrange equation to establish the dynamic equation of the servo press, and convert the established dynamic equation into the following equation:

[0006]

[0007] Among them, 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;

[0008] Then, formula (12) is introduced into the state feedback e c To improve the tracking control effect, the crank torque τ is obtained c Calculation formula:

[0009]

[0010] Among them, e c =θ c * -θ c ; θ c * Give the crank an angle; is the given angular velocity of the crank; is the given angular acceleration of the crank; k d Represents the speed error coefficient, which is a constant; k pRepresents the position error coefficient, which is a constant;

[0011] Step 2: Use the rotational inertia J of the servo press viewed from the motor side and the rotational inertia J of the servo press viewed from the crank side p The mathematical relationship between them gives the calculation formula for the rotational inertia J of the servo press viewed from the motor side:

[0012]

[0013] Where n is the reduction ratio of the reducer;

[0014] Step 3: According to the stator voltage equation of the permanent magnet synchronous motor, using Euler's forward approximation rule, the feedback value i of the direct axis current at the k+1th moment can be obtained: d (k+1) and the feedback value i of the quadrature axis current at the k+1th moment q (k+1):

[0015]

[0016] 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; R is the stator resistance; ω e is the electrical angular velocity; L d is the direct-axis inductance; L q is the quadrature-axis inductance; ψ f is the permanent magnet flux linkage;

[0017] Step 4: Use the mechanical model equation of the permanent magnet synchronous motor and the moment of inertia J of the servo press from the motor side calculated in step 2, combined with the first-order low-pass filter algorithm, to complete the motor load torque estimation Calculate, using the estimated value of the motor load torque Replace the actual motor load torque value T L , the estimated value of motor load torque and crank torque τ c Add the corresponding values ​​on the motor side to get the given torque T of the motor. e * , and then according to the given value of the motor's quadrature-axis current i q * With the given torque T of the motor e* The linear relationship between the motor and the given value i of the quadrature axis current at the k+1th moment is obtained. q *(k+1) is calculated as:

[0018]

[0019] Where p is the number of motor pole pairs;

[0020] Step 5: In the control strategy i d * When (k+1)=0, the value function is set to:

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

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

[0023] The eight voltage vectors of the three-phase two-level PWM inverter are respectively substituted into the value function, and the voltage vector with the minimum g value is defined as the optimal vector. The optimal vector acts on the power module to output the PWM wave to control the motor operation.

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

[0025] The advantages of the present invention are that the control method for torque calculation of the servo press is realized by utilizing the dynamic model of the system, the nonlinear inertia of the servo press is calculated online, the calculation process of the torque observer is accurately adapted, and a torque feedforward control method is adopted. The control system exhibits strong robustness in the case of motor load disturbance, especially when the servo press encounters a large load, the real-time curve error of the servo press is greatly reduced, the position control accuracy is improved, and the position control error is reduced. BRIEF DESCRIPTION OF THE DRAWINGS

[0026] Figure 1 This is a control algorithm block diagram of the present invention;

[0027] Figure 2 The moment of inertia J of the servo press viewed from the motor side changes with the crank feedback angle θ c The change curve diagram of

[0028] Figure 3 The moment of inertia J of the servo press viewed from the motor side is the crank feedback angle θc The derivative graph of . DETAILED DESCRIPTION

[0029] 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.

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

[0031] (I) Calculation of crank torque τ c

[0032] This step uses the Lagrange equation-based torque control method in the servo drive to calculate the crank torque τ c The input of the method includes a given crank angle, a given crank angular velocity and a given crank angular acceleration, as well as a crank feedback angle and a crank feedback angular velocity, and the output of the method is a calculated crank torque.

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

[0034]

[0035] Where Γ 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;

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

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

[0038] 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:

[0039]

[0040]

[0041] in,

[0042] 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.

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

[0044]

[0045] 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:

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

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

[0048] in,

[0049] A1=J c (15)

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

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

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

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

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

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

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

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

[0058] B4=blr 3 sin(θ c )cos 2 (i c )*cos(F) / B0 2 (24),

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

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

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

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

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

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

[0065]

[0066] Introduce formula (12) into state feedback c To improve the tracking control effect, the crank torque τ can be obtained c Calculation formula:

[0067]

[0068] Among them, e c =θ c * -θ c ; θ c * Give the crank an angle; is the given angular velocity of the crank; is the given angular acceleration of the crank; k d Represents the speed error coefficient, which is a constant; k p Represents the position error coefficient, which is a constant.

[0069] (II) Calculate the moment of inertia J of the servo press viewed from the motor side

[0070] This step uses the mathematical relationship between moments of inertia to obtain the moment of inertia J of the servo press as seen from the motor side, which is used to calculate the estimated value of the motor load torque.

[0071] The moment of inertia J of the servo press viewed from the crank side p That is the inertia coefficient M(θ c ), namely J p =M(θ c ), the calculation formula for the rotational inertia J of the servo press viewed from the motor side is:

[0072]

[0073] Among them, n is the reduction ratio of the reducer.

[0074] (III) Calculate i according to the stator voltage equation q (k+1) and i d (k+1)

[0075] This step uses the stator voltage equation of the permanent magnet synchronous motor to calculate the quadrature-axis and direct-axis currents at the k+1th moment in the dq coordinate system, which are then used to calculate the value function in the model predictive current control.

[0076] 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.

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

[0078]

[0079] in:

[0080] ψ d =L d i d +ψ f (39),

[0081] ψ q =L q i q (40),

[0082] 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; Ld is the direct-axis inductance; L q is the quadrature-axis inductance.

[0083] 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:

[0084] Euler's forward approximation rule is:

[0085]

[0086] According to the stator voltage equation:

[0087]

[0088] 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.

[0089] (IV) Calculate the given value i of the quadrature axis current at the k+1th moment q *(k+1)

[0090] This step uses the mechanical model equation of the permanent magnet synchronous motor and the real-time calculated moment of inertia of the servo press viewed from the motor side, combined with a first-order low-pass filter algorithm, to complete the calculation of the motor load torque estimate. The above motor load torque estimate is added to the corresponding value of the crank torque on the motor side, which is the given torque of the motor. The given current of the motor is obtained based on the linear relationship between the given current and the given torque of the motor.

[0091] The mechanical model equation of permanent magnet synchronous motor can be expressed as:

[0092]

[0093] Among them, θ m is the rotational mechanical angle of the motor; T e is the electromagnetic torque of the motor; T L is the motor load torque, which includes the real load, friction and other disturbances; p is the number of motor pole pairs.

[0094] When the servo press is used in practice, the moment of inertia J of the servo press viewed from the motor side changes with the crank feedback angle θ.c The change curve is shown in the attached Figure 2 As shown, the ordinate is the moment of inertia J of the servo press viewed from the motor side, and the abscissa is the crank feedback angle θ c , the actual J changes with θ c The system is in a state of constant change, which is not the traditional default that the system's moment of inertia J is considered to remain constant. Figure 3 The moment of inertia J of the servo press viewed from the motor side is the crank feedback angle θ c The derivative of

[0095] Since the motor rotates at a mechanical angle θ m and crank feedback angle θ c It is a linear relationship, and the expression is: θ m =nθ c

[0096] (46),

[0097] but

[0098] Where n is the reduction ratio of the reducer, n is generally less than 50, so it can be seen yes of times, you can know Compare Closer to 0, we get

[0099] Will Substituting into formula (45), we can get:

[0100]

[0101] but

[0102] Transform formula (49) from the time domain to the frequency domain through Laplace transform and obtain:

[0103] T L =T e -Jsω m (50),

[0104] Where s is the differential operator.

[0105] Then, formula (50) is combined with the design of a first-order low-pass filter to obtain the estimated value of the motor load torque: The expression is as follows:

[0106]

[0107] Where g1 is the cutoff frequency of the first-order low-pass filter; the motor load torque estimate is then used Replace the actual motor load torque value T L ,Right now

[0108] In order to improve the accuracy of the data model and reduce the error influence of the differential operator s, formula (51) can be transformed into:

[0109]

[0110] In the above formula (52), J is calculated according to formula (36), and then the motor load torque estimation value can be completed by using a first-order low-pass filter. The motor load torque estimate is used in subsequent calculations. Replace the actual motor load torque value T L .

[0111] From formula (45), we can get: Further we can get:

[0112]

[0113] Because I q and i q * It is in linear proportion, so from formula (53) we can get:

[0114]

[0115] where i q * Indicates the given value of the motor's quadrature-axis current; T e * is the given torque of the motor;

[0116] Use the motor load torque estimate Replace the actual motor load torque value T L , then the given torque T of the motor e * The expression is:

[0117]

[0118] Then the given value i of the quadrature axis current of the motor at the k+1th moment is q *(k+1) is expressed as:

[0119]

[0120] (V) Model Prediction Current Control

[0121] 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.

[0122] 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:

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

[0124] 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.

[0125] Note: The dots above the above letters all mean to find the derivative, for example Represents the c Derivatives are not explained one by one in the manual.

[0126] 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 feedforward control method based on the nonlinear inertia system of a servo press. Features: The steps include: Step 1: Use the Lagrange equation to establish the dynamic equation of the servo press, and convert the established dynamic equation into the following equation: Among them, 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; Then, formula (12) is introduced into the state feedback e c To improve the tracking control effect, the crank torque τ is obtained c Calculation formula: Among them, e c =θ c * -θ c ; θ c * Give the crank an angle; is the given angular velocity of the crank; is the given angular acceleration of the crank; k d Represents the speed error coefficient, which is a constant; k p Represents the position error coefficient, which is a constant; Step 2: Use the rotational inertia J of the servo press viewed from the motor side and the rotational inertia J of the servo press viewed from the crank side p The mathematical relationship between them gives the calculation formula of the rotational inertia J of the servo press viewed from the motor side: Where n is the reduction ratio of the reducer; Step 3: According to the stator voltage equation of the permanent magnet synchronous motor, using Euler's forward approximation rule, the feedback value i of the direct axis current at the k+1th moment can be obtained: d (k+1) and the feedback value i of the quadrature axis current at the k+1th moment q (k+1): 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; R is the stator resistance; ω e is the electrical angular velocity; L d is the direct-axis inductance; L q is the quadrature-axis inductance; ψ f is the permanent magnet flux linkage; Step 4: Use the mechanical model equation of the permanent magnet synchronous motor and the moment of inertia J of the servo press from the motor side calculated in step 2, combined with the first-order low-pass filter algorithm, to complete the motor load torque estimation Calculate, using the estimated value of the motor load torque Replace the actual motor load torque value T L , the estimated value of motor load torque and crank torque τ c Add the corresponding values ​​on the motor side to get the given torque T of the motor e * , and then according to the given value of the motor's quadrature-axis current i q * With the given torque T of the motor e * The linear relationship between the motor and the given value i of the quadrature axis current at the k+1th moment is obtained. q *(k+1) is calculated as: Where p is the number of motor pole pairs; Step 5: In the control strategy i d * When (k+1)=0, the value function is set to: g=|i q *(k+1)-i q (k+1)|+|i d *(k+1)-i d (k+1)| (57), Among them, i d * (k+1) represents the given value of the direct-axis current at the k+1th moment; The eight voltage vectors of the three-phase two-level PWM inverter are respectively substituted into the value function, and the voltage vector with the minimum g value is defined as the optimal vector. The optimal vector acts on the power module to output the PWM wave to control the motor operation.

2. The feedforward control method based on the nonlinear inertia system of the servo press according to claim 1, Features: The servo press 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.

Citation Information

Patent Citations

  • Pressure control method for servo crank press

    CN102107544A

  • Multi-motor servo system active disturbance rejection sliding mode speed control method based on inertia identification

    CN110518846A

  • Sensorless model prediction flux linkage control method for permanent magnet synchronous motor

    CN111431460A

  • Arc motor prediction control method based on improved disturbance observer

    CN113054878A

  • Dead-beat rotating speed prediction servo permanent magnet motor control method and system

    CN113691187A

Cited By

  • Non-linear inertia adaptive curve control method for servo press

    CN119335882A

  • A nonlinear inertia adaptive curve control method for servo press

    CN119335882B

  • Feedforward control method based on nonlinear inertia system of servo press

    WO2026032104A1