CN112859600A - Mechanical system finite time control method based on extended state observer - Google Patents

Mechanical system finite time control method based on extended state observer Download PDF

Info

Publication number
CN112859600A
CN112859600A CN202110025694.4A CN202110025694A CN112859600A CN 112859600 A CN112859600 A CN 112859600A CN 202110025694 A CN202110025694 A CN 202110025694A CN 112859600 A CN112859600 A CN 112859600A
Authority
CN
China
Prior art keywords
state observer
signal
formula
extended state
sliding mode
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.)
Granted
Application number
CN202110025694.4A
Other languages
Chinese (zh)
Other versions
CN112859600B (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.)
China Spaceflight Electronic Technology Research Institute
Aerospace Times Feihong Technology Co ltd
Original Assignee
China Spaceflight Electronic Technology Research Institute
Aerospace Times Feihong Technology Co ltd
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 China Spaceflight Electronic Technology Research Institute, Aerospace Times Feihong Technology Co ltd filed Critical China Spaceflight Electronic Technology Research Institute
Priority to CN202110025694.4A priority Critical patent/CN112859600B/en
Publication of CN112859600A publication Critical patent/CN112859600A/en
Application granted granted Critical
Publication of CN112859600B publication Critical patent/CN112859600B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04—Adaptive 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/042—Adaptive 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
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

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

本发明属于轨迹跟踪技术领域，尤其涉及一种基于扩张状态观测器的机械系统有限时间控制方法。所述控制方法利用非线性扩张状态观测器来提高系统的鲁棒性，采用非奇异终端滑控制器对其滑模变量进行分数幂重构，使系统状态在滑动阶段能够有限时间快速收敛到平衡点处，实现对机械系统的控制。本发明的方法采用了同样具有有限时间收敛特性的非线性扩张状态观测器来提高系统的鲁棒性，采用非奇异终端滑模控制方法是实现有限时间控制目的，同时非奇异终端滑模因对其滑模变量进行分数幂重构，减少抖振，快速估计系统的模型不确定性和外部扰动，实现系统状态有限时间收敛到平衡点的邻域内。

Figure 202110025694

The invention belongs to the technical field of trajectory tracking, and in particular relates to a finite time control method of a mechanical system based on an expanded state observer. The control method uses a nonlinear extended state observer to improve the robustness of the system, and uses a non-singular terminal sliding controller to reconstruct the fractional power of its sliding mode variables, so that the system state can quickly converge to equilibrium in a limited time during the sliding phase. At the point, the control of the mechanical system is realized. The method of the invention adopts the nonlinear extended state observer which also has finite time convergence characteristics to improve the robustness of the system, and the non-singular terminal sliding mode control method is used to achieve the purpose of finite time control, and the non-singular terminal sliding mode causes The sliding mode variable is reconstructed to fractional power to reduce chattering, quickly estimate the model uncertainty and external disturbance of the system, and realize the finite-time convergence of the system state to the neighborhood of the equilibrium point.

Figure 202110025694

Description

