CN112558469B - Extended state observer-model prediction control method of rigid-flexible coupling motion platform - Google Patents

Extended state observer-model prediction control method of rigid-flexible coupling motion platform Download PDF

Info

Publication number
CN112558469B
CN112558469B CN202011297739.5A CN202011297739A CN112558469B CN 112558469 B CN112558469 B CN 112558469B CN 202011297739 A CN202011297739 A CN 202011297739A CN 112558469 B CN112558469 B CN 112558469B
Authority
CN
China
Prior art keywords
rigid
control
motion platform
model
flexible
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202011297739.5A
Other languages
Chinese (zh)
Other versions
CN112558469A (en
Inventor
黄观新
高忠义
杨志军
黄建彬
危宇泰
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Guangdong University of Technology
Original Assignee
Guangdong University of Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Guangdong University of Technology filed Critical Guangdong University of Technology
Priority to CN202011297739.5A priority Critical patent/CN112558469B/en
Publication of CN112558469A publication Critical patent/CN112558469A/en
Application granted granted Critical
Publication of CN112558469B publication Critical patent/CN112558469B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
    • G05B13/045Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance using a perturbation signal
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/048Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators using a predictor

Landscapes

  • Engineering & Computer Science (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Feedback Control In General (AREA)

Abstract

The invention discloses an extended state observer-model predictive control method of a rigid-flexible coupling motion platform, which comprises the following steps: establishing a dynamic model of the rigid-flexible coupling motion platform, and providing a prediction model suitable for the rigid-flexible coupling motion platform based on the dynamic model; designing rolling optimization suitable for the rigid-flexible coupling motion platform in the high-precision control process by utilizing the prediction model, wherein the accumulated error between the prediction output and the motion planning input is defined as an optimization objective function; and applying the extended observer to a feedback technology of the prediction model to form a closed-loop control algorithm. The invention provides an MPC control method based on ESO feedback aiming at high-precision control and combining the characteristics of a flexible hinge, and by utilizing the feedback of ESO, the model prediction can acquire the disturbance on a rigid-flexible coupling motion platform in real time, so that the optimal solution of control optimization is obtained, and the control effect is improved.

Description

Extended state observer-model prediction control method of rigid-flexible coupling motion platform
Technical Field
The invention relates to the field of rigid-flexible coupling motion platform control, in particular to an extended observer-model prediction control method for a rigid-flexible coupling motion platform.
Background
Electronic manufacturing equipment plays a very important role in the electronics industry, particularly in modern manufacturing technologies. The precision motion platform is a key component of electronic manufacturing equipment, friction is a main reason for limiting precision of the precision motion platform, and the rigid-flexible coupling motion platform utilizes deformation of a flexible hinge to compensate friction, so that precision of the precision motion platform is improved.
At present, most of high-precision motion platforms adopt a classical PID control algorithm, namely a control strategy for eliminating an error is determined by the error between a control target and an actual behavior, but the control signal of the high-precision motion platform cannot be determined to be the optimal control signal based on the error control mode.
Disclosure of Invention
The invention aims to provide a model prediction control method of a rigid-flexible coupling motion platform extended observer, so that the rigid-flexible coupling motion platform can realize higher speed and higher precision at low cost.
In order to realize the task, the invention adopts the following technical scheme:
an extended state observer-model predictive control method of a rigid-flexible coupling motion platform comprises the following steps:
establishing a dynamic model of the rigid-flexible coupling motion platform, and providing a prediction model suitable for the rigid-flexible coupling motion platform based on the dynamic model;
designing rolling optimization suitable for the rigid-flexible coupling motion platform in the high-precision control process by utilizing the prediction model, wherein the accumulated error between the prediction output and the motion planning input is defined as an optimization objective function;
and applying the extended observer to a feedback technology of the prediction model to form a closed-loop control algorithm.
Furthermore, the rigid-flexible coupling motion platform is a single-degree-of-freedom linear motion platform and comprises an intermediate platform, an external frame, a flexible hinge, a mechanical guide rail, a grating ruler, a linear motor stator and a linear motor rotor, wherein the intermediate platform is connected with the external frame through the flexible hinge, and the linear motor rotor and the intermediate platform are connected and fixed at the lower part of the intermediate platform through bolts.
Further, the prediction model of the rigid-flexible coupling motion platform is represented as:
Figure BDA0002785723630000021
wherein, alpha is an adjustable parameter, msDenotes the mass of the intermediate platform, mbRepresenting the mass of the outer frame, y1=ds,y2=db,
Figure BDA0002785723630000022
dsIndicating the displacement of the intermediate platform, dbRepresenting the displacement of an external frame, k representing the rigidity coefficient of the flexible hinge, c representing the damping coefficient of the flexible hinge, delta t representing the sampling period, b representing the power conversion coefficient of a rigid-flexible coupling motion platform control system, u representing the signal of the control system, fbThe friction force applied to the rigid-flexible coupling motion platform is shown, and the superscript t represents the time t.
Further, the optimization objective function is represented as:
Figure BDA0002785723630000023
wherein, y1(i | t) predicting y at time i for current time t1,siTarget displacement, v, of the intermediate platform at time iiIs the target speed at time i;
Utthe variables that need to be solved for optimization for roll optimization are the control input signals, which are expressed as:
Ut={u(t|t),u(t+1|t),…,u(t+p-1|t)}
wherein u (t | t) is a control signal for predicting t moment at the current moment t, and p represents a prediction time domain of a prediction model;
the control objective is to minimize the difference between the predicted displacement and the motion planning displacement, with the motion planning displacement and velocity input as follows:
{st+1,st+2,…,st+p}
{vt+1,vt+2,…,vt+p}
and the optimization process must satisfy the control constraints of the control system:
umin≤u(t+i)≤umax,i≥0
where u (t + i) is the control signal at time t + i, uminAs a minimum value of the control signal, umaxIs the maximum value of the control signal.
Further, in the prediction model, under an unconstrained condition, an unconstrained minimum value of the target is 0, and the following equation can be obtained by solving:
Figure BDA0002785723630000024
substituting the formula into a prediction model to obtain a control input signal u without constraint for rigid-flexible coupling motion platform model predictionm(t):
Figure BDA0002785723630000031
And further, obtaining a prediction displacement through the prediction model, substituting the prediction displacement into an optimization objective function, and solving the objective function to realize rolling optimization of model prediction.
Further, defining the rigidity and the damping of the flexible hinge in the motion process of the rigid-flexible coupling motion platform as disturbance omega (t), and simplifying the control input signal to obtain a simplified control input signal;
the control of the prediction model is performed with the latest obtained measurement values at each sampling period
Figure BDA0002785723630000035
And
Figure BDA0002785723630000036
the optimization objective function is refreshed, the optimal solution of the refreshed optimization objective function is solved, and then the optimal solution, namely u, can be obtainedm(t) acting on the system.
Further, the application of the extended observer to the feedback technique of the prediction model to form a closed-loop control algorithm includes:
actively estimating the state of the control system at the current moment by using the extended state observer and estimating disturbance; the following three-order ESO was constructed:
Figure BDA0002785723630000032
in the above formula, z1Is the estimation of the displacement of the system by the ESO observer; z is a radical of2Is an estimate of the system speed by the ESO observer; z is a radical of3The method is an estimation of total disturbance of the system by an ESO observer;
observer-based 20 available y1And z1The transfer function of (a) is:
Figure BDA0002785723630000033
the characteristic polynomial corresponding to the above formula is s31s22s+β3The poles of the characteristic polynomial corresponding to the observer are uniformly distributed to s-omegaoI.e. configuring the characteristic polynomial as (s + ω)o)3Then three gains β of the observer can be obtained1=3ωo,
Figure BDA0002785723630000034
Wherein ω isoIs a parameter for which the bandwidth of the ESO observer is adjustable;
by means of estimation feedback of the ESO to the system, the prediction model can know the disturbance of the rigid-flexible coupling motion platform in real time, namely the z estimated by the ESO1、z2And z3Respectively replacing y in unconstrained control input signals1、y3And omega (t) to obtain an optimal control signal, so that the model prediction-ESO control algorithm realizes closed-loop control.
Further, in the actual use process, firstly, a displacement signal of the rigid-flexible coupling motion platform is acquired by using a grating ruler, the displacement signal and a control signal of the platform are substituted into an ESO observer to obtain the displacement and the speed of the middle platform and the deformation force and the damping force of the flexible hinge of the rigid-flexible coupling motion platform in the control process, then, the state parameters and the disturbance of the platform are subjected to an expression of an unconstrained control input signal to obtain an optimal control signal in the control process of the rigid-flexible coupling motion platform, then, the control signal is optimized in real time by using rolling optimization, then, the optimized control signal is input into a driver by a controller to obtain the force required by the rigid-flexible coupling motion platform in the control process, and finally, the control is realized on the control of the rigid-flexible coupling motion platform, so that the prediction control is completed.
Compared with the prior art, the invention has the following technical characteristics:
in the rigid-flexible coupling motion platform in the scheme of the invention, the middle platform is connected with the external frame by using a flexible hinge; an MPC strategy of a rigid-flexible coupling motion platform is designed; the invention provides an MPC control method based on ESO feedback aiming at high-precision control and combining the characteristics of a flexible hinge, and by utilizing the feedback of ESO, the model prediction can acquire the disturbance on a rigid-flexible coupling motion platform in real time, so that the optimal solution of control optimization is obtained, and the control effect is improved.
Drawings
FIG. 1 is a structure diagram of a rigid-flexible coupling motion platform;
FIG. 2 is an equivalent model diagram of a rigid-flexible coupling motion platform;
fig. 3 is a control block diagram of the rigid-flexible coupling motion platform.
Detailed Description
The core of the model predictive control algorithm is online constraint optimization generated by the characteristics of a predictive control method, however, online constraints aiming at problems in various research fields are difficult to satisfy. In order to solve the limitation of model prediction control on a rigid-flexible coupling motion platform, the invention introduces an Extended State Observer (ESO) of active disturbance rejection control in model prediction. The ESO is an estimation and processing of the disturbances experienced by the controlled object during the control process. Whether the controlled object is time-varying or constant, linear or nonlinear, deterministic or uncertain, after compensation based on the ESO estimation result, the system can be simplified into a basic structure of a feedback system of integral series connection, so that various complicated problems become simple and solvable.
The invention provides a model prediction control method of a rigid-flexible coupling motion platform expansion observer, which is suitable for model prediction of a rigid-flexible coupling motion platform according to a dynamic model of the rigid-flexible coupling motion platform. Therefore, the method estimates the disturbance of the deformation force and the damping force of the flexible hinge and the state of the rigid-flexible coupling motion platform by using the ESO, thereby perfecting the feedback mechanism of model prediction.
The rigid-flexible coupling motion platform structure mainly comprises a middle platform and an outer frame, wherein the middle platform is connected with the outer frame through a flexible hinge. In fig. 1 to 3:
r represents a fillet radius of the flexible hinge, w represents a width of the flexible hinge, t represents a thickness of the flexible hinge, and l represents a length of the flexible hinge; m issDenotes the mass of the intermediate platform, mbRepresenting the mass of the outer frame, fbRepresenting the friction force f experienced by the platform in rigid-flexible couplingsRepresenting the driving force applied to the rigid-flexible coupling motion platform, k representing the rigidity coefficient of the flexible hinge, c representing the damping coefficient of the flexible hinge, dsIndicating the displacement of the intermediate platform, dbRepresenting the displacement of the outer frame, b0A power conversion coefficient representing a control system; the superscript circle of the formula in this scheme represents the derivative of the parameter.
Referring to the attached drawings, the extended observer-model predictive control method of the rigid-flexible coupling motion platform comprises the following steps:
step 1, establishing a dynamic model of the rigid-flexible coupling motion platform, and providing a prediction model suitable for the rigid-flexible coupling motion platform based on the dynamic model.
The structure of the rigid-flexible coupling motion platform is shown in figure 1 and is a single-degree-of-freedom linear motion platform, the platform comprises an external frame, an intermediate platform, a flexible hinge, a mechanical guide rail, a grating ruler, a linear motor stator and a linear motor rotor, and the linear motor rotor and the intermediate platform are connected and fixed below the intermediate platform through bolts. An equivalent model of a rigid-flexible coupling motion platform can be made according to the rigid-flexible coupling motion platform of fig. 1 as shown in fig. 2.
Based on the simplified model of the rigid-flexible coupling motion platform in fig. 2, a dynamic model of the rigid-flexible coupling motion platform is established:
Figure BDA0002785723630000051
order to
Figure BDA0002785723630000061
Figure BDA0002785723630000062
Equation 1 reduces to:
Figure BDA0002785723630000063
b is defined as the power conversion coefficient of the rigid-flexible coupling motion platform control system, u is the signal of the control system, and then:
fsbu formula 3
By substituting the above formula for formula 1, one can obtain:
Figure BDA0002785723630000064
order:
Figure BDA0002785723630000065
substituting the above formula into formula 4, and introducing an adjustable parameter α in order to adapt to uncertain factors in the experiment and improve the control effect of the experiment, and reducing the formula 4 into:
Figure BDA0002785723630000066
order:
Figure BDA0002785723630000067
then equation 6 is simplified to:
Figure BDA0002785723630000068
and (3) substituting the differential quotient of the state variables for the derivative to obtain an approximate difference equation under the sampling period delta t, and changing the equation 7 into the following equation:
Figure BDA0002785723630000071
in the formula 8, t refers to the current time, t +1 refers to the next time, and the formula 8 is simplified as follows:
Ayt+1=(A+ΔtB)yt+Δtdtformula 9
Namely:
Figure BDA0002785723630000072
from this, equation 10 is a proposed prediction model for the rigid-flexible coupled motion platform MPC, and y in the prediction model is used1And y3The predicted displacement output starting at step t is noted as:
Figure BDA0002785723630000073
where p is the prediction time domain of the prediction model, t +1| t in parentheses represents the output at the time when t +1 is predicted at the current time t, and so on.
And 2, designing rolling optimization suitable for the rigid-flexible coupling motion platform in the high-precision control process based on the prediction model of the rigid-flexible coupling motion platform.
And recording the variable needing to be solved and optimized in the rolling optimization in the prediction model as a control input signal as Ut
UtOr { u (t | t), u (t +1| t), …, u (t + p-1| t) } formula 12
Where u (t | t) is a control signal that predicts time t at current time t.
The control objective is to minimize the difference between the predicted displacement and the motion planning displacement, with the motion planning displacement and velocity input as follows:
Figure BDA0002785723630000074
and the optimization process must satisfy the control constraints of the control system:
umin≤u(t+i)≤umaxi is not less than 0 and 14
Where u (t + i) is the control signal at time t + i, uminAs a minimum value of the control signal, umaxIs the maximum value of the control signal.
In summary, that the present invention is looking at finding the best control input for rolling optimization, the more closely the predicted system output is to the motion planning input, the better, then the present invention defines the accumulated error between the predicted output and the motion planning input as the optimization objective function as follows:
Figure BDA0002785723630000081
in the above formula, y1(i | t) predicting y at time i for current time t1,siDisplacement of the intermediate platform at time i, viThe velocity at time i.
The optimization problem described above can then be summarized as the following optimization control problem:
problem 1:
optimizing variables: u shapet
An objective function:
Figure BDA0002785723630000082
constraint conditions are as follows: u. ofmin≤u(t+i|t)≤umax,i≥0,1,…,p+1
In the prediction model, p is taken as 1 in order to simplify calculation; thus, in the unconstrained condition, it is easy to know that the unconstrained minimum of the target is 0, and the following equation can be solved:
Figure BDA0002785723630000083
substituting the above formula into the third equation in the prediction model formula 10 to obtain the control input signal u without constraint for rigid-flexible coupling motion platform model predictionm(t):
Figure BDA0002785723630000084
The control input signal for equation 17, including the constraint, is therefore:
Figure BDA0002785723630000085
therefore, in this step, the prediction displacement of the model prediction is obtained by equation 10, and substituted into equation 15, and then the rolling optimization of the model prediction is realized by solving problem 1.
And 3, applying a feedback technology of the core-extended observer of the active disturbance rejection controller and model prediction to form a closed-loop control algorithm.
From the above equation 18, it can be known that if u (t) at the time k acts on the system, the intermediate platform of the rigid-flexible coupled motion platform may receive a deformation force and a damping force, which are external forces received by the prediction model at the time k, and the resolution accuracy of the grating scale in the embodiment of the present invention is ± 0.1um of feedback accuracy, and the deformation of the flexible hinge is smaller than this value, so a more accurate measurement method is required to measure the deformation of the flexible hinge, and the rigidity and the damping of the flexible hinge are also uncertain values in the motion process of the rigid-flexible coupled motion platform. Therefore, defining the two as the disturbance ω (t), which is the amount to be compensated, equation 17 is simplified as:
Figure BDA0002785723630000091
in summary, the predictive model control of the present invention uses the most recently obtained measurement (feedback obtained) for each sampling period
Figure BDA0002785723630000092
And
Figure BDA0002785723630000093
) The problem 1 is refreshed, and the optimal solution of the refreshed optimization problem is solved, so that the optimal solution, i.e. u, can be obtainedm(t) acting on the system.
According to the basic principle of predictive model control, the state of the current time obtained by the state observer will be the starting point for future prediction. And because the rolling optimization decision observer of the invention needs to detect the actual output of the system at each step of control, and needs to introduce real-time tracking compensation for the interference error suffered by the controlled object. The present invention therefore uses the extended state observer to actively estimate the state of the control system at the present time and to estimate the total disturbance of the damping force and the deformation force that occurs in equation 18.
Because the rigid-flexible coupling motion platform is a second-order system, the invention constructs the following three-order ESO:
Figure BDA0002785723630000094
in the formula 20, z1Is the estimation of the displacement of the system by the ESO observer; z is a radical of2Is an estimate of the system speed by the ESO observer; z is a radical of3The method is an estimation of the total disturbance of the system by an ESO observer, namely the damping force and the damping variation suffered in the control process of the rigid-flexible coupling intermediate platformAnd (4) estimating the shape force.
Observer-based 20 available y1And z1The transfer function of (a) is:
Figure BDA0002785723630000095
the characteristic polynomial corresponding to the formula 21 is s31s22s+β3The poles of the characteristic polynomial corresponding to the observer are uniformly distributed to s-omegaoI.e. configuring the characteristic polynomial as (s + ω)o)3Then three gains β of the observer can be obtained1=3ωo,
Figure BDA0002785723630000101
Wherein ω isoIs a tunable parameter for the bandwidth of the ESO observer.
Therefore, the estimated feedback of the ESO to the system enables the prediction model to know the disturbance of the rigid-flexible coupling motion platform in real time, namely, the z estimated by the ESO1、z2And z3By replacing y in formula 17, respectively1、y3And omega (t) to obtain an optimal control signal, so that the model prediction-ESO control algorithm realizes closed-loop control.
In the actual use process, firstly, a displacement signal of the rigid-flexible coupling motion platform is acquired by using the grating ruler, the displacement signal and the control signal of the platform are substituted into an ESO observer to obtain state parameters (displacement and speed of the platform) of the rigid-flexible coupling motion platform in the control process and deformation force and damping force of the flexible hinge, then the state parameters and disturbance of the platform are subjected to formula 17 to obtain an optimal control signal in the control process of the rigid-flexible coupling motion platform, then the control signal is optimized in real time by using rolling optimization, then the optimized control signal is input into a driver by a controller to obtain the force required by the rigid-flexible coupling motion platform in the control process, and finally the control is realized on the control of the rigid-flexible coupling motion platform, so that the prediction control is completed.
The above embodiments are only used to illustrate the technical solutions of the present application, and not to limit the same; although the present application has been described in detail with reference to the foregoing embodiments, it should be understood by those of ordinary skill in the art that: the technical solutions described in the foregoing embodiments may still be modified, or some technical features may be equivalently replaced; such modifications and substitutions do not substantially depart from the spirit and scope of the embodiments of the present application and are intended to be included within the scope of the present application.

