CN110134137B - Spacecraft attitude tracking control method based on extended state observer - Google Patents
Spacecraft attitude tracking control method based on extended state observer Download PDFInfo
- Publication number
- CN110134137B CN110134137B CN201910527054.6A CN201910527054A CN110134137B CN 110134137 B CN110134137 B CN 110134137B CN 201910527054 A CN201910527054 A CN 201910527054A CN 110134137 B CN110134137 B CN 110134137B
- Authority
- CN
- China
- Prior art keywords
- spacecraft
- extended state
- state observer
- attitude tracking
- attitude
- 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
Links
Images
Abstract
The invention provides a spacecraft attitude tracking control method based on an extended state observer, which comprises the following steps: s1, establishing a mathematical model of the spacecraft; s2, establishing an error mathematical model of the spacecraft; s3, designing an extended state observer, and estimating the uncertainty of the rotational inertia parameters existing in the spacecraft attitude tracking control and the sum of the uncertainty of the rotational inertia parameters and the external environment interference by the extended state observer; s4, designing an attitude tracking controller based on the extended state observer by utilizing a back stepping method, and taking signals of the extended state observer as compensation signals of the uncertainty of the rotating inertia parameters and the total moment interfered by the external environment in the attitude tracking controller to perform attitude tracking control of the spacecraft. The invention has the beneficial effects that: the method is favorable for grasping each state variable; the controller is more robust, and the accuracy and precision of the control system are improved.
Description
Technical Field
The invention relates to a spacecraft, in particular to a spacecraft attitude tracking control method based on an extended state observer.
Background
In the problem of attitude tracking of the rigid-body spacecraft, the uncertainty of the existing rotational inertia parameters and the external interference moment received by the spacecraft in the operation process influence the control of the spacecraft to a great extent, and the accuracy and precision of the spacecraft control are reduced.
Disclosure of Invention
In order to solve the problems in the prior art, the invention provides a spacecraft attitude tracking control method based on an extended state observer.
The invention provides a spacecraft attitude tracking control method based on an extended state observer, which comprises the following steps:
s1, establishing a mathematical model of the spacecraft;
s2, establishing an error mathematical model of the spacecraft;
s3, designing an extended state observer, and estimating the uncertainty of the rotational inertia parameters existing in the spacecraft attitude tracking control and the sum of the uncertainty of the rotational inertia parameters and the external environment interference by the extended state observer;
s4, designing an attitude tracking controller based on the extended state observer by utilizing a back stepping method, and taking signals of the extended state observer as compensation signals of the uncertainty of the rotating inertia parameters and the total moment interfered by the external environment in the attitude tracking controller to perform attitude tracking control of the spacecraft.
As a further improvement of the present invention, step S1 includes:
the kinematic equation and the kinetic equation of the tracking spacecraft based on the modified Reed-Solomon parameter are established as follows:
wherein the content of the first and second substances,in order to track the attitude angular velocity of the spacecraft,to track the attitude description of a spacecraft relative to the inertial space, σ×For the oblique symmetric array, the following is defined:
m (σ) satisfies
J is a system rotational inertia matrix, is a symmetric matrix and meets the requirement
J=J0+△J
Wherein, J0For a constant symmetric matrix, Δ J is the uncertainty present in the moment of inertia.
The kinematic model of the target spacecraft is as follows:
wherein omegadFor a given target attitude angular velocity, σdIs the attitude variable of the target spacecraft.
As a further improvement of the present invention, step S2 includes:
the error kinematic equation and the error kinetic equation are established as follows:
wherein σeIs the attitude variable of the error system, omega is the angular speed of the error, and meets the condition that omega is omega-C omegadIn the formula
As a further improvement of the present invention, step S3 includes:
the f is all terms containing uncertainty in an error system and meets the requirement
Definition of z1、z2Respectively is an observationTwo outputs of the device; let x be ω + K σeWherein K ═ diag (K)1,k2,k3) Is a positive definite symmetric matrix, then x1=x,x2F is two inputs of the observer; the output error of the observer is e1,e2The form is as follows:
the extended state observer was designed as follows:
wherein, beta1,β2>0 is an adjustable parameter, and F is defined as follows:
as a further improvement of the present invention, step S4 includes:
the designed attitude tracking controller based on the extended state observer is as follows:
wherein, b1,b2,b3>0 is an adjustable parameter.
As a further improvement of the present invention, step S4 includes the following sub-steps:
Step 401
considering ω as a virtual control input, the kinematic controller is designed:
α=-Kσe
wherein K ═ diag (K)1,k2,k3) And there is a constant k min k i1,2, 3. Selecting a Lyapunov candidate function:
in the formula, b1For adjustable parameters greater than 0, for V1Derivative to obtain
As is apparent from the formula (3), σ is represented by time t → ∞e→0,
Step 402 defines a new error variable x:
x=ω-α=ω+Kσe (4)
the error kinetic equation is written as
Consider a new Lyapunov candidate function V2The form is as follows:
to V2Taking the derivative to obtain
If the control law is
In the formula, b2For an adjustable parameter greater than 0, then
The attitude tracking controller designed by Step 403 based on the extended state observer is
Wherein, b1,b2,b3>0 is an adjustable parameter.
As a further improvement of the invention, the parameter of the attitude tracking controller based on the extended state observer is b1=35,b2=1,b3=1000,K=diag(0.01,0.01,0.01),β1=20,β2=300。
The invention has the beneficial effects that:
1. the spacecraft attitude tracking controller based on the extended state observer can enable the closed-loop system under the action of the controller to be globally asymptotically bounded and stable;
2. the extended state observer used in the design of the invention can observe the total disturbance moment f of the uncertainty of the moment of inertia and the external disturbance moment, and inputs the estimated value into the control system as a compensation signal, which is beneficial to the grasp of each state variable;
3. the controller designed by the invention does not need to know the specific value of the interference upper bound in advance, the controller has more robustness, and compared with some existing methods, the controller reduces a large amount of matrix inversion calculation, reduces the calculation burden of an observer, and improves the accuracy and precision of a control system.
Drawings
FIG. 1 is a control system block diagram of a spacecraft attitude tracking control method based on an extended state observer.
FIG. 2 is a system simulation diagram of the spacecraft attitude tracking control method based on the extended state observer.
FIG. 3 is an error angular velocity simulation diagram of the spacecraft attitude tracking control method based on the extended state observer.
FIG. 4 is an error attitude variable simulation diagram of the spacecraft attitude tracking control method based on the extended state observer.
FIG. 5 is a control moment simulation diagram of the spacecraft attitude tracking control method based on the extended state observer.
Fig. 6 is a tracking angular velocity simulation diagram for tracking the angular velocity of the spacecraft, based on the spacecraft attitude tracking control method of the extended state observer of the present invention.
FIG. 7 is a simulation diagram of the total disturbance torque and the estimated value thereof of the spacecraft attitude tracking control method based on the extended state observer.
FIG. 8 shows an extended state observer z of the spacecraft attitude tracking control method based on the extended state observer of the present invention1The estimated error of (1) is simulated.
FIG. 9 is a diagram of the present invention based on dilationExtended state observer z of spacecraft attitude tracking control method of state observer2The estimated error of (1) is simulated.
Detailed Description
The invention is further described with reference to the following description and embodiments in conjunction with the accompanying drawings.
As shown in fig. 1, a spacecraft attitude tracking control method based on an extended state observer includes the following steps:
s1, establishing a mathematical model of the spacecraft;
s2, establishing an error mathematical model of the spacecraft;
s3, designing an extended state observer, and estimating the uncertainty of the rotational inertia parameters existing in the spacecraft attitude tracking control and the sum of the uncertainty of the rotational inertia parameters and the external environment interference by the extended state observer;
and S4, designing an attitude tracking controller based on the extended state observer by using a back stepping method, and using the signal of the extended state observer as a compensation signal of the attitude tracking controller to perform attitude tracking control of the spacecraft.
The method uses modified Reed-Solomon parameters (MRPs) to describe a spacecraft attitude tracking model, takes uncertain items existing in the rotational inertia and external interference as total interference, observes the total interference by using an extended state observer, and takes signals of the observer as compensation signals of a control system to carry out attitude tracking control.
The kinematic equation and the kinetic equation of the tracking spacecraft based on the modified Reed-Solomon parameters (MRPs) are established as follows:
wherein the content of the first and second substances,in order to track the attitude angular velocity of the spacecraft,for tracking spacecraft phasesFor attitude description in inertial space, σ×For the oblique symmetric array, the following is defined:
m (σ) satisfies
J is a system rotational inertia matrix, is a symmetric matrix and meets the requirement
J=J0+△J
Wherein, J0For a constant symmetric matrix, Δ J is the uncertainty present in the moment of inertia.
The kinematic model of the target spacecraft is as follows:
wherein omegadFor a given target attitude angular velocity, σdIs the attitude variable of the target spacecraft.
The error kinematic equation and the error kinetic equation are established as follows:
wherein σeIs the attitude variable of the error system, omega is the angular speed of the error, and meets the condition that omega is omega-C omegadIn the formula
Designing the controller by using a reverse step method:
considering ω as a virtual control input, the kinematic controller is designed:
α=-Kσe
wherein K ═ diag (K)1,k2,k3) And there is a constant k min k i1,2, 3. Selecting a Lyapunov candidate function:
in the formula, b1Is an adjustable parameter greater than 0. Now in pair V1Derivative to obtain
As is apparent from the formula (3), σ is represented by time t → ∞e→0。
Step2 defines a new error variable x:
x=ω-α=ω+Kσe (4)
the error dynamics equation can be written as
The simplified equation (5) can be written as
Consider a new Lyapunov candidate function V2The form is as follows:
to V2Taking the derivative to obtain
If the control law is
In the formula, b2Is an adjustable parameter greater than 0. Then there is
It is clear that the control law u contains parameter uncertainties and external disturbance torques, so that it is practically impossible to implement this control law. Therefore, an observer is required to estimate these state variables that are not directly measurable, and the estimated signals are used as compensation signals in the control system.
Step3 designs an extended state observer with f as an extended state variable. Definition of z1、z2Separately divide the two outputs of the observer, x1=x,x2F is two inputs of the observer; the output error of the observer is
The extended state observer was designed as follows:
wherein, beta1,β2>0 is an adjustable parameter. Then the achievable control law is
Wherein, b1,b2,b3>0 is an adjustable parameter.
Considering the Lyapunov candidate function V3The form is as follows:
to V3Taking the derivative to obtain
Due to the fact that
Then equation (15) can be written as
Wherein the content of the first and second substances,the preparation method is easy to obtain,converge on the set D
The simulation parameters of the rigid body spacecraft are selected as follows:
nominal value of moment of inertia J is
Uncertainty term Δ J of
△J=diag(sin(0.1t),2sin(0.2t),3sin(0.3t))kg·m2
The interference signal d (t) is
Selecting the initial value of the angular speed of the tracked spacecraft to be … (0) < 000]Trad/s, initial value of attitude variable σ (0) [ -0.1579,0.1368, -0.0947]TThe initial attitude variable of the target spacecraft is sigmad(0)=[0,0,0]T. The initial state of the observer is zi=[0.01,0.01,0.01]TAnd i is 1 and 2. Target angular velocity is set to
In consideration of the practical problem, the magnitude of the control torque provided by the spacecraft actuator is limited, and it is assumed that the magnitude of the control torque provided by the spacecraft actuator is 5N at most. Selecting a parameter of an extended state observer-based attitude tracking controller as
b1=35,b2=1,b3=1000,K=diag(0.01,0.01,0.01),β1=20,β2=300
Fig. 2-9 are simulation diagrams.
The invention provides a spacecraft attitude tracking control method based on an extended state observer, which designs a robust controller based on the extended state observer aiming at the attitude tracking problem of a spacecraft, assumes that the spacecraft is a rigid body spacecraft without a flexible attachment, and introduces the extended state observer to estimate the sum of uncertainty and external interference aiming at the problems of uncertainty of rotational inertia parameters and interference of external environment in the spacecraft attitude tracking control. A spacecraft attitude tracking controller based on an extended state observer is designed by utilizing a back stepping method. And finally, verifying the effectiveness of the designed control algorithm by a simulation example.
The foregoing is a more detailed description of the invention in connection with specific preferred embodiments and it is not intended that the invention be limited to these specific details. For those skilled in the art to which the invention pertains, several simple deductions or substitutions can be made without departing from the spirit of the invention, and all shall be considered as belonging to the protection scope of the invention.
Claims (5)
1. A spacecraft attitude tracking control method based on an extended state observer is characterized by comprising the following steps:
s1, establishing a mathematical model of the spacecraft;
s2, establishing an error mathematical model of the spacecraft;
s3, designing an extended state observer, and estimating the uncertainty of the rotational inertia parameters existing in the spacecraft attitude tracking control and the sum of the uncertainty of the rotational inertia parameters and the external environment interference by the extended state observer;
s4, designing an attitude tracking controller based on the extended state observer by utilizing a back stepping method, and taking signals of the extended state observer as compensation signals of the uncertainty of the rotating inertia parameters and the total moment interfered by the external environment in the attitude tracking controller to carry out attitude tracking control on the spacecraft;
step S1 includes:
the kinematic equation and the kinetic equation of the tracking spacecraft based on the modified Reed-Solomon parameter are established as follows:
wherein the content of the first and second substances,in order to track the attitude angular velocity of the spacecraft, to track the attitude description of a spacecraft relative to the inertial space, σ×For the oblique symmetric array, the following is defined:
m (σ) satisfies
J is a system rotational inertia matrix, is a symmetric matrix and meets the requirement
J=J0+△J
Wherein, J0Is a constant symmetric matrix, and Δ J is the uncertainty present in the moment of inertia;
the kinematic model of the target spacecraft is as follows:
wherein omegadFor a given target attitude angular velocity, σdIs the attitude variable of the target spacecraft;
step S2 includes:
the error kinematic equation and the error kinetic equation are established as follows:
wherein σeIs the attitude variable of the error system, omega is the angular speed of the error, and meets the condition that omega is omega-C omegadIn the formula
Step S3 includes:
the f is all terms containing uncertainty in an error system and meets the requirement
Definition of z1、z2Two outputs of the observer respectively; let x be ω + K σeWherein K ═ diag (K)1,k2,k3) Is a positive definite symmetric matrix, then x1=x,x2F is two inputs of the observer; the output error of the observer is e1,e2The form is as follows:
the extended state observer was designed as follows:
wherein, beta1,β2>0 is an adjustable parameter, and F is defined as follows:
2. the extended state observer-based spacecraft attitude tracking control method of claim 1, wherein: the spacecraft is a rigid body spacecraft without flexible appendages.
4. The extended state observer-based spacecraft attitude tracking control method of claim 2, wherein: step S4 includes the following substeps:
Step 401
considering ω as a virtual control input, the kinematic controller is designed:
α=-Kσe
wherein K ═ diag (K)1,k2,k3) And there is a constant k min ki1,2,3, selecting a Lyapunov candidate function:
in the formula,b1For adjustable parameters greater than 0, for V1Derivative to obtain
As is apparent from the formula (3), σ is represented by time t → ∞e→0,
Step 402 defines a new error variable x:
x=ω-α=ω+Kσe (4)
the error kinetic equation is written as
Consider a new Lyapunov candidate function V2The form is as follows:
to V2Taking the derivative to obtain
If the control law is
In the formula, b2For an adjustable parameter greater than 0, then
The attitude tracking controller designed by Step 403 based on the extended state observer is
Wherein, b1,b2,b3>0 is an adjustable parameter.
5. The extended state observer-based spacecraft attitude tracking control method of claim 4, wherein: the parameter of the attitude tracking controller based on the extended state observer is b1=35,b2=1,b3=1000,K=diag(0.01,0.01,0.01),β1=20,β2=300。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910527054.6A CN110134137B (en) | 2019-06-18 | 2019-06-18 | Spacecraft attitude tracking control method based on extended state observer |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910527054.6A CN110134137B (en) | 2019-06-18 | 2019-06-18 | Spacecraft attitude tracking control method based on extended state observer |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110134137A CN110134137A (en) | 2019-08-16 |
CN110134137B true CN110134137B (en) | 2021-11-23 |
Family
ID=67577839
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910527054.6A Active CN110134137B (en) | 2019-06-18 | 2019-06-18 | Spacecraft attitude tracking control method based on extended state observer |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110134137B (en) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110703602B (en) * | 2019-10-22 | 2022-07-26 | 西北工业大学深圳研究院 | Robust differential game control method for on-orbit assembly attitude stabilization of multiple robots |
CN111442786B (en) * | 2020-05-21 | 2021-08-20 | 合肥工业大学 | Zero drift deviation and attitude estimation method of aircraft gyroscope |
CN111766890B (en) * | 2020-07-24 | 2021-09-14 | 中南大学 | Spacecraft performance-guaranteeing attitude control method independent of neural network approximation |
CN114779799B (en) * | 2022-05-23 | 2023-05-16 | 哈尔滨工业大学 | Flexible spacecraft attitude and orbit tracking control method based on expansion disturbance observer |
CN115685761B (en) * | 2022-11-10 | 2023-06-30 | 哈尔滨工业大学 | Flexible spacecraft preset performance attitude control method, computer equipment and storage medium |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107678281A (en) * | 2017-10-16 | 2018-02-09 | 哈尔滨工业大学深圳研究生院 | Spacecraft Adaptive Attitude control law based on amendment type rodrigue parameters |
CN108536164A (en) * | 2018-03-23 | 2018-09-14 | 哈尔滨工业大学深圳研究生院 | Attitude control method of the Spacecraft without angular velocity measurement |
CN108646556A (en) * | 2018-05-08 | 2018-10-12 | 中国人民解放军战略支援部队航天工程大学 | Input saturation spacecraft is without unwinding Attitude tracking control method |
CN108710303A (en) * | 2018-07-25 | 2018-10-26 | 西北工业大学 | Spacecraft relative attitude control method containing multi-source disturbance and actuator saturation |
CN109164819A (en) * | 2018-08-22 | 2019-01-08 | 哈尔滨工业大学(深圳) | The contragradience adaptive sliding mode large angle attitude control method of rigid body spacecraft |
-
2019
- 2019-06-18 CN CN201910527054.6A patent/CN110134137B/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107678281A (en) * | 2017-10-16 | 2018-02-09 | 哈尔滨工业大学深圳研究生院 | Spacecraft Adaptive Attitude control law based on amendment type rodrigue parameters |
CN108536164A (en) * | 2018-03-23 | 2018-09-14 | 哈尔滨工业大学深圳研究生院 | Attitude control method of the Spacecraft without angular velocity measurement |
CN108646556A (en) * | 2018-05-08 | 2018-10-12 | 中国人民解放军战略支援部队航天工程大学 | Input saturation spacecraft is without unwinding Attitude tracking control method |
CN108710303A (en) * | 2018-07-25 | 2018-10-26 | 西北工业大学 | Spacecraft relative attitude control method containing multi-source disturbance and actuator saturation |
CN109164819A (en) * | 2018-08-22 | 2019-01-08 | 哈尔滨工业大学(深圳) | The contragradience adaptive sliding mode large angle attitude control method of rigid body spacecraft |
Non-Patent Citations (6)
Title |
---|
Attitude Tracking Control for Rigid Spacecraft With Parameter Uncertainties;Wu, YY 等;《IEEE》;20200217;全文 * |
Attitude tracking of rigid spacecraft with bounded disturbances;Y. Xia 等;《IEEE》;20111231;全文 * |
Extended State Observer based robust attitude control of spacecraft with input saturation;Bo Li 等;《IEEE》;20161231;全文 * |
Spacecraft output feedback attitude control based on extended state observer and adaptive dynamic programming;L.-G. Gong 等;《IEEE》;20190131;全文 * |
基于扩张状态观测器的航天器时延状态反馈控制;史小平 等;《系统工程与电子技术》;20161231;第38卷(第3期);参见第624-627页 * |
航天器姿态控制的干扰抑制问题研究;郭敏文;《中国优秀博硕士学位论文全文数据库(硕士)工程科技Ⅱ辑》;20120315;参见第19-24,55-60页及图5-3 * |
Also Published As
Publication number | Publication date |
---|---|
CN110134137A (en) | 2019-08-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110134137B (en) | Spacecraft attitude tracking control method based on extended state observer | |
CN108710303B (en) | Spacecraft relative attitude control method containing multi-source disturbance and actuator saturation | |
Sharifi et al. | Nonlinear model reference adaptive impedance control for human–robot interactions | |
Wang et al. | Finite-time fault-tolerant trajectory tracking control of an autonomous surface vehicle | |
CN106873611B (en) | A kind of design method of multichannel linear active disturbance rejection controller | |
Rahmani | MEMS gyroscope control using a novel compound robust control | |
Ulrich et al. | Modeling and direct adaptive control of a flexible-joint manipulator | |
Gao et al. | Adaptive neural network visual servo control for dynamic positioning of underwater vehicles | |
Schlanbusch et al. | Hybrid attitude tracking of rigid bodies without angular velocity measurement | |
Chu et al. | Observer-based adaptive neural network control for a class of remotely operated vehicles | |
CN111061247A (en) | Polarity test system and test method for closed-loop control of angular momentum of flywheel under whole satellite | |
CN111624878B (en) | Integral sliding mode acquisition method and system for autonomous water surface robot trajectory tracking | |
CN108762069B (en) | Flywheel fault identification and adjustment method for attitude control system of rigid spacecraft | |
CN109426147B (en) | Adaptive gain adjustment control method for combined spacecraft after satellite acquisition | |
Lendek et al. | Application of Takagi-Sugeno observers for state estimation in a quadrotor | |
Nekoo | Digital implementation of a continuous-time nonlinear optimal controller: An experimental study with real-time computations | |
Yang et al. | A robust and adaptive control method for flexible-joint manipulator capturing a tumbling satellite | |
Lee et al. | Robust position and attitude control for spacecraft formation flying | |
CN107102544A (en) | Global finite time Track In Track control method based on disturbance observer | |
CN112192573A (en) | Uncertainty robot self-adaptive neural network control method based on inversion method | |
CN108829109B (en) | Neutral buoyancy robot posture and track control method based on distributed model predictive control | |
Liu et al. | Interactive dynamics and balance of a virtual character during manipulation tasks | |
She et al. | Quasi-model free control for the post-capture operation of a non-cooperative target | |
CN109445448B (en) | Self-adaptive integral sliding-mode attitude controller for wheel-controlled minisatellite | |
Huang et al. | Robust control allocation in attitude fault-tolerant control for combined spacecraft under measurement uncertainty |
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 |