Mechanical system finite time control method based on extended state observer
Technical Field
The invention belongs to the technical field of trajectory tracking, and particularly relates to a mechanical system finite time control method based on an extended state observer.
Technical Field
Uncertain second-order mechanical systems characterized by the Euler-Lagrange equation have many examples in the physical world, such as unmanned aerial vehicle systems, pneumatic servo systems, and rigid robotic arm systems. The finite time trajectory tracking control method has been widely studied in recent years because it has a feature of promoting the system state to quickly track a desired trajectory. In order to reduce the influence of uncertainty and external disturbance of a system model on control precision, the invention adopts a nonlinear extended state observer with limited time convergence characteristics to improve the robustness of the system.
The nonsingular terminal sliding mode control method is a core technology for realizing the purpose of finite time control. The sliding mode control is divided into an approach stage and a sliding stage, and in order to solve the problem of gradual convergence of the system state in the sliding stage in the traditional sliding mode control, fractional power reconstruction is carried out on sliding mode variables of a nonsingular terminal sliding mode, so that the system state can be quickly converged to a balance point within limited time in the sliding stage. In a traditional nonsingular terminal sliding mode controller, variable structure control is adopted as a robust item to restrain uncertainty and external disturbance of a system model. However, variable configuration control may excite high frequency buffeting of the controller, damage the actuator, and even cause system divergence.
Disclosure of Invention
The invention discloses a mechanical system finite time control method based on an extended state observer, which aims to solve any of the above problems or other potential problems in the prior art.
In order to solve the problems, the technical scheme of the invention is as follows: a mechanical system finite time control method based on an extended state observer specifically comprises the following steps:
s1) collecting position signal and speed signal of sensor device measuring system, comparing with target expected track value, and obtaining position signal error valueδ1And speed signal error value delta2；
Then the position signal and the estimated signal z of the extended state observer are compared1Comparing to obtain the estimation error e of the extended state observer1；
S2) will S1) get the position signal error value δ1And speed signal error value delta2As a sliding mode control quantity model, the error e of the obtained extended state observer is used1As the input of the extended state observer and the input of the extended state observer, the output s of the sliding mode control quantity and the estimated signal value z of the extended state observer are respectively obtained3；
S3) obtaining the output S of the sliding mode control quantity obtained in S2) and the estimated signal value z of the extended state observer3The output signal of the finite time controller is obtained as the input of the nonsingular terminal sliding mode controller;
s4) sends the output signal as a control signal to an actuator of the mechanical system.
Further, the step S1) includes the following steps:
s1.1) acquiring position signals x of a sensor device measurement system1Sum velocity signal x2，
S1.2) establishing an expected trajectory value xd,
S1.3) obtaining the position signal x1Sum velocity signal x2And establishing a desired trajectory value xdDifference is made to obtain a position signal error value delta1And speed signal error value delta2，
S1.4) and then the position signal x1And the estimated signal z of the extended state observer1Comparing to obtain the estimation error e of the extended state observer1。
Further, in S1.3), a position signal error value δ is obtained by equation (8)1And speed signal error value delta2The formula is as follows:
Figure BDA0002890168990000031
in the formula, xdTo the desired trajectory value, z2The signal value is estimated for the velocity of the extended state observer.
Further, the estimation error e of the extended state observer in S1.4)1The calculation is performed by the following equation (6):
e1(t)＝z1(t)-x1(t) (6)，
in the formula, z1(t) is a position estimation signal of the extended state observer, t being time.
Further, z is1(t) is obtained by the following formula, as shown below,
Figure BDA0002890168990000032
in the formula (I), the compound is shown in the specification,
Figure BDA0002890168990000033
is the real-time output quantity of the extended state observer, and when the time t is equal to 0, the initial value z is1(0)＝0,z1(t)。
Further, the specific steps of S2) are:
s2.1) obtaining a position signal error value delta from S1.3)1And speed signal error value delta2As the input of the sliding mode control quantity model, the output s of the sliding mode control quantity is obtained,
s2.2) obtaining the estimation error e of the extended state observer by the S1.4)1As an input of the extended state observer, an estimated signal value z of the extended state observer is obtained3。
Further, the control model in S2.1) is expressed by formula (10), which is as follows:
Figure BDA0002890168990000034
in the formula, s is the output of the sliding mode control quantity, sigma is a parameter, and sigma is>0, γ ═ p/q, p and q are positive odd variables, p ═ 2m +1, and p is>q, m are largeA positive integer at 0; sigγ(. cndot.) is a fractional power sign function.
Further, the extended state observer in said S2.2) is expressed by the formula (5), which is shown below,
Figure BDA0002890168990000041
in the formula, betaiTo extend the gain of the state observer, i ═ 1.2.3, e1To extend the state observer error signal, z1For the position estimation signal of the extended state observer, z2For the velocity estimation signal of the extended state observer, M0Is a known nominal part of the inertial matrix, which is a dynamic model of the mechanical system, and τ is a finite time controlled quantity.
Further, the specific steps of S3) are:
s3.1) obtaining the sliding mode control quantity output S from S2.1), and obtaining the estimated signal z of the extended state observer from S2.2)3And S1.3) position signal error value delta1And speed signal error value delta2As input of the nonsingular terminal sliding mode controller;
and S3.2) outputting a control signal by the nonsingular terminal sliding mode controller.
Further, the nonsingular terminal sliding mode controller in S3.1) obtains the finite time control quantity τ by the following formula (16), which is as follows:
Figure BDA0002890168990000042
in the formula (I), the compound is shown in the specification,
Figure BDA0002890168990000043
is a robust term of the system, K1And K2Is the normal constant gain.
The invention has the beneficial effects that: due to the adoption of the technical scheme, the method adopts the nonlinear extended state observer with the finite time convergence characteristic to improve the robustness of the system, adopts the nonsingular terminal sliding mode control method to achieve the finite time control purpose, and simultaneously performs fractional power reconstruction on sliding mode variables of the nonsingular terminal sliding mode to reduce buffeting, quickly estimates model uncertainty and external disturbance of the system and achieves that the finite time of the system state converges into the neighborhood of a balance point.
Drawings
Fig. 1 is a schematic flow chart of a finite time control method of an uncertain second-order mechanical system based on an extended state observer according to the present invention.
Fig. 2 is a performance effect diagram of the extended state observer provided by the present invention.
Fig. 3 is a diagram illustrating the tracking effect of the first joint position of the robot arm provided by the present invention.
Fig. 4 is a diagram illustrating the tracking effect of the second joint position of the robot arm provided by the present invention.
Detailed Description
In order to make the technical problems, technical solutions and advantages to be solved by the present invention clearer, the following detailed description is made with reference to specific steps, simulations and drawings.
Step S1, using the sensor device to measure the position signal and the speed signal of the system, the expression of the position signal and the speed signal is as follows:
the dynamic model of the second order uncertain system was established as follows:
Figure BDA0002890168990000051
in the formula (I), the compound is shown in the specification,
Figure BDA0002890168990000052
and
Figure BDA0002890168990000053
representing generalized position coordinates, velocity, and acceleration;
Figure BDA0002890168990000054
is an inertia matrix, where the nominal inertia matrix M0(q) is symmetrically positive, MΔ(q) represents the unknown part and,
Figure BDA0002890168990000055
which represents the term of the centrifugal coriolis force,
Figure BDA0002890168990000056
the term of the force of gravity is represented,
Figure BDA0002890168990000057
representing an unknown and bounded external disturbance,
Figure BDA0002890168990000061
representing the joint control input torque.
The kinetic model equation (1) can be rewritten as:
Figure BDA0002890168990000062
in the formula (I), the compound is shown in the specification,
Figure BDA0002890168990000063
is a composite disturbance of the mechanical system consisting of external disturbances and parameter uncertainty.
Define x separately1(t) q (t) and
Figure BDA0002890168990000064
then equation (2) can be rewritten as:
Figure BDA0002890168990000065
step S2, calculating the estimation signal of the extended state observer to the uncertainty and external non-disturbance of the system model, the process is as follows:
estimating the complex disturbance l of the mechanical system by using the extended state observerlDefined as a new state x3Then the system (3) can be rewritten as
Figure BDA0002890168990000066
For the system (4), the invention envisages the following extended state observer
Figure BDA0002890168990000067
Wherein
Figure BDA0002890168990000068
And 0<α<1 is an adjustable parameter, zi(i-1, 2,3) is used to estimate the state xi,βiIs the gain of the observer.
The observer error formula is defined as follows:
e1(t)＝z1(t)-x1(t) (6)
in the formula, z1(t) is a position estimation signal of the extended state observer, and when the time t is 0, the initial value z is set to be1(0)＝0,z1(t) is updated by the formula
Figure BDA0002890168990000069
Figure BDA00028901689900000610
Is the real-time output of the extended state observer (5).
Obtained from (4) and (5), the error system of the observer is
Figure BDA0002890168990000071
Step S3, calculating the nonsingular terminal sliding mode signal by using the system state, wherein the process is as follows:
based on the observed quantity z2And z3The invention designs a controller based on a nonsingular terminal sliding mode surface, so that the system state can reach a tracking target in a certain time.
Defining the tracking error of the system as
Figure BDA0002890168990000072
Wherein xdIs the desired trajectory.
The derivation of (8) and the substitution of (4) are carried out, the error equation of the system is
Figure BDA0002890168990000073
Designing nonsingular terminal sliding mode variables as
Figure BDA0002890168990000074
Where the parameter σ >0, γ ═ p/q, p and q are positive odd variables, p ═ 2m +1 is satisfied, and p > q.
Step S4, calculating an output signal of the finite time controller:
the driving system (4) of the nonsingular terminal sliding mode controller based on the extended state observer can be designed to reach the sliding mode surface by the aid of the driving system (10).
The time derivative of the sliding mode variable (10) is
Figure BDA0002890168990000075
Bringing (9) into (11), rewritable
Figure BDA0002890168990000081
When in use
Figure BDA0002890168990000082
The kinetic equation of the system is equivalent to a non-linear equation
Figure BDA0002890168990000083
According to the design method of the sliding mode controller, the control moment tau is taueq+τsmc. If the complex disturbance l of the system is precisely known, then
Figure BDA0002890168990000084
Can calculate taueq：
Figure BDA0002890168990000085
But l is in practice uncertain, so based on the extended state observer and boundary layer techniques the following controllers can be designed:
Figure BDA0002890168990000086
thus, in practice the controller may be designed to
Figure BDA0002890168990000087
Wherein z is3Is the output of the extended state observer, used to estimate the complex disturbance l,
Figure BDA0002890168990000088
is a robust term of the system, K1And K2Is the normal constant gain.
To better demonstrate that the controller may be a system with limited time convergence, system stability verification is described in detail below. The device comprises two parts: a stability certification of the extended state observer and a stability certification of the finite time controller. Wherein, the state convergence time of the extended state observer should be theoretically shorter than the state convergence time of the system.
Introduction 1: for any x and non-zero real y, the following inequality holds,
0≤|x|(1-tanh(|x/y|))≤a*|y| (17)
wherein, a*＝0.2785。
2, leading: for the system
Figure BDA0002890168990000091
Wherein
Figure BDA0002890168990000092
If a positive real scalar function V (x) is defined, such that
Figure BDA0002890168990000093
The system is stable for a limited time. And convergence time is
Figure BDA0002890168990000094
Theorem 1: for the extended state observer (5), there is an adjustable parameter β1,β2,β3And α, in the presence of
Figure BDA0002890168990000095
In this case, the error of the observer may converge into the neighborhood of zero in a finite time.
And (3) proving that:
selecting Lyapunov functions
Figure BDA0002890168990000096
Wherein
Figure BDA0002890168990000097
Represents a vector eiThe j element, P being
Figure BDA0002890168990000098
ηjTime ofThe derivative is
Figure BDA0002890168990000099
Wherein
Figure BDA00028901689900000910
B＝[0,0,1]T,
Figure BDA00028901689900000911
The feature matrix of A is
Figure BDA0002890168990000101
When beta is1,β2,β3And alpha satisfies
Figure BDA0002890168990000102
When the temperature of the water is higher than the set temperature,
Figure BDA0002890168990000103
if positive, A is a Hurwitz matrix, and the eigenvalues of A have positive real parts, P is a positive matrix.
To V1Is derived by
Figure BDA0002890168990000104
Wherein
Figure BDA0002890168990000105
In fact, having a root with a negative real part is equivalent to having a positive definite matrix Q, such that P is a solution of the lyapunov equation.
ATP+PA＝-Q (22)
According to (19), the following inequality holds
Figure BDA0002890168990000106
According to (21) and (22), the
Figure BDA0002890168990000111
If the condition is
Figure BDA0002890168990000112
Satisfy, then
Figure BDA0002890168990000113
When in use
Figure BDA0002890168990000114
And 0<θ0<1 is, then
Figure BDA0002890168990000115
Wherein
Figure BDA0002890168990000116
q2,min＝min{q2j,j＝1,2,…,n}。
According to (23) and inequality
Figure BDA0002890168990000117
Then
Figure BDA0002890168990000118
This is true. Therefore, the temperature of the molten metal is controlled,
Figure BDA0002890168990000119
error η of observer according to lemma 2jWill converge in a finite time, the time expression is
Figure BDA00028901689900001110
Step 6: and (3) carrying out stability analysis on the finite time controller, wherein the process is as follows:
theorem 2: for the system (9), a nonsingular terminal sliding mode controller (16) and a sliding mode variable (10) are designed, and a proper parameter K is selectede,K1Satisfy the requirement of
Figure BDA00028901689900001111
And K ise<K1The tracking error of the closed loop system can converge to the neighborhood of zero in a finite time.
And (3) proving that:
the (16) is brought into (9), so that a closed-loop system can be obtained
Figure BDA0002890168990000121
Selecting Lyapunov functions
Figure BDA0002890168990000122
Bringing the controller (16) into (12) can obtain
Figure BDA0002890168990000123
To V2Derivative, bring (30) into
Figure BDA0002890168990000124
According to theorem 1, z is known3Is bounded and there is a suitable parameter kej(j ═ 1, 2.. times, n) satisfies
Figure BDA0002890168990000125
Is obtained by unfolding (31)
Figure BDA0002890168990000126
Wherein
Figure BDA0002890168990000127
k3,min＝min{k3j,j＝1,2,…,n}，
Figure BDA0002890168990000128
If it is not
Figure BDA0002890168990000129
Then epsilon is less than or equal to 2 theta2λmin(K3)V2. Then (32) can be rewritten as
Figure BDA00028901689900001210
According to lemma 2, the system state may be at a finite time tf2Internally converging to the vicinity of the equilibrium point, and the time expression is
Figure BDA0002890168990000131
Example (b):
in order to verify the effectiveness of the proposed method, the invention gives a specific simulation process as follows:
the double-link rigid mechanical arm is adopted in the simulation to verify the effectiveness of the proposed controller, and the structural block diagram of the system is shown in fig. 1. Definition of x1＝[x11,x12]TAs the joint angle of the mechanical arm, then the correlation matrix in the two-link robot mathematical model is given:
Figure BDA0002890168990000132
Figure BDA0002890168990000133
Figure BDA0002890168990000134
in the formula
Figure BDA0002890168990000135
p3＝m2l1lc2，p4＝m1lc2+m2l1，p5＝m2lc2；miAnd liMass and length of the connecting rod i, m1＝2.00(kg),m2＝0.85(kg)，l1＝0.35(m),l2＝0.31(m)；IiIs the moment of inertia of the connecting rod i,
Figure BDA0002890168990000136
lciis the centroid of the ith link; g is 9.8 (m/s)2)。
The initial position and speed of the robot are:
x11(0)＝x12(0)＝1(rad)，x21(0)＝x22(0)＝0(rad/s)
the set desired trajectory is:
Figure BDA0002890168990000137
the disturbance torque is:
d(t)＝[0.1sin(0.5t)+0.25cos(0.5t),0.25sin(0.5t)+0.1sin(0.5t)]T
the parameters of the extended state observer are: α is 0.5, β1＝300,β2＝10,β325; the controller has parameters σ 50, p 9, q 7, and K1＝diag{150,150},K2＝diag{150,150},ρ＝0.1。
As shown in fig. 2, compared with the conventional state observer, the extended state observer can converge the system error to the neighborhood of zero in milliseconds, and the convergence time is much shorter than that of the system state; as shown in FIGS. 3 and 4, the position state error of the system can be converged to the zero neighborhood within a limited time, and the convergence precision reaches 10-3A rank.
The foregoing description shows and describes several preferred embodiments of the present application, but as aforementioned, it is to be understood that the application is not limited to the forms disclosed herein, but is not to be construed as excluding other embodiments and is capable of use in various other combinations, modifications, and environments and is capable of changes within the scope of the application as described herein, commensurate with the above teachings, or the skill or knowledge of the relevant art. And that modifications and variations may be effected by those skilled in the art without departing from the spirit and scope of the application, which is to be protected by the claims appended hereto.