Claims (6)

1. An extended state observer-model predictive control method of a rigid-flexible coupling motion platform is characterized by comprising the following steps:
establishing a dynamic model of the rigid-flexible coupling motion platform, and providing a prediction model suitable for the rigid-flexible coupling motion platform based on the dynamic model;
designing rolling optimization suitable for the rigid-flexible coupling motion platform in the high-precision control process by utilizing the prediction model, wherein the accumulated error between the prediction output and the motion planning input is defined as an optimization objective function;
applying the extended observer to a feedback technology of a prediction model to form a closed-loop control algorithm;
the prediction model of the rigid-flexible coupling motion platform is represented as:
Figure FDA0003538472350000011
wherein, alpha is an adjustable parameter, msDenotes the mass of the intermediate platform, mbRepresenting the mass of the outer frame, y1=ds,y2=db,
Figure FDA0003538472350000012
dsIndicating the displacement of the intermediate platform, dbRepresenting the displacement of the outer frame, k representing the rigidity coefficient of the flexible hinge, c representing the damping coefficient of the flexible hinge, delta t representing the sampling period, and b being of the rigid-flexible coupling motion platform control systemA power conversion coefficient, u is a signal of a control system, fbThe friction force borne by the rigid-flexible coupling motion platform is shown, and the superscript t shows the time t;
the optimization objective function is represented as:
Figure FDA0003538472350000013
wherein, y1(i | t) predicting y at time i for current time t1,siDisplacement of the intermediate platform at time i, viThe speed at the moment i is represented by p, and the prediction time domain of the prediction model is represented by p;
Utthe variables that need to be solved for optimization for roll optimization are the control input signals, which are expressed as:
Ut={u(t|t),u(t+1|t),…,u(t+p-1|t)}
wherein u (t | t) is a control signal for predicting t moment at the current moment t;
the control objective is to minimize the difference between the predicted displacement and the motion planning displacement, with the motion planning displacement and velocity input as follows:
{st+1,st+2,…,st+p}
{vt+1,vt+2,…,vt+p}
and the optimization process must satisfy the control constraints of the control system:
umin≤u(t+i)≤umax,i≥0
where u (t + i) is the control signal at time t + i, uminAs a minimum value of the control signal, umaxIs the maximum value of the control signal;
the application of the extended observer to the feedback technology of the prediction model to form a closed-loop control algorithm comprises the following steps:
actively estimating the state of the control system at the current moment by using the extended state observer and estimating disturbance;
the following three-order ESO was constructed:
Figure FDA0003538472350000021
in the above formula, z1Is the estimation of the displacement of the system by the ESO observer; z is a radical of2Is an estimate of the system speed by the ESO observer; z is a radical of3The method is an estimation of total disturbance of the system by an ESO observer;
observer-based 20 available y1And z1The transfer function of (a) is:
Figure FDA0003538472350000022
the characteristic polynomial corresponding to the above formula is s31s22s+β3The poles of the characteristic polynomial corresponding to the observer are uniformly distributed to s-omegaoI.e. configuring the characteristic polynomial as (s + ω)o)3Then three gains β of the observer can be obtained1=3ωo,
Figure FDA0003538472350000023
Wherein ω isoIs a parameter for which the bandwidth of the ESO observer is adjustable;
by means of estimation feedback of the ESO to the system, the prediction model can know the disturbance of the rigid-flexible coupling motion platform in real time, namely the z estimated by the ESO1、z2And z3Respectively replacing y in unconstrained control input signals1、y3And ω (t) to obtain an optimal control signal, so that the model prediction-ESO control algorithm realizes closed-loop control.
2. The extended state observer-model predictive control method for a rigid-flexible coupled motion platform according to claim 1, wherein the rigid-flexible coupled motion platform is a single-degree-of-freedom linear motion platform, and comprises an intermediate platform, an external frame, a flexible hinge, a mechanical guide rail, a grating ruler, a linear motor stator and a linear motor rotor, the intermediate platform is connected with the external frame by using the flexible hinge, and the linear motor rotor and the intermediate platform are fixed at the lower part of the intermediate platform by adopting a bolt connection.
3. The extended state observer-model predictive control method for a rigid-flexible coupled motion platform according to claim 1, wherein in the predictive model, under an unconstrained condition, an unconstrained minimum value of a target is 0, and the following equation can be obtained by solving:
Figure FDA0003538472350000031
substituting the formula into a prediction model to obtain a control input signal u without constraint for rigid-flexible coupling motion platform model predictionm(t):
Figure FDA0003538472350000032
4. The extended state observer-model predictive control method of a rigid-flexible coupled motion platform of claim 1, wherein a predictive displacement is obtained through a predictive model, the predictive displacement is substituted into an optimization objective function, and then rolling optimization of model prediction is achieved by solving the objective function.
5. The extended state observer-model predictive control method of the rigid-flexible coupled motion platform according to claim 1, characterized in that the stiffness and damping of the flexible hinge during the motion of the rigid-flexible coupled motion platform are defined as disturbance ω (t), and the control input signal is simplified to obtain a simplified control input signal;
the control of the prediction model is performed with the latest obtained measurement values at each sampling period
Figure FDA0003538472350000033
And
Figure FDA0003538472350000034
the optimization objective function is refreshed, the optimal solution of the refreshed optimization objective function is solved, and then the optimal solution, namely u, can be obtainedm(t) acting on the system.
6. The extended state observer-model predictive control method of a rigid-flexible coupled motion platform according to claim 1, wherein in the actual use process, a grating ruler is used to collect displacement signals of the rigid-flexible coupled motion platform, the displacement signals and control signals of the platform are substituted into an ESO observer to obtain the displacement and speed of the intermediate platform of the rigid-flexible coupled motion platform in the control process, the deformation force and damping force of a flexible hinge, the state parameters and disturbance of the platform are then passed through an expression of an unconstrained control input signal to obtain an optimal control signal in the rigid-flexible coupled motion platform control process, then a rolling optimization real-time optimization control signal is used, the optimized control signal is then input into a driver by a controller to obtain the force required by the rigid-flexible coupled motion platform in the control process, and finally the control is realized on the rigid-flexible coupled motion platform, thereby completing the predictive control.
CN202011297739.5A 2020-11-18 2020-11-18 Extended state observer-model prediction control method of rigid-flexible coupling motion platform Active CN112558469B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011297739.5A CN112558469B (en) 2020-11-18 2020-11-18 Extended state observer-model prediction control method of rigid-flexible coupling motion platform

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011297739.5A CN112558469B (en) 2020-11-18 2020-11-18 Extended state observer-model prediction control method of rigid-flexible coupling motion platform

