BACKGROUND
Technical Field
The present disclosure relates to a control method of a permanent magnet synchronous motor, and in particular, to a nonlinear predictive position control method suitable for a biaxial permanent magnet synchronous motor.
Description of Related Art
A permanent magnet synchronous motor is favorable because of its advantages of simple structure, high power density, and wide speed range, and is commonly adopted in precision machining of CNC machine tools, semiconductor micromachining, robots and other applications. However, in the actual working process, because of the turning of the reference contour trajectory, the unbalanced load of the biaxial drive motor and other factors, the performance of the biaxial permanent magnet synchronous motor driving system deteriorates and the contour tracking accuracy is decreased. Therefore, it is of great significance to study the permanent magnet synchronous motor position tracking control strategy to achieve efficient and stable operation of the biaxial permanent magnet synchronous motor driving system.
In recent years, domestic and foreign scholars have conducted in-depth research on biaxial contour control methods. Specifically, the model predictive control method is commonly adopted in multi-motor control systems due to its advantages such as fast dynamic response speed. In Literature [1], based on generalized model predictive control, the permanent magnet synchronous motor tracking error is set as a control target and added to the value function and solved to obtain a single-axis drive motor cascade generalized predictive controller to drive motors of various axes, and combined with cross-coupling control decoupling to realize the contour tracking control of the biaxial permanent magnet synchronous motor driving system. In Literature [2], in combination with the model predictive control method, the tracking error and contour error are set as control targets and introduced into the value function simultaneously to solve the control law based on the optimal control theory, thereby determining the controller structure of the system, and realizing the drive control of the biaxial motor. However, the conventional model predictive control methods mostly employ a cascade controller structure to control the biaxial drive motor. The conventional controller structure is relatively redundant and has limited dynamic response performance.
SUMMARY
The technical problem to be solved by the present disclosure is to provide a nonlinear predictive position control method that is able to improve the dynamic response capability of a biaxial drive motor and improve the contour tracking accuracy of a biaxial permanent magnet synchronous motor driving system. The disclosure has a simple structure, fast dynamic response and high position tracking accuracy, and is of great significance for improving the biaxial contour tracking accuracy.
The technical solution adopted by the present disclosure is as follows.
In consideration of uncertainty disturbance of the biaxial permanent magnet synchronous motor driving system, a value function for the biaxial permanent magnet synchronous motor driving system and a constraint condition of the value function are constructed, and the value function is solved to obtain a voltage control quantity of the permanent magnet synchronous motor. The voltage control quantity of the permanent magnet synchronous motor is input into the stator voltage input end of the permanent magnet synchronous motor, thereby realizing the adjustment control of the nonlinear predicative position of the biaxial permanent magnet synchronous motor driving system.
The value function for the biaxial permanent magnet synchronous motor driving system is constructed as follows.
- in the formula, J is a value of the value function adopted by a predictive controller, T1 and T2 are the predicative step sizes of a current loop and a position loop of the permanent magnet synchronous motor respectively; Y1ref and Y2ref respectively represent a reference output vector of the value function, H1 and H2 respectively represent a weight coefficient matrix of the value function, Y1 and Y2 respectively represent an output evaluation vector of the value function, t represents a time, r represents a future control time domain; y1(t) and y2(t) respectively represent a first component and a second component of an actual output vector of the control system at the time t; y1&(t) and y2&(t) respectively represent the first-order derivatives of the first component and the second component of the actual output vector of the control system at the time t; y2&&(t) represents the second-order derivative of the second component of the actual output vector of the control system at the time t; y1ref(t) and y2ref(t) respectively represent the first component and the second component of the reference output vector of the control system at the time t; y1&ref(t) and y2&ref(t) respectively represent the first-order derivatives of the first component and the second component of the reference output vector of the control system at the time t; y2&&ref(t) and y2&&ref(t) respectively represent the second-order derivative and the third-order derivative of the second component of the reference output vector of the control system at the time t; idi(t) and idi*(t) respectively represent the actual value and reference value of the d-axis current of the two permanent magnet synchronous motors at the time t, θi (t) and θi*(t) respectively represent the actual value and reference value of the position angle of the two permanent magnet synchronous motors at the time t, i=1, 2 represents the reference sign of the two permanent magnet synchronous motors;
- the above value function enables the permanent magnet synchronous motor system to track the given value as quickly as possible.
Under the described value function, nonlinear constraint conditions of the permanent magnet synchronous motor constructed for the biaxial system permanent magnet synchronous motor are further established:
- in the formula, x (t) represents the state variable at time t, x&(t) represents the first-order derivative of the state variable at time t, iqi represents the actual value of the q-axis current of the two permanent magnet synchronous motors, ωi is the mechanical angular velocity of the two permanent magnet synchronous motors, u(t) represents the input vector of the motor control system at time t, udi and uqi respectively represent the voltage control quantities of the permanent magnet synchronous motor at d-axis and q-axis; bdi, bqi, bωi, and bθi respectively represent disturbance caused by d-axis parameter changes, q-axis parameter changes, external load changes and mechanical interference in the permanent magnet synchronous motor system; f( ) represents the nonlinear function of the motor control system, h( ) represents the output function of the motor control system, b(t) represents the uncertainty disturbance vector at time t, g1( ) and g2( ) respectively represent the coefficient matrix functions of the input vector and disturbance vector; Rs, Ls, ψf, p, Jm, and B respectively represent the stator resistance, inductance, rotor permanent magnet flux, number of pole pairs, moment of inertia, and friction coefficient of the permanent magnet synchronous motor;
- then, the voltage control quantity u(t) of the permanent magnet synchronous motor is obtained by minimizing an expression of the value function as the target, that is, taking ∂J/∂u=0 as the target for solving.
The voltage control quantities udi and uqi in the voltage control quantity u(t) of the permanent magnet synchronous motor at d-axis and q-axis are input to the stator voltage input end of the permanent magnet synchronous motor, thereby realizing the adjustment control of the nonlinear predictive position of the biaxial permanent magnet synchronous motor driving system.
The uncertainty disturbance b(t) is obtained by establishing a processing of a nonlinear disturbance observer.
The nonlinear disturbance observer of the present disclosure may realize high-precision control of trajectory tracking of the biaxial permanent magnet synchronous motor driving system and perform real-time estimation of the uncertainty disturbance b(t) of the permanent magnet synchronous motor system.
The nonlinear disturbance observer is as follows.
- in the formula, {circumflex over (b)}(t) represents the disturbance observation value; z and z& respectively represent the state variable and a first-order derivative thereof inside the nonlinear observer; q( ) is the nonlinear function to be designed for the nonlinear observer; L is the gain matrix of the nonlinear observer; l1, l2, l3, and l4 respectively represent the first, second, third and fourth gain coefficients of the nonlinear observer, and the gain coefficients l1, l2, l3, and l4>0; {circumflex over (b)}di, {circumflex over (b)}qi, {circumflex over (b)}ωi, and {circumflex over (b)}θi, respectively represent the observed values of bdi, bqi, bωi, and bθi;
- the disturbance observation value {circumflex over (b)} is obtained through processing by the nonlinear disturbance observer, and the disturbance observation value {circumflex over (b)} is substituted into the value function as the uncertainty disturbance b(t).
The voltage control quantity u(t) of the permanent magnet synchronous motor obtained by solving through the method is specifically calculated as:
- in the formula, G( ) represents the coefficient matrix related to the motor parameters in the voltage control quantity; δj1 and δj3 represent the coefficients related to the predicative step size in the voltage control quantity; K1 and K2 respectively represent the constant matrix in the voltage control quantity; represents the Lie derivative symbol.
The characteristics and advantageous effects of the present disclosure are as follows:
The method of the present disclosure applies the nonlinear predictive control algorithm to the position control of the permanent magnet synchronous motor of the biaxial system, and establishes the optimal control value function for the nonlinear predictive position control.
The present disclosure employs a nonlinear predictive control algorithm to construct a non-cascade controller of a single-axis motor, thus simplifying the conventional cascade controller structure. In the meantime, the present disclosure employs optimization principles to solve the nonlinear predictive value function, so it is possible to effectively reduce the calculation amount of system and improve the dynamic response performance of system. In this way, the contour tracking accuracy of the biaxial permanent magnet synchronous motor driving system may be improved.
By constructing the nonlinear disturbance observer to estimate the uncertainty disturbance of the system, the influence of the parameter uncertainty disturbance on the position tracking of the motor of the biaxial system may be effectively suppressed.
BRIEF DESCRIPTION OF THE DRAWINGS
FIG. 1 is a schematic diagram illustrating the principle of an embodiment of a control system under the method of the present disclosure.
FIG. 2 is a schematic diagram illustrating the principle of an algorithm for nonlinear predictive control of a single-axis motor.
DESCRIPTION OF THE EMBODIMENTS
The present disclosure will be described in detail below with reference to the embodiments and drawings. The described specific embodiments only illustrate the present disclosure and are not intended to limit the present disclosure.
In view of the problems of slow dynamic response and significant contour error in the conventional biaxial contour control structure, the present disclosure constructs a cascaded single-loop nonlinear predictive position controller based on a nonlinear predictive control algorithm, thereby improving the dynamic response performance of the system. In the meantime, a nonlinear disturbance observer is constructed to observe uncertainty disturbances such as system parameter mismatch and load mutation to suppress the influence caused by system uncertainty disturbances. In addition, in order to coordinately control the two axes, a position correction loop is incorporated to realize compensation for the given position of the biaxial drive motor.
The specific implementation of the present disclosure is as follows:
FIG. 1 is a system block diagram illustrating application of the nonlinear predictive position control method of the biaxial permanent magnet synchronous motor driving system of the present disclosure. In the figure, θx* and θy* are the given values of the rotor positions of the x-axis and y-axis motors respectively, θx and θy are the actual values of the rotor positions of the x-axis and y-axis motors respectively, θx and θy are the mechanical angular speeds of the x-axis and y-axis motors respectively, idx* and idy* are the given d-axis currents of the x-axis and y-axis motors respectively, idx and idy are the actual values of d-axis currents of the x-axis and y-axis motors respectively, iqx and iqy are the actual values of q-axis currents of the x-axis and y-axis motors respectively, {circumflex over (b)}x and {circumflex over (b)}y are the disturbance observation values of the x-axis and y-axis motors respectively, θcx and θcy are the corrections of given position output by the cross-coupling control structure; p* and p are the given position and actual position matrix of the biaxial system respectively; Cx and Cy are the contour error compensation coefficients of various axes; Cc is the gain coefficient of the cross-coupling controller; c is the biaxial contour error.
The following value function for the biaxial permanent magnet synchronous motor driving system is constructed as:
Under the described value function, nonlinear constraint conditions of the permanent magnet synchronous motor constructed for the biaxial system permanent magnet synchronous motor are further established:
The uncertainty disturbance b(t) is obtained by establishing a processing of a nonlinear disturbance observer. The nonlinear disturbance observer is as follows:
The disturbance observation value {circumflex over (b)} is obtained through processing by the above nonlinear disturbance observer, and the disturbance observation value {circumflex over (b)} is substituted into the value function as the uncertainty disturbance b(t).
Then, the voltage control quantity u(t) of the permanent magnet synchronous motor is obtained by minimizing an expression of the value function as the target, that is, taking ∂J/∂u=0 as the target for solving.
The voltage control quantity u(t) of the permanent magnet synchronous motor obtained from the final solution is specifically calculated as:
The voltage control quantities udi and uqi in the voltage control quantity u(t) of the permanent magnet synchronous motor at d-axis and q-axis are input to the stator voltage input end of the permanent magnet synchronous motor, thereby realizing the adjustment control of the nonlinear predictive position of the biaxial permanent magnet synchronous motor driving system.
FIG. 2 is a schematic diagram illustrating the principle of an algorithm of a nonlinear predicative position of a single-axis motor. In the specific implementation process of nonlinear predictive position control, a control method of a given value of d-axis current id*=0 of the permanent magnet synchronous motor is adopted. Moreover, the position angle θi* of mechanical rotor of motor of each axis corresponding to the given contour trajectory of the biaxial permanent magnet synchronous motor driving system is used as the given input of the nonlinear predictive position controller, and combined with the nonlinear disturbance observer to realize control of the permanent magnet synchronous motor of each axis.
The present disclosure has been described above in conjunction with the drawings. However, the present disclosure is not limited to the above-mentioned specific embodiments. The above-mentioned specific embodiments are only illustrative and not restrictive. Under the inspiration of the present disclosure, those of ordinary skill in the art can make many modifications without departing from the principle of the present disclosure, and the modifications are all within the scope to be protected by the present disclosure.