Claims (10)

1.一种基于扩张状态观测器的机械系统有限时间控制方法，其特征在于，所述控制方法具体包括以下步骤：1. A finite time control method for a mechanical system based on an expanded state observer, wherein the control method specifically comprises the following steps: S1)采集传感器设备测量系统的位置信号和速度信号，再与目标期望轨迹值对比做差，分别得到位置信号误差值δ1和速度信号误差值δ2；S1) collect the position signal and velocity signal of the sensor equipment measurement system, and then compare with the target expected trajectory value to make a difference, and obtain the position signal error value δ 1 and the velocity signal error value δ 2 respectively; 再将位置信号与扩张状态观测器估计信号Z1做比较，得到扩张状态观测器的估计误差e1；Then compare the position signal with the estimated signal Z 1 of the extended state observer to obtain the estimated error e 1 of the extended state observer; S2)将S1)得到位置信号误差值δ1和速度信号误差值δ2作为滑模控制量模型，将得到的扩张状态观测器误差e1作为扩张状态观测器的输入，和扩张状态观测器的输入，分别得到滑模控制量的输出s和扩张状态观测器的估计信号值z3；S2) Take the position signal error value δ 1 and the velocity signal error value δ 2 obtained from S1) as the sliding mode control quantity model, take the obtained extended state observer error e 1 as the input of the extended state observer, and the extended state observer input, the output s of the sliding mode control variable and the estimated signal value z 3 of the expanded state observer are obtained respectively; S3)将S2)得到的滑模控制量的输出s和扩张状态观测器的估计信号值z3作为非奇异终端滑模控制器的输入，得到有限时间控制器的输出信号；S3) take the output s of the sliding mode control variable obtained in S2) and the estimated signal value z 3 of the extended state observer as the input of the non-singular terminal sliding mode controller, and obtain the output signal of the finite time controller; S4)将输出信号作为控制信号发送给机械系统的执行机构。S4) Send the output signal as a control signal to the actuator of the mechanical system. 2.根据权利要求1所述的控制方法，其特征在于，所述S1)具体步骤为：2. control method according to claim 1, is characterized in that, described S1) concrete steps are: S1.1)采集传感器设备测量系统的位置信号x1和速度信号x2，S1.1) Collect the position signal x 1 and the speed signal x 2 of the sensor device measurement system, S1.2)建立期望轨迹值xd，S1.2) Establish the desired trajectory value x d , S1.3)将得到的位置信号x1和速度信号x2与建立期望轨迹值xd做差值，得到位置信号误差值δ1和速度信号误差值δ2，S1.3) Make the difference between the obtained position signal x 1 and speed signal x 2 and the established expected trajectory value x d to obtain the position signal error value δ 1 and the speed signal error value δ 2 , S1.4)再将位置信号x1与扩张状态观测器估计信号z1做比较，得到扩张状态观测器的估计误差e1。S1.4) Compare the position signal x 1 with the estimated signal z 1 of the extended state observer to obtain the estimated error e 1 of the extended state observer. 3.根据权利要求2所述的方法，其特征在于，所述S1.3)中通过公式(8)求出位置信号误差值δ1和速度信号误差值δ2，公式如下所示：3. The method according to claim 2, wherein, in the S1.3), the position signal error value δ 1 and the velocity signal error value δ 2 are obtained by formula (8), and the formula is as follows:
Figure FDA0002890168980000021
Figure FDA0002890168980000021
 式中，xd为期望轨迹值，z2为扩张状态观测器的速度估计信号值。In the formula, x d is the expected trajectory value, and z 2 is the velocity estimation signal value of the expansion state observer. 4.根据权利要求2所述的方法，其特征在于，所述S1.4)中扩张状态观测器的估计误差e1通过公式(6)求出，公式如下所示：4. The method according to claim 2, wherein the estimation error e 1 of the expanded state observer in the S1.4) is obtained by formula (6), and the formula is as follows: e1(t)＝z1(t)-x1(t) (6)，e 1 (t)=z 1 (t)-x 1 (t) (6), 式中，z1(t)为扩张状态观测器的位置估计信号，t为时间。In the formula, z 1 (t) is the position estimation signal of the extended state observer, and t is the time. 5.根据权利要求4所述的方法，其特征在于，所述z1(t)通过以下公式求出，如下所示，5. The method according to claim 4, wherein the z 1 (t) is obtained by the following formula, as follows,
Figure FDA0002890168980000022
Figure FDA0002890168980000022
 式中，
Figure FDA0002890168980000023
是扩张状态观测器的实时输出量，当时间t＝0时，初始值z1(0)＝0，z1(t)。In the formula,
Figure FDA0002890168980000023
is the real-time output of the extended state observer, when time t=0, the initial value z 1 (0)=0, z 1 (t). 6.根据权利要求2所述的控制方法，其特征在于，所述S2)的具体步骤为：6. control method according to claim 2, is characterized in that, the concrete step of described S2) is: S2.1)将S1.3)得到位置信号误差值δ1和速度信号误差值δ2作为滑模控制量模型的输入，求出滑模控制量输出s，S2.1) Use the position signal error value δ 1 and the speed signal error value δ 2 obtained in S1.3) as the input of the sliding mode control quantity model, and obtain the sliding mode control quantity output s, S2.2)将S1.4)得到扩张状态观测器的估计误差e1作为扩张状态观测器的输入，求出扩张状态观测器的估计信号值z3。S2.2) The estimated error e 1 of the extended state observer obtained in S1.4) is used as the input of the extended state observer, and the estimated signal value z 3 of the extended state observer is obtained. 7.根据权利要求6所述的控制方法，其特征在于，所述S2.1)中的控制模型通过公式(10)表达，公式如下所示：7. The control method according to claim 6, wherein the control model in the S2.1) is expressed by formula (10), and the formula is as follows:
Figure FDA0002890168980000031
Figure FDA0002890168980000031
 式中，s为滑模控制量输出，σ为参数，σ＞0，γ＝p/q，p和q是正的奇变量，满足p＝2m+1，且p＞q，m为大于0的正整数；sigγ(·)是分数幂符号函数。In the formula, s is the output of the sliding mode control quantity, σ is the parameter, σ>0, γ=p/q, p and q are positive odd variables, p=2m+1, and p>q, m is greater than 0 Positive integer; sig γ (·) is the sign function of fractional power. 8.根据权利要求6所述的控制方法，其特征在于，所述S2.2)中的扩张状态观测器通过如公式(5)表达，公式如下所示，8. The control method according to claim 6, wherein the expanded state observer in S2.2) is expressed by formula (5), and the formula is as follows,
Figure FDA0002890168980000032
Figure FDA0002890168980000032
 式中，βi为扩张状态观测器的增益，i＝1.2.3，e1为扩张状态观测器误差信号，Z1为扩张状态观测器的位置估计信号，Z2为扩张状态观测器的速度估计信号，M0是为机械系统的动力学模型的惯性矩阵的已知标称部分，τ为有限时间控制量。In the formula, β i is the gain of the expanded state observer, i=1.2.3, e 1 is the error signal of the expanded state observer, Z 1 is the position estimation signal of the expanded state observer, and Z 2 is the velocity of the expanded state observer The estimated signal, M 0 is the known nominal part of the inertia matrix of the dynamic model of the mechanical system, and τ is the finite time control quantity. 9.根据权利要求1所述的控制方法，其特征在于，所述S3)的具体步骤为：9. control method according to claim 1, is characterized in that, the concrete step of described S3) is: S3.1)将S2.1)得到滑模控制量输出s，S2.2)得到的扩张状态观测器的估计信号z3以及S1.3)的位置信号误差值δ1和速度信号误差值δ2作为非奇异终端滑模控制器的输入；S3.1) The sliding mode control variable output s obtained in S2.1), the estimated signal z3 of the expanded state observer obtained in S2.2) and the position signal error value δ1 and velocity signal error value δ1 in S1.3 ) 2 as the input of the non-singular terminal sliding mode controller; S3.2)非奇异终端滑模控制器输出控制信号。S3.2) The non-singular terminal sliding mode controller outputs a control signal. 10.根据权利要求9所述的控制方法，其特征在于，所述S3.1)中的非奇异终端滑模控制器通过以下公式(16)表达，求出有限时间控制量τ，公式如下：10. The control method according to claim 9, wherein the non-singular terminal sliding mode controller in the S3.1) is expressed by the following formula (16), and the finite-time control quantity τ is obtained, and the formula is as follows:
Figure FDA0002890168980000041
Figure FDA0002890168980000041
 式中，
Figure FDA0002890168980000042
是系统的鲁棒项，K1和K2是正常数增益。In the formula,
Figure FDA0002890168980000042
are the robust terms of the system, and K 1 and K 2 are constant gains.
CN202110025694.4A 2021-01-08 2021-01-08 Mechanical system finite time control method based on extended state observer Active CN112859600B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110025694.4A CN112859600B (en) 2021-01-08 2021-01-08 Mechanical system finite time control method based on extended state observer

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110025694.4A CN112859600B (en) 2021-01-08 2021-01-08 Mechanical system finite time control method based on extended state observer

Publications (2)

Publication Number Publication Date
CN112859600A true CN112859600A (en) 2021-05-28
CN112859600B CN112859600B (en) 2024-02-09

Family

ID=76001821

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110025694.4A Active CN112859600B (en) 2021-01-08 2021-01-08 Mechanical system finite time control method based on extended state observer

Country Status (1)

Country Link
CN (1) CN112859600B (en)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113325716A (en) * 2021-06-10 2021-08-31 浙江大学 Underwater hydraulic mechanical arm nonlinear robust control method based on extended observer
CN113900373A (en) * 2021-08-06 2022-01-07 南京工业大学 Global nonsingular rapid terminal sliding mode control method for structural thermal test
CN114249238A (en) * 2021-12-27 2022-03-29 南京工业大学 An anti-sway control method of an overhead crane
CN116430730A (en) * 2023-04-11 2023-07-14 天津大学 Helicopter active vibration damping control method based on limited time expansion state observer

Citations (22)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20040239282A1 (en) * 2003-05-29 2004-12-02 Koji Yoneda Motion controller having sliding mode controller
US20050096793A1 (en) * 2003-10-30 2005-05-05 Kabushiki Kaisha Toshiba Reference model tracking control system and method
CN104111607A (en) * 2014-06-13 2014-10-22 南京理工大学 Motor position servo system control method taking input time lag into consideration
CN105045101A (en) * 2015-06-08 2015-11-11 浙江工业大学 Mechanical arm servo system full-order slide mold control method based on extended state observer
CN106444799A (en) * 2016-07-15 2017-02-22 浙江工业大学 Four-rotor unmanned aerial vehicle control method based on fuzzy extended state observer and self-adaptive sliding mode
CN106849795A (en) * 2017-03-14 2017-06-13 中国矿业大学 A kind of permanent magnet linear synchronous motor System with Sliding Mode Controller based on linear extended state observer
CN107831761A (en) * 2017-10-16 2018-03-23 中国科学院电工研究所 A kind of path tracking control method of intelligent vehicle
CN107942684A (en) * 2017-12-26 2018-04-20 电子科技大学 Mechanical arm trace tracking method based on the adaptive non-singular terminal sliding formwork of fractional order
CN108227485A (en) * 2017-12-01 2018-06-29 西北工业大学 A kind of robot for space Auto-disturbance-rejection Control with actuator saturation
CN108614425A (en) * 2018-06-06 2018-10-02 黄山学院 Mobile robot Adaptive Integral sliding-mode control
CN108803324A (en) * 2018-06-06 2018-11-13 黄山学院 Multi-joint industrial machinery arm contragradience finite time sliding-mode control
CN108828955A (en) * 2018-08-16 2018-11-16 大连海事大学 Precise Track Tracking Control Method Based on Finite Time Extended State Observer
CN109189087A (en) * 2018-08-20 2019-01-11 哈尔滨工业大学 A kind of adaptive fusion method of VTOL Reusable Launch Vehicles
CN109343549A (en) * 2018-10-09 2019-02-15 北京航空航天大学 An aircraft attitude control method, system, medium and device
CN109460043A (en) * 2018-12-29 2019-03-12 上海海事大学 One kind being based on multi-modal non-singular terminal sliding formwork ship track Auto-disturbance-rejection Control
CN110221539A (en) * 2019-05-17 2019-09-10 江苏理工学院 Quadrotor non-singular terminal sliding-mode control based on linear expansion observer
GB201912280D0 (en) * 2019-07-02 2019-10-09 Univ Northwestern Polytechnical Dynamic gain control method for multi-spacecraft consensus
CN110661464A (en) * 2019-09-29 2020-01-07 北京机械设备研究所 Disturbance suppression method for alternating current servo system and position loop
CN110764418A (en) * 2019-11-13 2020-02-07 天津津航计算技术研究所 Active disturbance rejection controller based on finite time convergence extended state observer
CN111152225A (en) * 2020-01-15 2020-05-15 北京科技大学 Fixed-time trajectory tracking control method for uncertain manipulator with input saturation
CN111431404A (en) * 2020-02-21 2020-07-17 浙江工业大学 A DC Buck Converter System Control Method Based on Extended State Observer and Continuous Non-Singular Terminal Sliding Mode Control Technology
CN112000006A (en) * 2020-07-06 2020-11-27 南京邮电大学 Autonomous spacecraft rendezvous control method based on finite-time rapid nonsingular terminal sliding mode

Patent Citations (22)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20040239282A1 (en) * 2003-05-29 2004-12-02 Koji Yoneda Motion controller having sliding mode controller
US20050096793A1 (en) * 2003-10-30 2005-05-05 Kabushiki Kaisha Toshiba Reference model tracking control system and method
CN104111607A (en) * 2014-06-13 2014-10-22 南京理工大学 Motor position servo system control method taking input time lag into consideration
CN105045101A (en) * 2015-06-08 2015-11-11 浙江工业大学 Mechanical arm servo system full-order slide mold control method based on extended state observer
CN106444799A (en) * 2016-07-15 2017-02-22 浙江工业大学 Four-rotor unmanned aerial vehicle control method based on fuzzy extended state observer and self-adaptive sliding mode
CN106849795A (en) * 2017-03-14 2017-06-13 中国矿业大学 A kind of permanent magnet linear synchronous motor System with Sliding Mode Controller based on linear extended state observer
CN107831761A (en) * 2017-10-16 2018-03-23 中国科学院电工研究所 A kind of path tracking control method of intelligent vehicle
CN108227485A (en) * 2017-12-01 2018-06-29 西北工业大学 A kind of robot for space Auto-disturbance-rejection Control with actuator saturation
CN107942684A (en) * 2017-12-26 2018-04-20 电子科技大学 Mechanical arm trace tracking method based on the adaptive non-singular terminal sliding formwork of fractional order
CN108803324A (en) * 2018-06-06 2018-11-13 黄山学院 Multi-joint industrial machinery arm contragradience finite time sliding-mode control
CN108614425A (en) * 2018-06-06 2018-10-02 黄山学院 Mobile robot Adaptive Integral sliding-mode control
CN108828955A (en) * 2018-08-16 2018-11-16 大连海事大学 Precise Track Tracking Control Method Based on Finite Time Extended State Observer
CN109189087A (en) * 2018-08-20 2019-01-11 哈尔滨工业大学 A kind of adaptive fusion method of VTOL Reusable Launch Vehicles
CN109343549A (en) * 2018-10-09 2019-02-15 北京航空航天大学 An aircraft attitude control method, system, medium and device
CN109460043A (en) * 2018-12-29 2019-03-12 上海海事大学 One kind being based on multi-modal non-singular terminal sliding formwork ship track Auto-disturbance-rejection Control
CN110221539A (en) * 2019-05-17 2019-09-10 江苏理工学院 Quadrotor non-singular terminal sliding-mode control based on linear expansion observer
GB201912280D0 (en) * 2019-07-02 2019-10-09 Univ Northwestern Polytechnical Dynamic gain control method for multi-spacecraft consensus
CN110661464A (en) * 2019-09-29 2020-01-07 北京机械设备研究所 Disturbance suppression method for alternating current servo system and position loop
CN110764418A (en) * 2019-11-13 2020-02-07 天津津航计算技术研究所 Active disturbance rejection controller based on finite time convergence extended state observer
CN111152225A (en) * 2020-01-15 2020-05-15 北京科技大学 Fixed-time trajectory tracking control method for uncertain manipulator with input saturation
CN111431404A (en) * 2020-02-21 2020-07-17 浙江工业大学 A DC Buck Converter System Control Method Based on Extended State Observer and Continuous Non-Singular Terminal Sliding Mode Control Technology
CN112000006A (en) * 2020-07-06 2020-11-27 南京邮电大学 Autonomous spacecraft rendezvous control method based on finite-time rapid nonsingular terminal sliding mode

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
周涛: "基于反双曲正弦函数的转台伺服系统滑模控制", 光电工程 *
张文博: "伺服电机驱动的连铸结晶器振动位移系统鲁棒跟踪控制研究", 《中国优秀博硕士学位论文全文数据库(硕士)工程科技Ⅱ辑》 *

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113325716A (en) * 2021-06-10 2021-08-31 浙江大学 Underwater hydraulic mechanical arm nonlinear robust control method based on extended observer
CN113900373A (en) * 2021-08-06 2022-01-07 南京工业大学 Global nonsingular rapid terminal sliding mode control method for structural thermal test
CN113900373B (en) * 2021-08-06 2023-11-03 南京工业大学 Global nonsingular rapid terminal sliding mode control method for structural thermal test
CN114249238A (en) * 2021-12-27 2022-03-29 南京工业大学 An anti-sway control method of an overhead crane
CN116430730A (en) * 2023-04-11 2023-07-14 天津大学 Helicopter active vibration damping control method based on limited time expansion state observer
CN116430730B (en) * 2023-04-11 2023-11-21 天津大学 Helicopter active vibration damping control method based on limited time expansion state observer

Also Published As

Publication number Publication date
CN112859600B (en) 2024-02-09

Similar Documents

Publication Publication Date Title
CN112859600A (en) Mechanical system finite time control method based on extended state observer
Shao et al. Neural adaptive control for MEMS gyroscope with full-state constraints and quantized input
CN108803324B (en) Multi-joint industrial mechanical arm backstepping finite time sliding mode control method
Fareh et al. Robust active disturbance rejection control for flexible link manipulator
CN108303885B (en) Self-adaptive control method of motor position servo system based on disturbance observer
CN106406085B (en) Based on the space manipulator Trajectory Tracking Control method across Scale Model
CN106802660B (en) A Composite Strong Anti-disturbance Attitude Control Method
CN110154028A (en) A Model-Free Adaptive Integral Terminal Sliding Mode Control Method for Manipulators
CN107703742B (en) Flexible spacecraft sensor fault adjusting method
CN106842916B (en) A kind of prediction Auto-disturbance-rejection Control of three-dimensional position servo-system
CN108897226A (en) The nonsingular sliding-mode control of MEMS gyroscope default capabilities based on interference observer
CN112207834B (en) Robot joint system control method and system based on disturbance observer
CN104950678A (en) Neural network inversion control method for flexible manipulator system
CN115981162A (en) Sliding mode control trajectory tracking method of robot system based on novel disturbance observer
CN115586724A (en) Self-adaptive fractional order global sliding mode control method for gear inspection robot system
CN114147713B (en) Track tracking control method based on adaptive neural network high-order dynamic sliding mode
CN108762088A (en) A kind of Hysteresis Nonlinear servo electrical machinery system sliding-mode control
CN106100469A (en) Implementation method based on adaptive motor servo system robust position controller
CN106354013A (en) Linear active-disturbance-rejection controlling method of attack angle
CN110134135B (en) Control method of quadrotor aircraft based on improved MPC-PID
CN104020664B (en) A kind of flexible mechanical arm interference observer method for designing based on partial differential equation
CN109062048B (en) Non-singular sliding mode control method for preset performance of MEMS gyroscope based on compound learning
CN112936270B (en) A neural network-based internal model control method for manipulators
Chen et al. Finite-time attitude control with chattering suppression for quadrotors based on high-order extended state observer
CN111025915B (en) Z-axis gyroscope neural network sliding mode control method based on disturbance observer

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