Publications (2)

Publication Number Publication Date
CN112558469A CN112558469A (en) 2021-03-26
CN112558469B true CN112558469B (en) 2022-07-01

Family

ID=75043894

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011297739.5A Active CN112558469B (en) 2020-11-18 2020-11-18 Extended state observer-model prediction control method of rigid-flexible coupling motion platform

Country Status (1)

Country Link
CN (1) CN112558469B (en)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106094528A (en) * 2016-07-13 2016-11-09 上海航天控制技术研究所 A kind of spatial flexible robot arm vibration suppression algorithm
CN108415252A (en) * 2018-02-13 2018-08-17 南京理工大学 Electrohydraulic servo system modeling forecast Control Algorithm based on extended state observer
CN109129479A (en) * 2018-08-23 2019-01-04 广东工业大学 A kind of Rigid-flexible Coupled Motion platform courses method based on disturbance force compensating
CN109407511A (en) * 2018-11-22 2019-03-01 广东工业大学 Duplex path feedback Coupled Rigid-flexible platform courses method
CN109465827A (en) * 2018-11-22 2019-03-15 广东工业大学 Single feedback drives Coupled Rigid-flexible platform courses method
CN109581862A (en) * 2018-11-22 2019-04-05 广东工业大学 The driver of embedded disturbance estimation compensation algorithm

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106094528A (en) * 2016-07-13 2016-11-09 上海航天控制技术研究所 A kind of spatial flexible robot arm vibration suppression algorithm
CN108415252A (en) * 2018-02-13 2018-08-17 南京理工大学 Electrohydraulic servo system modeling forecast Control Algorithm based on extended state observer
CN109129479A (en) * 2018-08-23 2019-01-04 广东工业大学 A kind of Rigid-flexible Coupled Motion platform courses method based on disturbance force compensating
CN109407511A (en) * 2018-11-22 2019-03-01 广东工业大学 Duplex path feedback Coupled Rigid-flexible platform courses method
CN109465827A (en) * 2018-11-22 2019-03-15 广东工业大学 Single feedback drives Coupled Rigid-flexible platform courses method
CN109581862A (en) * 2018-11-22 2019-04-05 广东工业大学 The driver of embedded disturbance estimation compensation algorithm

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
《A Novel Motion Stage Design by Reducing Disturbance Bandwidth of ADRC for Higher Performance》;Zhijun Yang.etc;《Proceedings of the 38th Chinese Control Conference》;20191017;第4327-4331页 *
《基于观测器复合模型预测的直驱式风电系统控制研究》;史艳秋;《CNKI中国期刊全文数据库》;20190515;第1-85页 *
《面向高精度光电跟踪系统的非线性抗干扰控制方法研究》;冒建亮;《CNKI中国期刊全文数据库》;20200315;第1-142页 *

