Method for improving position control precision of servo press
Through the model prediction control method, the problems of low position control accuracy and poor anti-interference ability in traditional servo presses are solved, and the servo press control effect with high accuracy, low switching frequency and simplified calculation are achieved.
Patent Information
- Application Number
- CN202411077218.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-07
- Publication Date
- 2024-11-19
AI Technical Summary
The cascaded magnetic field orientation control in traditional servo presses has problems such as large error in position control accuracy, slow response, large calculation amount, long time to adjust PI parameter, poor anti-interference ability and high switching frequency.
Using a position control method based on model prediction control, by calculating the moment of inertia, motor load torque estimation and value function optimization of the servo press, the three-phase two-level PWM inverter is used for motor control, reducing PI parameter adjustment, and improving control Accuracy and load resistance.
It improves position control accuracy, reduces the calculation amount and switching frequency, enhances anti-interference ability, simplifies the calculation process, and saves the time for PI parameter adjustment.
Smart Images

Figure CN118984086A_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the technical field of servo presses, and in particular relates to a method for improving the position control accuracy of a servo press. Background Art
[0002] With the rapid rise of high-speed finishing industry, the requirements for parts processing quality are getting higher and higher. Servo presses, as industrial mother machines and special forming machines, are adopted by major forming demanders for their advantages of flexible processing. The core of flexible processing is the controllable and adjustable position and speed, as well as the high control accuracy of position and speed.
[0003] The motor control method in traditional servo presses is mainly cascaded magnetic field oriented control, such as the invention patent No. ZL202311527814.6 of Shenzhen Tianliyue Technology Co., Ltd. Since the traditional cascaded magnetic field oriented control uses position loop PI, speed loop PI, current loop PI, plus coordinate transformation matrix and SVPWM (space vector pulse width modulation), the three closed-loop PI loops in the position control are looped one after another, and the output of the position loop PI is used as the given of the speed loop PI, and the output of the speed loop PI is used as the given of the current loop PI. The output results of each loop of this control method are serially connected and transmitted in sequence, which will seriously affect the response and bandwidth of the outermost loop (position control loop). Therefore, the traditional cascaded magnetic field oriented control has the following disadvantages:
[0004] 1. The position control accuracy error is large, the position loop responds slowly, and the bandwidth of the position loop is narrow;
[0005] 2. The amount of calculation is relatively large. There are a lot of mathematical formulas in SVPWM;
[0006] 3. It takes a lot of time to determine the parameters of PI, and the experimental parameters need to be constantly adjusted to the optimal value;
[0007] 4. Poor anti-interference load capacity;
[0008] 5. The current loop itself will also have a delay in response;
[0009] 6. High switching frequency.
[0010] Therefore, the present invention proposes a position control method based on model predictive control to solve the above problems. Summary of the invention
[0011] The present invention aims to solve the deficiencies of the prior art and provides a method for improving the position control accuracy of a servo press.
[0012] The present invention is achieved through the following technical solutions:
[0013] A method for improving the position control accuracy of a servo press comprises the following steps:
[0014] Step 1: Calculation of the moment of inertia J of the servo press from the motor side
[0015] According to E k =E c +E l +E s +E m (8)
[0016] Where E c is the kinetic energy of the crank, E l is the kinetic energy of the connecting rod, E s is the kinetic energy of the slider, E m Represents the kinetic energy of the motor and reducer, E k Represents the kinetic energy of the crank-connecting rod mechanical structure, and the kinetic energy expressions are:
[0017]
[0018] in,
[0019] Among them, J p is the moment of inertia of the servo press viewed from the crank side, J c is the moment of inertia of the crank rotating around the center 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 rotation angle, φ is the connecting rod clockwise rotation angle from top dead center to the current position, r is the crank radius, and l is the connecting rod length;
[0020] Substituting formula (9)-formula (16) into formula (8), we can obtain the moment of inertia J of the servo press viewed from the crank side: p :
[0021]
[0022] Among them, a, b, c, and β are parameter coefficients.
[0023]
[0024] b=(m l +2ms )rl(19),
[0025]
[0026] The moment of inertia J of the servo press viewed from the motor side is:
[0027]
[0028] Where n is the reduction ratio of the reducer;
[0029] Step 2: as well as Calculation
[0030] According to the mechanical model equation expression of permanent magnet synchronous motor:
[0031]
[0032] Where, J is the moment of inertia of the servo press viewed from the motor side, θ m is the rotational mechanical angle of the motor; T e is the electromagnetic torque of the motor; T L is the load torque of the motor, p is the number of motor pole pairs, ψ f is the permanent magnet flux, i q is the feedback value of the quadrature axis current in the dq coordinate system,
[0033] because We can get:
[0034]
[0035] Further we can get:
[0036] Taking the derivative of both sides of formula (31), We can get:
[0037]
[0038] Step 3: Estimated motor load torque Calculation using the motor load torque estimate Replace the actual motor load torque value T L
[0039] The formula (30) in step 2 is transformed from the time domain to the frequency domain through Laplace transform, and then combined with the design of a first-order low-pass filter, the estimated value of the motor load torque is obtained The calculation formula is as follows:
[0040]
[0041] Where s is the differential operator, g1 is the cutoff frequency of the first-order low-pass filter,
[0042] Transform formula (34) into:
[0043]
[0044] Using a first-order low-pass filter, the motor load torque estimation is completed Calculation of
[0045]
[0046] Step 4: Setting the value function g
[0047] In the control strategy d *(k+1)=0, the value function g is set to:
[0048] g=|i q *(k+1)-i q (k+1)|+|i d *(k+1)-i d (k+1)|(47),
[0049] in,
[0050]
[0051] Among them, i q *(k+1) is the given value of the quadrature axis current at the k+1th moment in the dq coordinate system, i q (k) is the feedback value of the quadrature axis current at the kth moment in the dq coordinate system, i q (k+1) is the feedback value of the quadrature axis current at the k+1th moment in the dq coordinate system, i d (k) is the feedback value of the direct axis current at the kth moment in the dq coordinate system, i d (k+1) is the feedback value of the direct axis current at the k+1th moment in the dq coordinate system, T s is the control period, L d is the direct axis inductance in the dq coordinate system, L q is the quadrature-axis inductance in the dq coordinate system, ω e is the electrical angular velocity, V d (k) is the direct axis voltage at the kth moment in the dq coordinate system, V q (k) is the quadrature axis voltage at the kth moment in the dq coordinate system, R is the stator resistance,
[0052] The above q * The calculation formula of (k+1) is obtained by the following steps:
[0053] Given the input angle θ of the motorm * The third-order Taylor expansion is:
[0054]
[0055] Substituting formulas (31) and (33) in step 2 into formula (39), we can obtain
[0056]
[0057] Using Euler's forward approximation rule,
[0058] Assumptions
[0059] Substitute formula (41) into formula (40) and use We can get formula (42);
[0060] The above d (k+1) and i q The calculation formula of (k+1) is obtained by the following steps:
[0061] According to the stator voltage equation, using Euler's forward approximation rule,
[0062]
[0063] The above formula (45) and formula (46) can be obtained;
[0064] Finally, the eight voltage vectors of the three-phase two-level PWM (pulse width modulation) inverter are respectively substituted into the value function g, and the voltage vector with the minimum value of g is defined as the optimal vector. The optimal vector acts on the power module to output the PWM wave to control the operation of the motor.
[0065] Preferably, 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.
[0066] Preferably, the stator voltage equation of the permanent magnet synchronous motor in the rotating coordinate system is:
[0067]
[0068] in:
[0069] ψ d =L d i d +ψ f (27)
[0070] ψ q =L q i q (28)
[0071] where ψ d is the direct-axis stator flux, ψ q is the quadrature-axis stator flux.
[0072] The present invention adopts a position control method based on model predictive control, which improves the accuracy of position control, greatly improves the load resistance, and can significantly reduce the switching frequency of IGBT (insulated gate bipolar transistor). At the same time, the amount of calculation per unit time is reduced, and the calculation process is simple and clear. The method of the present invention has the following advantages:
[0073] 1. Small position control error, high control accuracy and high position bandwidth;
[0074] 2. Short calculation time and small amount of calculation;
[0075] 3. No PI parameters need to be adjusted, saving a lot of time;
[0076] 4. Strong anti-interference load capability;
[0077] 5. The current loop itself responds quickly;
[0078] 6. Low switching frequency. BRIEF DESCRIPTION OF THE DRAWINGS
[0079] Figure 1 This is a control algorithm block diagram of the present invention;
[0080] Figure 2 The moment of inertia J of the servo press viewed from the motor side changes with the crank rotation angle θ c The change curve diagram of
[0081] Figure 3 is the moment of inertia J of the servo press viewed from the motor side relative to the crank rotation angle θ c The derivative graph of . DETAILED DESCRIPTION
[0082] 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.
[0083] The technical solution for implementing the present invention is as follows:
[0084] (I) Calculation of the moment of inertia J of the servo press from the motor side
[0085] In most industrial application scenarios, the system's moment of inertia is assumed to remain constant, so the concept of constant moment of inertia is also used in the application scenario of servo presses. But in fact, in a servo press, the system's moment of inertia is constantly changing, and accurate calculation of the moment of inertia helps improve the control system's response and control accuracy. The equivalent moment of inertia of the servo press calculated in this step is mainly used to calculate the motor load torque in the future, as an important parameter for estimating the motor load torque.
[0086] This embodiment uses a crank-connecting rod transmission structure as the main transmission structure of a servo press to illustrate the equivalent moment of inertia calculation process. Figure 1 As shown, point O is the central rotation point of the crank structure, point O and point A are the two end points of the crank, point S is the center of mass of the slider, point A and point S are the two end points of the connecting rod, point B is the midpoint of the connecting rod, and m s is the mass of the slider, m l is the mass of the connecting rod, θ c It is the angle of the crank rotating clockwise from the top dead center to the current position, that is, the crank rotation angle, φ is the angle of the connecting rod rotating clockwise from the top dead center to the current position, r is the crank radius, and l is the connecting rod length.
[0087] The typical servo press crank structure is driven by a permanent magnet synchronous motor, and the mathematical model of the structural geometry is:
[0088] x A =rsinθ c (1)
[0089] y A =-rcosθ c (2)
[0090] x s =0(3)
[0091]
[0092] y s =lcosφ-rcosθ c (5)
[0093]
[0094] Kinetic energy E of the crank-connecting rod mechanical structure k The calculation is as follows:
[0095] E k =E c +E l +E s +E m (8)
[0096] Where Ec is the kinetic energy of the crank, E l is the kinetic energy of the connecting rod, E s is the kinetic energy of the slider, E m Represents the kinetic energy of the motor and reducer. The kinetic energy expressions are:
[0097]
[0098] in,
[0099] Among them, J p is the moment of inertia of the servo press viewed from the crank side, J c is the moment of inertia of the crank rotating around point O, J l is the moment of inertia of the connecting rod rotating around point S, J g is the moment of inertia of the motor and reducer, v l is the velocity of the connecting rod at point B, v s is the speed of the slider, ω m is the angular velocity of the motor.
[0100] According to the law of conservation of energy, the above kinetic energy expressions are substituted into the kinetic energy E of the crank-connecting rod mechanical structure. k By calculating formula (8), we can get the moment of inertia J of the servo press viewed from the crank side: p :
[0101]
[0102] Among them, a, b, c, and β are parameter coefficients, respectively:
[0103]
[0104] b=(m l +2m s )rl(19)
[0105]
[0106] The moment of inertia J of the servo press viewed from the motor side and the moment of inertia J of the servo press viewed from the crank side p The relationship between them is:
[0107]
[0108] Among them, n is the reduction ratio of the reducer.
[0109] Therefore, the moment of inertia J of the servo press viewed from the crank side is calculated. p, we can get the moment of inertia J of the servo press viewed from the motor side according to the above formula, and bring it into the estimation equation of the motor load torque in the subsequent calculation.
[0110] 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 rotation 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 rotation angle θ c , the actual J changes with θ c The system is in constant change, which is not the traditional default that the system's moment of inertia J is considered to remain constant. Figure 3 is the moment of inertia J of the servo press viewed from the motor side relative to the crank rotation angle θ c The derivative of Since the motor rotates at a mechanical angle θ m and crank rotation angle θ c It is a linear relationship, and the expression is: θ m =nθ c (twenty three),
[0111] but 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.
[0112] (II) Physical model of the motor
[0113] 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.
[0114] The mathematical model of the permanent magnet synchronous motor in the rotating coordinate system, the stator voltage equation is:
[0115]
[0116] Among them, V d is the direct axis voltage in the dq coordinate system, V q is the quadrature axis voltage in the dq coordinate system, i d is the direct axis current in the dq coordinate system, i q is the quadrature axis current in the dq coordinate system, 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, where:
[0117] ψd =L d i d +ψ f (27)
[0118] ψ q =L q i q (28)
[0119] Among them, ψ f is the permanent magnet flux, L d is the direct axis inductance in the dq coordinate system, L q is the quadrature-axis inductance in the dq coordinate system. Formulas (27) and (28) can be substituted into the above stator voltage equation.
[0120] The mechanical model equation of permanent magnet synchronous motor can be expressed as:
[0121]
[0122] Among them, J is the moment of inertia of the servo press viewed from the motor side. In the servo press, this value is variable; θ m is the rotational mechanical angle of the motor; T e is the electromagnetic torque of the motor; T L is the load torque of the motor, which includes the real load, friction and other disturbances, and p is the number of motor pole pairs.
[0123] because The above formula (29) can be simplified as:
[0124]
[0125] From the above formula, we can get:
[0126] Taking the derivative of both sides of formula (30), we can get:
[0127]
[0128] Generally speaking, the load torque of the motor will not change suddenly. Substituting into the above formula (32), after transforming the above formula (32), we can get:
[0129] (III) Motor load torque estimation
[0130] The purpose of this step is to obtain the estimated value of the motor load torque by calculation Using the motor load torque estimate Replace the actual motor load torque value T L .
[0131] By transforming formula (30) from the time domain to the frequency domain through Laplace transform, the motor load torque estimation value is Combined with the design of the first-order low-pass filter, it is given as follows:
[0132]
[0133] Where s is the differential operator, g1 is the cutoff frequency of the first-order low-pass filter; ω m is the angular velocity of the motor, The motor load torque estimation method in this step is different from other conventional algorithms because the moment of inertia J here is a variable.
[0134] In order to improve the accuracy of the data model and reduce the error influence of the differential operator s, formula (34) can be transformed into:
[0135]
[0136] The J in the above formula (36) is calculated according to formula (22). p It can be calculated by formula (17), and then the motor load torque estimation value can be completed by using a digital first-order low-pass filter. The motor load torque estimate is used in subsequent calculations. Replace the actual motor load torque value T L ,Right now
[0137] The estimated value of the motor load torque in this step Position control method for model predictive control q * (k+1) calculation.
[0138] (IV) Position control method and current control method based on model predictive control
[0139] The crank input angle of the servo press input process curve is θ c * , n is the reduction ratio of the reducer, then the given input angle of the motor is θ m * =nθ c * (38).
[0140] Given the input angle θ of the motor m * The third-order Taylor expansion is:
[0141]
[0142] Among them, T sTo control the cycle.
[0143] Substituting formula (31) and (33) into formula (39), we can obtain
[0144]
[0145] Using Euler's forward approximation rule,
[0146] Assumptions
[0147] Among them, i q *(k+1) is the given value of the quadrature axis current at the k+1th moment in the dq coordinate system, i q (k) is the feedback value of the quadrature axis current at the kth moment in the dq coordinate system. Substitute formula (41) into formula (40) and use We can get:
[0148]
[0149] According to the stator voltage equations (25) and (26), the current value at the kth moment is used to calculate the current value at the k+1th moment. Using Euler's forward approximation rule,
[0150]
[0151] We can get:
[0152]
[0153] In the control strategy d *(k+1)=0, at the k+1th time, the value function can be obtained by optimizing the appropriate control rate, and the value function is set to:
[0154] g=|i q *(k+1)-i q (k+1)|+|i d *(k+1)-i d (k+1)|(47)
[0155] 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.
[0156] 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.
[0157] 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 method for improving the position control accuracy of a servo press, characterized in that: The steps include: Step 1: Calculation of the moment of inertia J of the servo press from the motor side Nete E k = E c +E l +E s +E m (8) Where E c is the kinetic energy of the crank, E l is the kinetic energy of the connecting rod, E s is the kinetic energy of the slider, E m Represents the kinetic energy of the motor and reducer, E k Represents the kinetic energy of the crank-connecting rod mechanical structure, and the kinetic energy expressions are: in, Among them, J p is the moment of inertia of the servo press viewed from the crank side, J c is the moment of inertia of the crank rotating around the center 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 rotation angle, φ is the connecting rod clockwise rotation angle from top dead center to the current position, r is the crank radius, and l is the connecting rod length; Substituting formula (9)-formula (16) into formula (8), we can obtain the moment of inertia J of the servo press viewed from the crank side: p : Among them, a, b, c, and β are parameter coefficients. b=(m l +2m s )rl (19), The moment of inertia J of the servo press viewed from the motor side is: Where n is the reduction ratio of the reducer; Step 2: as well as Calculation According to the mechanical model equation expression of permanent magnet synchronous motor: Where, J is the moment of inertia of the servo press viewed from the motor side, θ m is the rotational mechanical angle of the motor; T e is the electromagnetic torque of the motor; T L is the load torque of the motor, p is the number of motor pole pairs, ψ f is the permanent magnet flux, i q is the feedback value of the quadrature axis current in the dq coordinate system, because We can get: Further we can get: Taking the derivative of both sides of formula (31), We can get: Step 3: Estimated motor load torque Calculation using the motor load torque estimate Replace the actual motor load torque value T L The formula (30) in step 2 is transformed from the time domain to the frequency domain through Laplace transform, and then combined with the design of the first-order low-pass filter, the estimated value of the motor load torque is Given as follows: Where s is the differential operator, g1 is the cutoff frequency of the first-order low-pass filter, Transform formula (34) into: Using a first-order low-pass filter, the motor load torque estimation is completed Calculation of Step 4: Setting the value function g In the control strategy d *(k+1)=0, the value function g is set to: g=|i q *(k+1)-i q (k+1)|+|i d *(k+1)-i d (k+1)| (47), in, Among them, i q *(k+1) is the given value of the quadrature axis current at the k+1th moment in the dq coordinate system, i q (k) is the feedback value of the quadrature axis current at the kth moment in the dq coordinate system, i q (k+1) is the feedback value of the quadrature axis current at the k+1th moment in the dq coordinate system, i d (k) is the feedback value of the direct axis current at the kth moment in the dq coordinate system, i d (k+1) is the feedback value of the direct axis current at the k+1th moment in the dq coordinate system, T s is the control period, L d is the direct axis inductance in the dq coordinate system, L q is the quadrature-axis inductance in the dq coordinate system, ω e is the electrical angular velocity, V d (k) is the direct axis voltage at the kth moment in the dq coordinate system, V q (k) is the quadrature axis voltage at the kth moment in the dq coordinate system, R is the stator resistance, The above q * The calculation formula of (k+1) is obtained by the following steps: Given the input angle θ of the motor m * The third-order Taylor expansion is: Substituting formulas (31) and (33) in step 2 into formula (39), we can obtain Using Euler's forward approximation rule, Assumptions Substitute formula (41) into formula (40) and use We can get formula (42); The above d (k+1) and i q The calculation formula of (k+1) is obtained by the following steps: According to the stator voltage equation, using Euler's forward approximation rule, The above formula (45) and formula (46) can be obtained; Finally, the eight voltage vectors of the three-phase two-level PWM inverter are respectively substituted into the value function g, and the voltage vector with the minimum value of g is defined as the optimal vector. The optimal vector acts on the power module to output the PWM wave to control the operation of the motor.
2. The method for improving the position control accuracy of a servo press according to claim 1, characterized in that: 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.
3. The method for improving the position control accuracy of a servo press according to claim 2, characterized in that: The stator voltage equation of the permanent magnet synchronous motor in the rotating coordinate system is: in: ψ d =L d I d +ψ f (27), ψ q =L q I q (28), where ψ d is the direct-axis stator flux, ψ q is the quadrature-axis stator flux.
Citation Information
Patent Citations
Servo control method and device, terminal and storage medium
CN117227242A
