Patent Grant
12117782
The invention relates to the technical field of linear motor motion control, and particularly relates to a linear motor motion control method, device, equipment and storage medium.
Linear motors have excellent servo performance such as high precision, strong stability and fast response speed. They effectively solve the contradiction between precision, speed and large stroke, and have gradually become the mainstream driving method for high-speed and high-acceleration precision motion platforms. However, since linear motors do not have intermediate mechanical transmission links, they are easily affected by parameter perturbations, thrust fluctuations and other disturbances during high-precision positioning. As one of the key technologies of linear motor precision motion systems, motion control strategy is also the core technology of controllers. How to improve positioning accuracy and anti-interference ability under high response speed has always been a difficult point in research.
PID control (proportional-integral-derivative control) has always been a traditional control method widely used in practical engineering for linear motors due to its simple control structure and convenient parameter adjustment. However, PID control has contradictions among rapidity, overshoot, robustness and high precision, which seriously limits the response speed and anti-interference ability of linear motors under high positioning accuracy indicators. Therefore, it is increasingly difficult for traditional PID control to meet the requirements for high-precision positioning and fast anti-interference of linear motors under high-speed and high-acceleration conditions.
Based on the PID control method, the existing technology uses the expanded state observer to estimate the disturbance, thereby compensating it in the control law. Among them, the existing technology provides a model-free predictive control method for permanent magnet synchronous motors based on an expanded state observer (patent application number is CN201911092531.7). The method includes the following steps: Step A: Use the linear expansion observer to estimate the unknown and disturbed parts of the system, without involving the motor parameters; Step B: The motor reference current vector and feedback current vector are passed through the permanent magnet synchronous motor model-free controller based on the extended state observer, and the reference voltage vector is obtained using a complex vector current regulator. After PWM modulation, the six-way switching signals of the inverter are obtained. This realizes the control of the motor. However, the extended state observer in this method does not make full use of the known model information of the linear motor. Instead, it treats the model parameter information of the linear motor as unknown and unifies it with the unknown external disturbances into a total disturbance for observation and estimation. This is compensated in the control law. When a large disturbance occurs, this method cannot quickly distinguish and suppress the disturbance due to the limitations of the extended state observer, thus significantly reducing the output speed of the control amount, which in turn affects the response speed and anti-interference ability of the linear motor motion system.
The existing technology also provides an expanded state observer-model predictive control method for a rigid-flexible coupled motion platform (patent application number is CN202011297739.5). The method includes: Establish a dynamic model of the rigid-flexible coupled motion platform; and based on this, a prediction model suitable for the rigid-flexible coupled motion platform is proposed; Use the prediction model, a rolling optimization suitable for the high-precision control process of the rigid-flexible coupled motion platform is designed, in which the accumulation error between the prediction output and the motion planning input is defined as the optimization objective function; the expansion observer is applied to the feedback technology of the prediction model to form a closed-loop control algorithm. This method also does not use the model information of the controlled object, and does not consider the lag of the expanded state observer in disturbance observation and suppression. There is a phase lag when performing the disturbance suppression, which results in the inability to suppress disturbances quickly and accurately.
Therefore, it is necessary to study a new linear motor motion control scheme in order to make full use of the known linear motor model information and effectively improve the motion control accuracy, response speed and anti-interference ability of the linear motor.
The proposed invention provides a linear motor motion control method, device, equipment and storage medium, which is used to solve the technical problem that the existing linear motor motion control scheme has low motion control accuracy, low response speed, and poor anti-interference ability due to the difficulty in quickly distinguishing and suppressing disturbances.
The first aspect of the proposed invention provides a linear motor motion control method, which includes:
According to an implementation manner of the first aspect of the proposed invention, the state estimation based on the total control amount of the linear motor and the actual displacement signal includes:
According to the total control amount of the linear motor and the actual displacement signal, the corresponding displacement observation signal, the speed observation signal and the disturbance observation signal are calculated according to the following observation expressions:
In the formula, ż1 is a first-order derivative of the displacement observation signal, ż2 is a first-order derivative of the speed observation signal, ż3 is a first-order derivative of the disturbance observation signal, u is the total control amount of the linear motor, y is the actual displacement signal, z1 is the displacement observation signal, z2 is the speed observation signal, z3 is the disturbance observation signal, l1, l2 and l3 are the observation parameters of the extended state observer, a0, a1 and b0 are the model parameters of the linear motor. Among them, a0 represents displacement gain, & represents the speed gain, and b0 represents the control amount gain.
According to an implementable manner of the first aspect of the proposed invention, the model of the linear motor is:
{dot over (v)}=−a0y−a1v+w(t)+b0u
In the formula, {dot over (v)} is a first-order derivative of the actual speed signal of the linear motor, v is the actual speed signal of the linear motor, and w(t) is the external disturbance signal.
The observation parameters of the extended state observer satisfy:
In the formula, wo is the observation bandwidth parameter.
According to an implementable manner of the first aspect of the proposed invention, the expression of the phase advance controller is
In the formula, zd is the improved disturbance observation signal, z3 is the disturbance observation signal, r is the adjustment factor (r=0.5), and Te is the time constant
and s is the Laplace transform factor.
According to an implementable manner of the first aspect of the proposed invention, the prediction model used by the model prediction controller is
Yp(k)=PxΔX(k)+Iy(k)+PuΔU(k)
In the formula, k is a current time value, Yp (k) is a predicted displacement output value sequence (Yp (k)=[y(k+1|k) y(k+2|k)L y(k +p|k)]Tp×1), the superscript T indicates transposition, y(k+i|k) is a displacement output value in the future time k+i predicted at the current time k(i=1, 2, . . . , p), Px is a system matrix (Px=[CAΣx=12CAxLΣx=1pCAx]Tp×2), I is an unit matrix (I=[1 1 L 1]Tp×1), Pu is a control matrix
C=[1 0]), t is a signal sampling interval time, a1 represents a speed gain, b0 represents a control amount gain, ΔX(k) is an observation signal difference sequence (ΔX(k)=[z1(k)−z1 (k−1) z2(k)−z2(k−1)]T), z1 (k) represents the displacement observation signal at current time k, z(k−1) represents the displacement observation signal at a time k−1, z2 (k) is the speed observation signal at the current time k, z2 (k−1) represents the speed observation signal at the time k−1, y(k) is the actual displacement signal at the time k, ΔU(k) is a control increment sequence (ΔU(k)=[Δu0(k) Δu0(k+1) L Δu0(k+m−1)]Tm×1), Δu0(j) represents the optimal control amount increment, m is a control time domain, and p is a prediction time domain.
According to an implementable manner of the first aspect of the proposed invention, the rolling optimization is performed according to the displacement planning signal, the displacement observation signal and the speed observation signal to obtain the optimal control amount increment, including:
The displacement output value sequence is obtained through the prediction model, and the displacement output value sequence is substituted into the following optimization objective function:
J(m, p)=(Y)p(k)−R(k))TQ(Y)p(k)−R(k))+ΔU(k)TWΔU(k)
In the formula, m is the control time domain, p is the prediction time domain, R(k) is the displacement planning signal sequence R(k)=[r(k+1) r(k+2) L r(k+p)]Tp×1), r(k+i) is the displacement planning signal, Q and W are the weight matrix that needs to be designed (Q=diag[q1 q2 L qi]p×p, q1, q2, qi respectively correspond to the weight of the first, second, and ith signals in the obtained sequence Yp(k)−R(k), w=diag[w1 w2 L wi]m×m, w1, w2, wi respectively correspond to the weights of the first, second, and ith signals in ΔU(k));
Taking
as extreme value condition, the an optimization objective function according to the extreme value condition is solved, and the optimal control amount increment is obtained:
Δu0(k)=[1 0 L 0]1×m (PuTQTQPu+WTW)−1PuTQTQ(R(k+1)−PxΔ{circumflex over (X)}(k)−Iy(k)) According to an implementable manner of the first aspect of the proposed invention, the updating of the total control amount according to the improved disturbance observation signal and the optimal control amount increment includes:
The optimal control amount according to the optimal control amount increment is obtained;
The total control amount is updated according to the following formula:
In the formula, u represents the total control amount, u0 represents the optimal control amount, zd is the improved disturbance observation signal, b0 is a parameter in the model of the linear motor, and represents the control amount gain.
The second aspect of the proposed invention provides a linear motor motion control system, characterized in that it includes:
According to an implementable manner of the second aspect of the proposed invention, the extended state observer is specifically used for:
According to the total control amount of the linear motor and the actual displacement signal, the corresponding displacement observation signal, the speed observation signal and the disturbance observation signal are calculated according to the following observation expressions:
In the formula, ż1 is a first-order derivative of the displacement observation signal, ż2 is a first-order derivative of the speed observation signal, ż3 is a first-order derivative of the disturbance observation signal, u is the total control amount of the linear motor, y is the actual displacement signal, z1 is the displacement observation signal, z2 is the speed observation signal, z3 is the disturbance observation signal, l1, l2 and l3 are the observation parameters of the extended state observer, a0, a1 and b0 are the model parameters of the linear motor. Among them, a0 represents displacement gain, a1 represents speed gain, and b0 represents control amount gain.
According to an implementable manner of the second aspect of the proposed invention, the model of the linear motor is:
{dot over (v)}=−a0y−a1v+w(t)+b0u
in the formula, {dot over (v)} is a first-order derivative of the actual speed signal of the linear motor, v is the actual speed signal of the linear motor, and w(t) is the external disturbance signal;
In the formula, w0 is an observation bandwidth parameter.
According to an implementable manner of the second aspect of the proposed invention, the expression of the phase advance controller is:
In the formula, zd is the improved disturbance observation signal, z3 is the disturbance observation signal, r is an adjustment factor (r=0.5), and Te is a time constant
and s is a Laplace transform factor.
According to an implementable manner of the second aspect of the proposed invention, the prediction model used by the model prediction controller is:
Yp(k)=PxΔX(k)+Iy(k)+PuΔU(k)
In the formula, k is the current time value, Yp (k) is the predicted displacement output value sequence (Yp(k)=[y(k+1|k) y(k+2|k) L y(k+p|k)]Tp×1), the superscript T indicates transposition, y(k+i|k) is the displacement output value in the future time k+i predicted at the current time k(i=1, 2, . . . , p), Px is the system matrix (Px=[CAΣx=12CAxLΣx=1pCAx]Tp×2), I is the unit matrix (I=[1 1 L 1]Tp×1), Pu is the control matrix
t is the signal sampling interval time, a1 represents the speed gain, b0 represents the control amount gain, ΔX(k) is the observation signal difference sequence (ΔX(k)=[z1(k)−z1 (k−1) z2 (k)−z2 (k−1)]T), z1(k) represents the displacement observation signal at time k, z1(k−1) represents the displacement observation signal at time k−1, z2(k) is the speed observation signal at time k, z2(k−1) represents the speed observation signal at the time k−1, y(k) is the actual displacement signal at the time k, ΔU(k) is the control increment sequence (ΔU(k)=[Δu0 (k) Δu0 (k+1) L Δu0 (k+m−1)]Tm×m1), Δu0(j) represents the optimal control amount increment, m is the control time domain, and p is the prediction time domain.
According to an implementable manner of the second aspect of the proposed invention, the model prediction controller is specifically used for:
The displacement output value sequence is obtained through the prediction model, and the displacement output value sequence is substituted into the following optimization objective function:
J(m, p)=(Yp(k)−R(k))TQ(Yp(k)−R(k))+ΔU(k)TWΔU(k)
In the formula, m is the control time domain, p is the prediction time domain, R(k) is the displacement planning signal sequence (R(k)=[r(k+1) r(k+2) L r(k+p)]Tp×1), r(k+i) is the displacement planning signal, Q and W are the weight matrix that needs to be designed (Q=diag[q1 q2 L qi]pxp, q1, q2, qi respectively correspond to the weight of the first, second, and ith signals in the obtained sequence Yp(k)−R(k), W=diag[w1 w2 L wi]m×m, w1, w2, wi respectively correspond to the weights of the first, second, and ith signals in ΔU(k));
Taking
as the extreme value condition, solve the optimization objective function according to the extreme value condition, and obtain the optimal control amount increment:
Δu0(k)=[1 0 L 0]1×m(PuTQTQPu+WTW)−1PuTQTQ(R(k+1)−PxΔ{circumflex over (X)}(k)−Iy(k))
According to an implementable manner of the second aspect of the proposed invention, the motor control module includes:
An optimal control amount determination unit is used to obtain the optimal control amount based on the optimal control amount increment;
The update calculation unit is used to update the total control amount according to the following formula:
In the formula, u represents the total control amount, u0 represents the optimal control amount, zd is the improved disturbance observation signal, b0 is a parameter in the model of the linear motor, and represents the control amount gain.
The third aspect of the proposed invention provides a linear motor motion control device, which includes:
The fourth aspect of the proposed invention is a computer-readable storage medium. A computer program is stored on the computer-readable storage medium. When the computer program is executed by a processor, the linear motor movement control method can be realized in any of the above-mentioned ways.
It can be seen from the above technical solutions that the proposed invention has the following advantages:
In order to explain the embodiments of the proposed invention or the technical solutions in the prior art more clearly. The drawings that need to be used in the description of the embodiments or prior art will be briefly introduced below. Obviously, the drawings in the following description are only some embodiments of the proposed invention. For those of ordinary skill in the art, other drawings can be obtained based on these drawings without exerting any creative effort.
In
The embodiments of the proposed invention provide a linear motor motion control method, device, equipment and storage medium, which is used to solve the technical problem that the existing linear motor motion control scheme has low motion control accuracy, low response speed, and poor anti-interference ability due to the difficulty in quickly distinguishing and suppressing disturbances.
In order to make the purpose, features, and advantages of the proposed invention more obvious and easier to understand, the technical solutions in the embodiments of the proposed invention will be clearly and completely described below in conjunction with the accompanying drawings in the embodiments of the proposed invention. Obviously, the embodiments described below are only some, not all, of the embodiments of the proposed invention. Based on the embodiments of the proposed invention, all other embodiments obtained by those of ordinary skill in the art without creative efforts fall within the scope of protection of the proposed invention.
The invention provides a linear motor motion control method.
As shown in
Step S1: The displacement planning signal and the actual displacement signal of the linear motor are obtained.
Step S2: An extended state observer constructed in advance based on the model parameters of the linear motor is used to perform state estimation based on the total control amount of the linear motor and the actual displacement signal. And the corresponding displacement observation signal, the speed observation signal and the disturbance observation signal are obtained;
In this embodiment, the extended state observer is designed according to the model parameters of the linear motor. Among them, the model parameters of the linear motor can be obtained through system identification, searching the product manual of the linear motor, etc. After obtaining the model parameters of the linear motor, the model parameters of the linear motor can be used to design the extended state observer. Then the linear motor part no longer needs to be estimated. Therefore, the disturbance observation signal obtained by the extended state observer in this embodiment is only the estimation result of the external disturbance signal, and does not include the estimation result of the model structure of the linear motor in the prior art. Therefore, it can effectively improve the estimation accuracy of the external unknown disturbances.
In an implementable manner, the state estimation based on the total control amount of the linear motor and the actual displacement signal includes:
According to the total control amount of the linear motor and the actual displacement signal, the corresponding displacement observation signal, the speed observation signal and the disturbance observation signal are calculated according to the following observation expressions:
In the formula, z is a first-order derivative of the DISPLACEMENT OBSERVATION SIGNAL, Ż2 IS A FIRST-ORDER DERIVATIVE OF THE speed observation signal, ż3 is a first-order derivative of the disturbance observation signal, u is the total control amount of the linear motor, y is the actual displacement signal, u is the total control amount of the linear motor, z1 is the displacement observation signal, z2 is the speed observation signal, z3 is the disturbance observation signal, l1, l2 and l3 bare the observation parameters of the extended state observer, a0, a1 and b0 are the model parameters of the linear motor. Among them, a0 represents displacement gain, a1 represents the speed gain, and b0 represents the control amount gain.
In an implementable manner, the model of the linear motor is
{dot over (v)}=−a0y−a1v+w(t)+b0u
In the formula, {dot over (v)} is a first-order derivative of the actual speed signal of the linear motor, v is the actual speed signal of the linear motor, and w(t) is the external disturbance signal;
The observation parameters of the extended state observer satisfy:
In the formula, w0 is the observation bandwidth parameter.
In this embodiment, the bandwidth adjustment method is used to design the size of the observation parameters, which is simple and convenient. Among them, the model parameters of the linear motor can be obtained through system identification based on the model of the linear motor. Specifically, for a certain linear motor, the model parameters can be identified by obtaining its actual displacement, speed and acceleration under the known total control amount and known external disturbance signal.
Step S3: A pre-constructed phase advance controller is used to improve the estimated lag of the disturbance observation signal and obtain an improved disturbance observation signal;
In an implementable manner, the expression of the phase advance controller is:
In the formula, zd is the improved disturbance observation signal, z3 is the disturbance observation signal, r is the adjustment factor (r=0.5), and Te is the time constant
and s is the Laplace transform factor.
In order to improve the estimation accuracy of the external disturbance signal by the disturbance observation signal, in this embodiment, the pre-designed phase advance controller is called to compensate and improve the estimation lag, and the improved disturbance observation signal obtained is better than the original disturbance observation signal. The improved signal has higher accuracy and can effectively improve the suppression effect of the disturbance suffered by the linear motor.
Step 4: A model prediction controller constructed in advance based on the mathematical model of the linear motor is used to perform the rolling optimization based on the displacement planning signal, the displacement observation signal and the speed observation signal to obtain the optimal control amount increment;
In an implementable manner, the prediction model used by the model prediction controller is:
Yp(k)=PxΔX(k)+Iy(k)+PuΔU(k)
In the formula, k is the current time value, Yp(k) is the predicted displacement output value sequence (Yp(k)=[y(k+1|k) y(k+2|k) L y(k+p|k)]Tp×1), the superscript T indicates transposition, y(k+i|k) is the displacement output value in the future time k+i predicted at the current time k(i=1, 2, . . . , p), Px is the system matrix (Px=CAΣx=12CAxLΣx=1pCAx]Tp×2), I is the unit matrix (I=[1 1 L 1]Tp×1), Pu is the control matrix
t is the signal sampling interval time, a1 represents the speed gain, b0 represents the control amount gain, ΔX(k) is the difference observation signal sequence (ΔX(k)=[z1(k)−z1(k−1) z2(k)−z2(k−1)]T), z1(k) represents the displacement observation signal at time k, z1(k−1) represents the displacement observation signal at time k−1, z2(k) is the speed observation signal at time k, z2(k−1) represents the speed observation signal at the time k−1, y(k) is the actual displacement signal at the time k, ΔU(k) is the control increment sequence (ΔU(k)=[Δu0(k) Δu0(k+1) L Δu0(k+m−1)]Tm×1), Δu0(j) represents the optimal control amount increment, m is the control time domain, and p is the prediction time domain.
In an implementable manner, the rolling optimization is performed according to the displacement planning signal, the displacement observation signal and the speed observation signal to obtain the optimal control amount increment, which includes:
The displacement output value sequence is obtained through the prediction model, and the displacement output value sequence is substituted into the following optimization objective function:
J(m, p)=(Y)p(k)−R(k))TQ(Y)p(k)−R(k))+ΔU(k)TWΔU(k)
In the formula, m is the control time domain, p is the prediction time domain, R(k) is the displacement planning signal sequence (R(k)=[r(k+1) r(k+2) L r(k+p)]Tp×1), r(k+i) is the displacement planning signal, Q and W are the weight matrix that needs to be designed (Q=diag[q1 q2 L qi]p×p, q1, q2, qi respectively correspond to the weight of the first, second, and ith signals in the obtained sequence Yp(k)−R(k), W=diag[w1 w2 L wi]m×m, w1, w2, wi respectively correspond to the weights of the first, second, and ith signals in ΔU(k));
Taking
as the extreme value condition, solve the optimization objective function according to the extreme value condition, and obtain the optimal control amount increment:
Δu0(k)=[1 0 L 0]1×m(PuTQTQPu+WTW)−1PuTQTQ(R(k+1)−PxΔ{circumflex over (X)}(k)−Iy(k))
Step S5: The total control amount is updated based on the improved disturbance observation signal and the optimal control amount increment, and the corresponding drive signal is output to the drive end of the linear motor based on the updated total control amount. This achieves the motion control of the linear motor.
In an implementable manner, the updating of the total control amount according to the improved disturbance observation signal and the optimal control amount increment includes:
In the formula, u represents the total control amount, u0 represents the optimal control amount, zd is the improved disturbance observation signal, b0 is a parameter in the model of the linear motor, and represents the control amount gain.
In this embodiment, the optimal control amount increment is generated based on the model prediction controller designed based on the mathematical model of the linear motor. Combining the optimal control amount increment and the disturbance observation signal improved by the phase advance controller, the total control amount is updated and calculated to adjust the drive signal corresponding to the total control amount for driving the linear motor in real time. It is conceivable that the total control amount calculated based on the improved disturbance observation signal with higher accuracy is bound to have higher accuracy, which can effectively improve the motion control accuracy and control speed of the linear motor.
Generally, the linear motor can be driven by a voltage signal, and the output force of the linear motor depends on the current generated by the voltage signal. Therefore, specifically, the drive signal may be a voltage signal. Of course, a current drive method can also be used, that is, the drive signal can also be a current signal.
The above embodiments of the proposed invention make full use of the model parameter information of the linear motor. Based on the extended state observer pre-designed according to the model parameters of the linear motor and the model prediction controller pre-designed based on the mathematical model of the linear motor, the disturbance signal of the system is accurately observed, and the targeted control and compensation is carried out. This can greatly improve the motion control accuracy and response speed of the linear motor, and effectively optimize the anti-interference performance of the linear motor control.
The beneficial effects of the linear motor motion control method provided in this application will be described in detail below with reference to specific schematic diagrams.
As can be seen from
Specifically, as shown in
The invention also provides a linear motor motion control system.
Please refer to
The linear motor motion control system provided by an embodiment of the proposed invention includes:
In a way that can be implemented, the extended state observer 2 is specifically used to:
According to the total control amount of the linear motor and the actual displacement signal, the corresponding displacement observation signal, the speed observation signal and the disturbance observation signal are calculated according to the following observation expressions:
In the formula, ż1 is a first-order derivative of the displacement observation signal, ż2 is a first-order derivative of the speed observation signal, ż3 is a first-order derivative of the disturbance observation signal, u is the total control amount of the linear motor, y is the actual displacement signal, u is the total control amount of the linear motor, z1 is the displacement observation signal, z2 is the speed observation signal, z3 is the disturbance observation signal, l1, l2 and l3 are the observation parameters of the extended state observer, a0, a1 and b0 are the model parameters of the linear motor. Among them, a0 represents displacement gain, a1 represents the speed gain, and b0 represents the control amount gain.
In a way that can be implemented, the model of the linear motor is:
{dot over (v)}=−a0y−a1v+w(t)+b0u
In the formula, {dot over (v)} is a first-order derivative of the actual speed signal of the linear motor, v is the actual speed signal of the linear motor, and w(t) is the external disturbance signal;
The observation parameters of the extended state observer 2 satisfy:
In the formula, wo is the observation bandwidth parameter.
In a way that can be implemented, the expression of the phase advance controller model is:
In the formula, zd is the improved disturbance observation signal, z3 is the disturbance: observation signal, r is the adjustment factor (r=0.5), and Te is the time constant
and s is the Laplace transform factor.
In a way that can be implemented, the prediction model used by the model prediction controller 4 is
Yp(k)=PxΔX(k)+Iy(k)+PuΔU(k)
In the formula, k is the current time value, Yp(k) is the predicted displacement output value sequence (Yp(k)=[y (k+1|k) y(k+2|k) L y(k+p|k)]Tpx1), the superscript T indicates transposition, y(k+i|k) is the displacement output value in the future time k+i predicted at the current time k(i=1, 2, . . . , p), Px is the system matrix (Px=[CAΣx=12CAxLΣx=1pCAx]Tp×2), Px unit matrix (I=[1 1 L 1]Tp×1), Pu is the control matrix
t is the signal sampling interval time, a1 represents the speed gain, b represents the control amount gain, ΔX(k) is the observation signal difference sequence (ΔX(k)=[z1(k)−z1 (k−1) z2(k)−z2 (k−1)]T), z1(k) represents the displacement observation signal at time k, z1 (k−1) represents the displacement observation signal at time k−1, z2(k) is the speed observation signal at time k, z2 (k−1) represents the speed observation signal at the time k−1, y(k) is the actual displacement signal at the time k, ΔU(k) is the control increment sequence (ΔU(k)=[Δu0(k) Δu0(k+1) L Δu0(k+m−1)]Tm×1), Δu0(j) represents the optimal control amount increment, m is the control time domain, and p is the prediction time domain.
In a way that can be implemented, the model prediction controller 4 is specifically used for:
The displacement output value sequence is obtained through the prediction model, and the displacement output value sequence is substituted into the following optimization objective function:
J(m, p)=(Y)p(k)−R(k))TQ(Y)p(k)−R(k))+ΔU(k)TWΔU(k)
In the formula, m is the control time domain, p is the prediction time domain, R(k) is the displacement planning signal sequence (R(k)=[r(k+1) r(k+2) L r(k+p)]Tp×1), r(k+i) is the displacement planning signal, Q and W are the weight matrix that needs to be designed (Q=diag [q1 q2 L qi]p×p, q1, q2, qi respectively correspond to the weight of the first, second, and ith signals in the obtained sequence Yp(k)−R(k), W=diag[w1w2 L wi]m×m, w1, w2, wi respectively correspond to the weights of the first, second, and ith signals in ΔU(k));
Taking
as the extreme value condition, solve the
optimization objective function according to the extreme value condition, and obtain the optimal control amount increment:
Δu0(k)=[1 0 L 0]1×m(PuTQTQPu+WTW)−1PuTQTQ(R(k+1)−PxΔ{circumflex over (X)}(k)−Iy(k))
In a way that can be implemented, the motor control module 5 includes:
The optimal control amount determination unit is used to obtain the optimal control amount based on the optimal control amount increment;
The calculation unit is updated, which is used to update the total control amount according to the following formula:
In the formula, u represents the total control amount, u0 represents the optimal control amount, zd is the improved disturbance observation signal, b0 is a parameter in the model of the linear motor, and represents the control amount gain.
The invention also provides a linear motor motion control device, which includes:
The proposed invention also provides a computer-readable storage medium. A computer program is stored on the computer-readable storage medium. When the computer program is executed by a processor, the linear motor motion control method as described in any of the above embodiments is implemented.
The above-mentioned embodiments of the proposed invention have at least the following advantages:
Those skilled in the art can clearly understand that for the convenience and simplicity of description, for the specific working processes of the above-described systems, devices and modules, reference can be made to the corresponding processes in the foregoing method embodiments. For specific beneficial effects of the systems, devices and modules described above, please refer to the corresponding beneficial effects in the foregoing method embodiments, and will not be described again here.
In the several embodiments provided in this application, it should be understood that the disclosed systems, devices and methods can be implemented in other ways. For example, the system embodiments described above are only illustrative. For example, the division of modules is only a logical function division. In actual implementation, there may be other division methods. For example, multiple modules or components may be combined or can be integrated into another system, or some features can be ignored, or not implemented. On the other hand, the coupling or direct coupling or communication connection between each other shown or discussed may be through some interfaces, indirect coupling or communication connection of devices or modules, which may be in electrical, mechanical or other forms.
The modules described as separate components may or may not be physically separated, and the components shown as modules may or may not be physical modules, that is, they may be located in one place, or they may be distributed to multiple network modules. Some or all of the modules can be selected according to actual needs to achieve the purpose of the solution of this embodiment.
In addition, each functional module in various embodiments of the proposed invention can be integrated into one processing module, or each module can exist physically alone, or two or more modules can be integrated into one module. The above integrated modules can be implemented in the form of hardware or software function modules.
If the integrated module is implemented in the form of a software function module and sold or used as an independent product, it can be stored in a computer-readable storage medium. Based on this understanding, the technical solution of the proposed invention is essentially or contributes to the existing technology or all or part of the technical solution can be embodied in the form of a software product. And the computer software product is stored in a storage medium, which includes several instructions to cause the computer device (which may be a personal computer, a server, or a network device, etc.) to execute all or part of the steps of the methods described in various embodiments of the proposed invention. The aforementioned storage media includes U disk, mobile hard disk, read-only memory (ROM), random access memory (RAM), magnetic disk or optical disk and other media that can store program code.
As mentioned above, the above embodiments are only used to illustrate the technical solution of the proposed invention, but not to limit it. Although the proposed invention has been described in detail with reference to the foregoing embodiments, those of ordinary skill in the art should understand that they can still modify the foregoing. The technical solutions described in each embodiment may be modified, or some of the technical features may be equivalently replaced; however, these modifications or substitutions do not cause the essence of the corresponding technical solutions to deviate from the spirit and scope of the technical solutions of each embodiment of the proposed invention.
| Number | Date | Country | Kind |
|---|---|---|---|
| 202211009753.X | Aug 2022 | CN | national |
This application is a continuation of International Patent Application No. PCT/CN2023/093956 with a filing date of May 12, 2023, designating the United States, now pending, and further claims priority to Chinese Patent Application No. 202211009753. X with a filing date of Aug. 22, 2022. The content of the aforementioned applications, including any intervening amendments thereto, are incorporated herein by reference.
| Number | Name | Date | Kind |
|---|---|---|---|
| 20090005886 | Gao | Jan 2009 | A1 |
| 20200089229 | Lee | Mar 2020 | A1 |
| Number | Date | Country |
|---|---|---|
| 1938934 | Mar 2007 | CN |
| 109695893 | Apr 2019 | CN |
| 110034715 | Jul 2019 | CN |
| 110034715 | Jul 2019 | CN |
| 110209122 | Sep 2019 | CN |
| 110912480 | Mar 2020 | CN |
| 111817638 | Oct 2020 | CN |
| 112558469 | Mar 2021 | CN |
| 113091088 | Jul 2021 | CN |
| 113777930 | Dec 2021 | CN |
| Entry |
|---|
| Lui et al, “Model Predictive Control with Integral Control and Constraint Handling for Mechatronic Systems”, 2010, pp. 424-429, downloaded from https://ieeexplore.ieee.org/document/5553527 (Year: 2010). |
| Chenguang et al, “A state-compensation extended state observer for model predictive control”, 2017, pp. 1-9, dowloaded from https://www.sciencedirect.com/science/article/pii/S0947358016302503 (Year: 2017). |
| Wang et al, “Extended State Observer-Based Predictive Speed Control for Permanent Magnet Linear Synchronous” 2019, pp. 1-11, downloaded from Motorhttps://www.mdpi.com/2227-9717/7/9/618 (Year: 2019). |
| Roset et al, “Observer Based Model Predictive Control” 2006 pp. 6, downloaded from chrome-extension://efaidnbmnnnibpcajpcglclefindmkaj/https://alexandria.tue.nl/openaccess/Metis204663.pdf (Year: 2006). |
| Liuping Wang, “Model Predictive Control System Design and Implementation Using MATLAB®”, 2009, publisher Springer, pp. 111 (Year: 2009). |
| Yachao Liu et al., “Extended State Observer-Based IMC-PID Tracking Control of PMLSM Servo Systems”, IEEE Access, Apr. 5, 2021. |
| Yachao Liu, “Improved Linear Active Disterdancc Rejection Control for Permanent Magnet Linear Synchronous Motor”, McCromotors, May 31, 2021. |
| Number | Date | Country | |
|---|---|---|---|
| 20240176315 A1 | May 2024 | US |
| Number | Date | Country | |
|---|---|---|---|
| Parent | PCT/CN2023/093956 | May 2023 | WO |
| Child | 18430513 | US |