Also Published As

Publication number Publication date
CN112558469A (en) 2021-03-26

Similar Documents

Publication Publication Date Title
CN108614419B (en) Adaptive neural network control method of arc micro-electro-mechanical system
CN110018638B (en) Neural network active disturbance rejection controller for alternating-current radial magnetic bearing and construction method thereof
US6901320B2 (en) Friction compensation in a vehicle steering system
CN109129479B (en) Rigid-flexible coupling motion platform control method based on disturbance force compensation
KR101813615B1 (en) Apparatus and method for control of actuator
US5833407A (en) Method for estimating heat-included displacment in a machine tool
JP2020194375A (en) Servo system parameter identification method
CN106505909B (en) A kind of supersonic motor nonlinear dead-zone compensation control system and method
CN115085611B (en) Linear motor motion control method, device, equipment and storage medium
US6619086B1 (en) Control system for tandem rolling mill
JP4862752B2 (en) Electric inertia control method
CN112558469B (en) Extended state observer-model prediction control method of rigid-flexible coupling motion platform
JP2010019713A (en) Electric inertia control device of power meter system
US8970079B2 (en) Method for adjusting resistance of electromagnet in magnetic bearing and for sensorless determination of position of object mounted in magnetic bearing, taking into account adjusted value of resistance
CN109116721B (en) Control method for converting time-varying system into steady system
WO2018077593A1 (en) Method for determining a deadzone angle of a backlash in a mechanical drive-train system, method for controlling a drive motor controller as well as drive-train system
CN109465827B (en) Single-feedback single-drive rigid-flexible coupling platform control method
JP3085499B2 (en) Rolling mill control method and device
JP2838578B2 (en) Motor control device, disturbance load torque estimation device
CN112202376A (en) Linear motor active disturbance rejection control design method based on Taylor tracking differentiator
JP3599127B2 (en) Observer control arithmetic unit
Peng et al. Comparison of several active disturbance rejection control methods for rigid-flexible coupling motion stage
CN115230805B (en) Accurate steering control method for heavy-load AGV
CN115817185B (en) Method and system for controlling speed of medium-low speed maglev train
JPH04304181A (en) Suppressor/controller for torsional vibration of shaft

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant