CN105068425A - State feedback robustnon-fragile control method applicable for determination of agile satellite postures - Google Patents

State feedback robustnon-fragile control method applicable for determination of agile satellite postures Download PDF

Info

Publication number
CN105068425A
CN105068425A CN201510493674.4A CN201510493674A CN105068425A CN 105068425 A CN105068425 A CN 105068425A CN 201510493674 A CN201510493674 A CN 201510493674A CN 105068425 A CN105068425 A CN 105068425A
Authority
CN
China
Prior art keywords
satellite
matrix
moment
attitude
input torque
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.)
Pending
Application number
CN201510493674.4A
Other languages
Chinese (zh)
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.)
Harbin Institute of Technology
Original Assignee
Harbin Institute 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 Harbin Institute of Technology filed Critical Harbin Institute of Technology
Priority to CN201510493674.4A priority Critical patent/CN105068425A/en
Publication of CN105068425A publication Critical patent/CN105068425A/en
Pending legal-status Critical Current

Links

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The invention provides a state feedback robust non-fragile control method applicable for determination of agile satellite postures. The objective is to solve problems of high fragility and restrains on control input of a current controller. The control method comprises following steps of 1:obtaining a satellite posture system state equation according to a satellite posture kinetic equation based on the model parameter uncertainty Delta A, external disturbance torque w(t), controller gain perturbation and gyroscopic drift d(t); 2: obtaining a state feedback controller gain matrix K according to the satellite posture kinetic equation; 3) obtaining a theoretical control input torque [mu](t) according to the state feedback controller gain matrix K; and 4) judging whether the theoretical control input torque is smaller than the upper limit of the actual control input torque so as to determine postures of satellite in the time tk. The control method is applicable for satellite field.

Description

A kind of Robust State-Feedback non-fragiie control method being applicable to the quick attitude of satellite and determining
Technical field
The present invention relates to the Robust State-Feedback non-fragiie control method that the attitude of satellite is determined.
Background technology
The design of quick satellite attitude control system is very complicated, and its control accuracy and control efficiency play a part very crucial for the aerial mission of satellite.Owing to usually there is a lot of disturbing factor in quick satellite operation environment, as model parameter uncertainty, gyroscopic drift, external interference moment, controller gain perturbations etc., these factors can affect the serviceability of satellite, therefore need to design high performance controller.In the controls, robustness mainly refers to that resisting external disturbance makes self to keep the ability of stability comparatively strong, and fragility causes due to controller self perturbation, changes more responsive to inherent parameters.When designing the robust non-fragile controller of attitude of satellite system, the problem of can not ignore run into is that the control inputs of system is limited, causes that the fragility of existing controller is high and control inputs is limited.
Summary of the invention
The object of the invention is the problem that fragility is high and control inputs is limited in order to solve existing controller, and propose a kind of Robust State-Feedback non-fragiie control method being applicable to the quick attitude of satellite and determining.
Above-mentioned goal of the invention is achieved through the following technical solutions:
Step one, according to Dynamical Attitude Equations, when model parameter uncertainty Δ A, external interference moment w (t), controller gain perturbations and gyroscopic drift d (t), obtain attitude of satellite system state equation;
Step 2, according to attitude of satellite system state equation, obtain state feedback controller gain matrix K;
Step 3, given satellite initial attitude x (0), according to state feedback controller gain matrix K, obtain theoretical control inputs moment u (t); Judge whether theoretical control inputs moment is less than the working control input torque upper limit, and then determine that satellite is at t kthe attitude in moment, the working control input torque upper limit is determined by topworks.
Invention effect
Adopt a kind of Robust State-Feedback non-fragiie control method being applicable to the quick attitude of satellite and determining of the present invention, satellite considers model parameter uncertainty in gesture stability process, gyroscopic drift, external interference moment, the impact of controller gain perturbations factor, these uncertain factors are taken into account Satellite Attitude Control System state equation, according to the known coefficient matrix in system state equation, propose three LMIs, convex optimization problem under utilizing the mincx function in LMI tool box to solve LMI constraint, and then obtain the gain matrix of Robust State-Feedback non-fragile controller, thus the problem that the fragility solving controller is high, additional saturated process is carried out to theoretical control inputs moment, solve the problem that control inputs is limited.When considering that model parameter uncertainty, gyroscopic drift, external interference moment and the gain of controller addition type are perturbed at the same time, the control inputs moment that the attitude angle of satellite, attitude angular velocity and topworks provide can be obtained, as shown in figs 2-4.Can find out, designed robust non-fragile controller can make satellite closed cycle attitude control system reach steady state (SS) in 15s, and under this controller action, the control inputs moment maximal value of satellite is no more than 0.25Nm.Non-fragiie control is not also mentioned in this in satellite gravity anomaly field; The control inputs moment upper limit of Fig. 5 has exceeded the control inputs moment upper limit of 0.25Nm, Fig. 4 not more than 0.25Nm.
Accompanying drawing explanation
Fig. 1 is the process flow diagram that Robust State-Feedback non-fragile controller controls;
Fig. 2 is the attitude angle of satellite under the effect of Robust State-Feedback non-fragile controller, wherein, solid line represents the roll angle of satellite, dotted line represents the angle of pitch of satellite, phase line represents the crab angle of satellite, and θ is the angle of pitch of satellite, and ψ is the crab angle of satellite, for the roll angle of satellite, rad is radian;
Fig. 3 is the attitude angular velocity of satellite under the effect of Robust State-Feedback non-fragile controller, wherein, solid line represents the rate of roll of satellite, dotted line represents the rate of pitch of satellite, phase line represents the yaw rate of satellite, and rad/s is radian per second;
Fig. 4 is the working control input torque of satellite under the effect of Robust State-Feedback non-fragile controller, wherein, solid line represents the working control input torque of satellite around the axis of rolling, dotted line represents the working control input torque of satellite around pitch axis, phase line represents the working control input torque of satellite around yaw axis, u xfor satellite is around the working control input torque of the axis of rolling, u yfor satellite is around the working control input torque of pitch axis, u zfor satellite is around the working control input torque of yaw axis, Nm is ox rice;
Fig. 5 is the theoretical control inputs moment of satellite under the effect of Robust State-Feedback non-fragile controller, wherein, solid line represents the theoretical control inputs moment of satellite around the axis of rolling, dotted line represents the theoretical control inputs moment of satellite around pitch axis, phase line represents the theoretical control inputs moment of satellite around yaw axis.
Embodiment
Embodiment one: composition graphs 1 illustrates present embodiment, a kind of Robust State-Feedback non-fragiie control method being applicable to the quick attitude of satellite and determining, it is characterized in that, be a kind ofly applicable to that Robust State-Feedback non-fragiie control method that the quick attitude of satellite determines specifically carries out according to the following steps:
Step one, according to Dynamical Attitude Equations, when model parameter uncertainty Δ A, external interference moment w (t), controller gain perturbations and gyroscopic drift d (t), obtain attitude of satellite system state equation;
Step 2, according to attitude of satellite system state equation, obtain state feedback controller gain matrix K;
Step 3, given satellite initial attitude x (0), according to state feedback controller gain matrix K, obtain theoretical control inputs moment u (t); Judge whether theoretical control inputs moment is less than the working control input torque upper limit, and then determine that satellite is at t kthe attitude in moment, the working control input torque upper limit is determined by topworks.
Embodiment two: present embodiment and embodiment one unlike: according to Dynamical Attitude Equations in described step one, when model parameter uncertainty Δ A, external interference moment w (t), controller gain perturbations and gyroscopic drift d (t), obtain attitude of satellite system state equation, detailed process is:
Dynamical Attitude Equations is:
I x I x ω · x + ( I z - I y ) ω y ω z = T c x + T g x + T d x I y ω · y + ( I x - I z ) ω z ω x = T c y + T g ν + T d y I z ω · z + ( I y - I x ) ω x ω y = T c z + T g z + T d z - - - ( 1 )
In formula, I xfor satellite orbit coordinate system x-axis moment of inertia, I yfor satellite orbit coordinate system y-axis moment of inertia, I zfor satellite orbit coordinate system z-axis moment of inertia, ω xfor satellite orbit coordinate system x-axis measuring satellite angular velocities, ω yfor satellite orbit coordinate system y-axis measuring satellite angular velocities, ω zfor satellite orbit coordinate system z-axis measuring satellite angular velocities, T cxfor the control inputs moment of satellite orbit coordinate system x-axis, T cyfor the control inputs moment of satellite orbit coordinate system y-axis, T czfor the control inputs moment of satellite orbit coordinate system z-axis, T gxfor satellite orbit coordinate system x-axis gravity gradient torque, T gyfor satellite orbit coordinate system y-axis gravity gradient torque, T gzfor satellite orbit coordinate system z-axis gravity gradient torque, T dxfor satellite orbit coordinate system x-axis external interference moment, T dyfor satellite orbit coordinate system y-axis external interference moment, T dzfor satellite orbit coordinate system z-axis external interference moment, for the first order derivative of satellite orbit coordinate system x-axis angular velocity, for the first order derivative of satellite orbit coordinate system y-axis angular velocity, for the first order derivative of satellite orbit coordinate system z-axis angular velocity;
Wherein,
In formula, ω 0for orbit angular velocity, for roll angle, θ is the angle of pitch;
Be located under attitude angle is less than the angle of 10 °, measuring satellite angular velocities is:
In formula, for first order derivative, ψ is crab angle, for the first order derivative of θ, for the first order derivative of ψ;
Adopt zyx rotating manner, obtaining attitude dynamic equations is:
In formula, for second derivative, for the second derivative of θ, for the second derivative of ψ;
When model parameter uncertainty Δ A, external interference moment w (t), controller gain perturbations and gyroscopic drift d (t), definition status variable is utilize the surveying instrument such as star sensor and gyroscope to record output variable to be by above-mentioned attitude dynamic equations linearization, draw attitude of satellite system state equation:
{ x · ( t ) = ( A + Δ A ) x ( t ) + B 1 u ( t ) + B 2 w ( t ) y ( t ) = C 1 x ( t ) + D 1 d ( t ) + D 2 z ( t ) = C 2 x ( t ) - - - ( 5 )
In formula, u (t) is theoretical control inputs moment, and w (t) is external interference moment, and z (t) is control output variable, for the first order derivative of t state variable, the output variable that y (t) is t, the state variable that x (t) is t, B 1for control inputs matrix of coefficients, B 2for external interference matrix of coefficients, C 1for coefficient of regime matrix in output can be surveyed, C 2for controlling coefficient of regime matrix in output, D 1for Gyro drift coefficient matrix, D 2for surveying constant value matrix in output, A is model coefficient matrix, and Δ A is model parameter uncertainty, and its form is
ΔA=M 1F 1(t)N 1
(6)
F 1(t) TF 1(t)≤I
In formula, M 1for determining the known constant real matrix of Δ A line number, N 1for determining the known constant real matrix of Δ A columns, F 1t (), for determining that Δ A changes the unknown matrix of speed, I is unit diagonal matrix, and T is matrix transpose symbol;
Definition gyroscopic drift is constant value drift:
A = 0 0 0 1 0 0 0 0 0 0 1 0 0 0 0 0 0 1 A 41 0 0 0 0 - ω 0 I x - 1 ( I y - I x - I z ) 0 A 52 0 0 0 0 0 0 A 63 ω 0 I z - 1 ( I y - I x - I z ) 0 0
A 41 = - 4 ω 0 2 I x - 1 ( I y - I z )
A 52 = - 3 ω 0 2 I y - 1 ( I x - I z )
A 63 = - ω 0 2 I z - 1 ( I y - I x )
B 1 = B 2 = D 1 = 0 3 × 3 d i a g ( I x - 1 , I y - 1 , I z - 1 ) T
u(t)=[T cxT cyT cz] T
w(t)=[T dxT dyT dz] T
D 2=[0 1×400] T
C 1 = I 3 × 3 0 3 × 3 B I 3 × 3
B = 0 - ω 0 ω 0 0 2 × 2
C 2=[I 6×6]
In formula, T is matrix transpose symbol, I 3 × 3be the diagonal unit battle array of 3 × 3, I 6 × 6be the diagonal unit battle array of 6 × 6,0 1 × 4be the null matrix of 1 × 4,0 3 × 3be the null matrix of 3 × 3, B is the constant real matrix determined by orbit angular velocity, 0 2 × 2be the null matrix of 2 × 2,0 is the null matrix of 1 × 1, for by I xinverse, I yinverse and I zthe inverse diagonal matrix formed.
Other step and parameter identical with embodiment one.
Embodiment three: present embodiment and embodiment one or two unlike: according to attitude of satellite system state equation in described step 2, obtain state feedback controller gain matrix K; Detailed process is:
Design point feedback robust non-fragile controller is:
u(t)=(K+ΔK)x(t)(7)
In formula, u (t) for theoretical control inputs moment, K be standard controller gain matrix, Δ K is controller gain perturbations,
And meet: ΔKΔK T ≤ η 0 2 I
In formula, I is unit diagonal matrix, η 0for given constant, because the gain perturbation of Robust State-Feedback non-fragile controller (7) to controller has certain robustness, be called as non-fragile controller,
Only consider the addition type perturbation situation of controller gain herein, have:
ΔK=M 2F 2(t)N 2
(8)
F 2(t) TF 2(t)≤I
In formula, M 2for determining the known constant real matrix of Δ K line number, N 2for determining the known constant real matrix of Δ K columns, F 2(t) for determining that Δ K changes the unknown matrix of speed,
For given ξ 1>0, ξ 2>0 and γ >0, consider that the attitude dynamic equations of uncertain factor is Quadratic Stability under the Robust State-Feedback non-fragile controller effect of design, z (t) meets H performance constraints, and control inputs u (t) is limited, if there is symmetric positive definite matrix X and matrix W, LMI (9), (10), (11) is set up:
A X + B 1 W + XA T + W T B 1 T M 1 XN 1 T B 1 M 2 XN 2 T XC 2 T B 2 M 1 T - &xi; 1 - 1 I 0 0 0 0 0 N 1 X 0 - &xi; 1 I 0 0 0 0 ( B 1 M 2 ) T 0 0 - &xi; 2 - 1 I 0 0 0 N 2 X 0 0 0 - &xi; 2 I 0 0 C 2 X 0 0 0 0 - I 0 B 2 T 0 0 0 0 0 - &gamma; 2 I < 0 - - - ( 9 )
- &gamma; 0 I x ( 0 ) T x ( 0 ) - X < 0 - - - ( 10 )
- X W T X T W - &lambda; 0 &gamma; 0 - 1 I + &epsiv; - 1 &eta; 0 2 I 0 X 0 - &epsiv; - 1 I < 0 - - - ( 11 )
In formula, X is symmetric positive definite matrix, and W is general matrix, M 1for the constant real matrix of known dimension, N 1for the constant real matrix of known dimension, M 2for the constant real matrix of known dimension, N 2for the constant real matrix of known dimension, ξ 1for known normal number, ξ 2for known normal number, I is diagonal unit battle array, and γ is known normal number, γ 0for known normal number, x (0) is satellite initial attitude, λ 0for ensureing the optimized variable of input-bound, ε is known normal number, for known normal number;
According to attitude of satellite system state equation, utilize the mincx function in LMI tool box, minimize λ 0solve the convex optimization optimum solution under LMI (9), (10), (11) constraint, and each known matrix in LMI is determined by the matrix of coefficients in attitude of satellite system state equation, thus obtain state feedback controller gain matrix: K=WX -1.
Other step and parameter identical with embodiment one or two.
Embodiment four: present embodiment and embodiment one, two or three are unlike given satellite initial attitude x (0) in described step 3, according to state feedback controller gain matrix K, obtain theoretical control inputs moment u (t); Judge whether theoretical control inputs moment is less than the working control input torque upper limit, and then determine that satellite is at t kthe attitude in moment, the working control input torque upper limit is determined by topworks; Detailed process is:
Given satellite initial attitude x (0), substitutes into Robust State-Feedback non-fragile controller (7) by state feedback controller gain matrix K, obtains theoretical control inputs moment u (t);
Judge whether theoretical control inputs moment u (t) obtained by state feedback controller gain matrix K is less than the working control input torque upper limit, and the working control input torque upper limit is determined by topworks;
If theoretical control inputs moment is less than or equal to working control input torque sat (u) upper limit, then preserve previous moment, i.e. t k-1the control inputs moment in moment, substitutes into Satellite Attitude Control System state equation (5), determines that satellite is at t kthe attitude in moment;
If theoretical control inputs moment is greater than the working control input torque upper limit, then saturated process is carried out to theoretical control inputs moment u (t), obtain t k-1working control input torque sat (u) in moment, substitutes into Satellite Attitude Control System state equation (5), determines that satellite is at t kthe attitude in moment;
Wherein, saturated process is carried out to theoretical control inputs moment u (t), obtain t k-1the process of working control input torque sat (u) in moment is:
Working control input torque is sat (u), and its form is
sat(u)=[sat(u x)sat(u y)sat(u z)] T(12)
In formula, sat (u x) be the working control input torque on x-axis component, sat (u y) be the working control input torque on y-axis component, sat (u z) be the working control input torque on z-axis component, T is matrix transpose symbol;
Detailed process is:
s a t ( u i ) = u m i u i > u m i u i - u m i &le; u i &le; u m i - u m i u i < - u m i - - - ( 13 )
Wherein, u mithe working control input torque upper limit that (i=x, y, z) can provide for topworks, m represents upper limit symbol, sat (u i) be working control input torque on the i-th axle component.
Wherein, topworks is counteraction flyback or control-moment gyro, is the topworks of satellite attitude control system;
Other step and parameter and embodiment one, two or three identical.
Embodiment five: present embodiment and embodiment one, two, three or four unlike: the working control input torque upper limit in described step 3 is when selecting counteraction flyback to be topworks, and the scope of its actual control inputs moment upper limit is generally 0 ~ 1Nm.
Other step and parameter and embodiment one, two, three or four identical.
Embodiment six: present embodiment and embodiment one, two, three or four unlike: the working control input torque upper limit in described step 3 is when selecting control-moment gyro to be topworks, and the scope of its actual control inputs moment upper limit is 0 ~ 50Nm.
Other step and parameter and embodiment one, two, three or four identical.
Embodiment 1:
A kind ofly be applicable to that Robust State-Feedback non-fragiie control method that the quick attitude of satellite determines specifically carries out according to the following steps:
Step one, according to Dynamical Attitude Equations, when uncertain factors such as model parameter uncertainty Δ A, external interference moment w (t) and gyroscopic drifts d (t), obtain attitude of satellite system state equation;
Step 2, according to attitude of satellite system state equation, obtain state feedback controller gain matrix K;
Step 3, given satellite initial attitude x (0), according to state feedback controller gain matrix K, obtain theoretical control inputs moment u (t); Judge whether theoretical control inputs moment is less than the working control input torque upper limit, and then determine that satellite is at t kthe attitude in moment, the working control input torque upper limit is determined by topworks;
If satellite moment of inertia I x=20kgm 2, I y=18kgm 2, I z=15kgm 2, be highly 300km in orbit,
Original state
x(0)=[0.08rad,0.06rad,-0.06rad,0.01rad/s,0.01rad/s,0.01rad/s],
External interference moment:
w ( t ) = 5 c o s ( &omega; 0 t ) 5 cos ( &omega; 0 t + &pi; / 4 ) 5 cos ( &omega; 0 t + &pi; / 3 ) &times; 10 - 4 N m
Wherein, ω 0for the orbit angular velocity of satellite.
M 1=[0.81.11.31.51.61.8] T,N 1=[-0.1-0.2-0.3-0.4-0.21]
M 2=[111] T,N 2=[0.10.10.10.10.10.1],F 2(t)=sin(100ω 0t+π/4),
ξ 1=0.025,ξ 2=0.022,γ=0.1,ε=0.001,η 0=0.1,F 1(t)=sin(100ω 0t)
Control moment upper limit value is u mx=u my=u mz=0.25Nm.
Thus it is as follows to obtain simulation result:
The gain utilizing LMI tool box can obtain the lower Robust State-Feedback non-fragile controller of addition type gain perturbation is:
K = - 21.3156 - 13.8040 - 67.5413 - 49.3180 - 11.3360 24.2525 6.8685 - 40.5112 - 105.5648 - 19.3245 - 46.8950 13.7111 14.3558 - 8.5390 - 127.3973 1.4976 - 14.4843 - 99.5766
As shown in Figure 5, as shown in Figure 4, as shown in Figure 2, attitude angular velocity as shown in Figure 3 at corresponding attitude of satellite angle for the working control input torque obtained after carrying out saturated process for the theoretical control inputs moment obtained.
The control inputs moment upper limit of Fig. 5 has exceeded the control inputs moment upper limit of 0.25Nm, Fig. 4 not more than 0.25Nm.

Claims (6)

1. be applicable to the Robust State-Feedback non-fragiie control method that the quick attitude of satellite is determined, it is characterized in that, be a kind ofly applicable to that Robust State-Feedback non-fragiie control method that the quick attitude of satellite determines specifically carries out according to the following steps:
Step one, according to Dynamical Attitude Equations, when model parameter uncertainty Δ A, external interference moment w (t), controller gain perturbations and gyroscopic drift d (t), obtain attitude of satellite system state equation;
Step 2, according to attitude of satellite system state equation, obtain state feedback controller gain matrix K;
Step 3, given satellite initial attitude x (0), according to state feedback controller gain matrix K, obtain theoretical control inputs moment u (t); Judge whether theoretical control inputs moment is less than the working control input torque upper limit, and then determine that satellite is at t kthe attitude in moment, the working control input torque upper limit is determined by topworks.
2. a kind of Robust State-Feedback non-fragiie control method being applicable to the quick attitude of satellite and determining according to claim 1, it is characterized in that, according to Dynamical Attitude Equations in described step one, when model parameter uncertainty Δ A, external interference moment w (t), controller gain perturbations and gyroscopic drift d (t), obtain attitude of satellite system state equation, detailed process is:
Dynamical Attitude Equations is:
I x I x &omega; &CenterDot; x + ( I z - I y ) &omega; y &omega; z = T c x + T g x + T d x I y &omega; &CenterDot; y + ( I x - I z ) &omega; z &omega; x = T c y + T g &nu; + T d y I z &omega; &CenterDot; z + ( I y - I x ) &omega; x &omega; y = T c z + T g z + T d z - - - ( 1 )
In formula, I xfor satellite orbit coordinate system x-axis moment of inertia, I yfor satellite orbit coordinate system y-axis moment of inertia, I zfor satellite orbit coordinate system z-axis moment of inertia, ω xfor satellite orbit coordinate system x-axis measuring satellite angular velocities, ω yfor satellite orbit coordinate system y-axis measuring satellite angular velocities, ω zfor satellite orbit coordinate system z-axis measuring satellite angular velocities, T cxfor the control inputs moment of satellite orbit coordinate system x-axis, T cyfor the control inputs moment of satellite orbit coordinate system y-axis, T czfor the control inputs moment of satellite orbit coordinate system z-axis, T gxfor satellite orbit coordinate system x-axis gravity gradient torque, T gyfor satellite orbit coordinate system y-axis gravity gradient torque, T gzfor satellite orbit coordinate system z-axis gravity gradient torque, T dxfor satellite orbit coordinate system x-axis external interference moment, T dyfor satellite orbit coordinate system y-axis external interference moment, T dzfor satellite orbit coordinate system z-axis external interference moment, for the first order derivative of satellite orbit coordinate system x-axis angular velocity, for the first order derivative of satellite orbit coordinate system y-axis angular velocity, for the first order derivative of satellite orbit coordinate system z-axis angular velocity;
Wherein,
In formula, ω 0for orbit angular velocity, for roll angle, θ is the angle of pitch;
Be located under attitude angle is less than the angle of 10 °, measuring satellite angular velocities is:
In formula, for first order derivative, ψ is crab angle, for the first order derivative of θ, for the first order derivative of ψ;
Adopt zyx rotating manner, obtaining attitude dynamic equations is:
In formula, for second derivative, for the second derivative of θ, for the second derivative of ψ;
When model parameter uncertainty Δ A, external interference moment w (t), controller gain perturbations and gyroscopic drift d (t), definition status variable is utilize star sensor and gyroscope survey instrument to record output variable to be by above-mentioned attitude dynamic equations linearization, draw attitude of satellite system state equation:
x &CenterDot; ( t ) = ( A + &Delta; A ) x ( t ) + B 1 u ( t ) + B 2 w ( t ) y ( t ) = C 1 x ( t ) + D 1 d ( t ) + D 2 z ( t ) = C 2 x ( t ) - - - ( 5 )
In formula, u (t) is theoretical control inputs moment, and w (t) is external interference moment, and z (t) is control output variable, for the first order derivative of t state variable, the output variable that y (t) is t, the state variable that x (t) is t, B 1for control inputs matrix of coefficients, B 2for external interference matrix of coefficients, C 1for coefficient of regime matrix in output can be surveyed, C 2for controlling coefficient of regime matrix in output, D 1for Gyro drift coefficient matrix, D 2for surveying constant value matrix in output, A is model coefficient matrix, and Δ A is model parameter uncertainty, and its form is
ΔA=M 1F 1(t)N 1
(6)
F 1(t) TF 1(t)≤I
In formula, M 1for determining the known constant real matrix of Δ A line number, N 1for determining the known constant real matrix of Δ A columns, F 1t (), for determining the unknown matrix that Δ A changes, I is unit diagonal matrix, T is matrix transpose symbol;
Definition gyroscopic drift is constant value drift:
A = 0 0 0 1 0 0 0 0 0 0 1 0 0 0 0 0 0 1 A 41 0 0 0 0 - &omega; 0 I x - 1 ( I y - I x - I z ) 0 A 52 0 0 0 0 0 0 A 63 &omega; 0 I z - 1 ( I y - I x - I z ) 0 0
A 41 = - 4 &omega; 0 2 I x - 1 ( I y - I z )
A 52 = - 3 &omega; 0 2 I y - 1 ( I x - I z )
A 63 = - &omega; 0 2 I z - 1 ( I y - I x )
B 1 = B 2 = D 1 = &theta; 3 &times; 3 d i a g ( I x - 1 , I y - 1 , I z - 1 ) T
u(t)=[T cxT cyT cz] T
w(t)=[T dxT dyT dz] T
D 2=[0 1×400] T
C 1 = I 3 &times; 3 0 3 &times; 3 B I 3 &times; 3
B = 0 - &omega; 0 &omega; 0 0 2 &times; 2
C 2=[I 6×6]
In formula, T is matrix transpose symbol, I 3 × 3be the diagonal unit battle array of 3 × 3, I 6 × 6be the diagonal unit battle array of 6 × 6,0 1 × 4be the null matrix of 1 × 4,0 3 × 3be the null matrix of 3 × 3, B is the constant real matrix determined by orbit angular velocity, 0 2 × 2be the null matrix of 2 × 2,0 is the null matrix of 1 × 1, for by I xinverse, I yinverse and I zthe inverse diagonal matrix formed.
3. a kind of Robust State-Feedback non-fragiie control method being applicable to the quick attitude of satellite and determining according to claim 2, is characterized in that, according to attitude of satellite system state equation in described step 2, obtains state feedback controller gain matrix K; Detailed process is:
Design point feedback robust non-fragile controller is:
u(t)=(K+ΔK)x(t)(7)
In formula, u (t) for theoretical control inputs moment, K be standard controller gain matrix, Δ K is controller gain perturbations,
And meet: &Delta;K&Delta;K T &le; &eta; 0 2 I
In formula, I is unit diagonal matrix, η 0for given constant;
The addition type perturbation situation of Robust State-Feedback non-fragile controller gain is:
ΔK=M 2F 2(t)N 2
(8)
F 2(t) TF 2(t)≤I
In formula, M 2for determining the known constant real matrix of Δ K line number, N 2for determining the known constant real matrix of Δ K columns, F 2t () is for determining the unknown matrix that Δ K changes;
Given ξ 1>0, ξ 2>0 and γ >0, if there is symmetric positive definite matrix X and matrix W, then makes LMI (9), (10), (11) set up:
A X + B 1 W + XA T + W T B 1 T M 1 XN 1 T B 1 M 2 XN 2 T XC 2 T B 2 M 1 T - &xi; 1 - 1 I 0 0 0 0 0 N 1 X 0 - &xi; 1 I 0 0 0 0 ( B 1 M 2 ) T 0 0 - &xi; 2 - 1 I 0 0 0 N 2 X 0 0 0 - &xi; 2 I 0 0 C 2 X 0 0 0 0 - I 0 B 2 T 0 0 0 0 0 - &gamma; 2 I < 0 - - - ( 9 )
- &gamma; 0 I x ( 0 ) T x ( 0 ) - X < 0 - - - ( 10 )
- X W T X T W - &lambda; 0 &gamma; 0 - 1 I + &epsiv; - 1 &eta; 0 2 I 0 X 0 - &epsiv; - 1 I < 0 - - - ( 11 )
In formula, X is symmetric positive definite matrix, and W is general matrix, M 1for the constant real matrix of known dimension, N 1for the constant real matrix of known dimension, M 2for the constant real matrix of known dimension, N 2for the constant real matrix of known dimension, ξ 1for known normal number, ξ 2for known normal number, I is diagonal unit battle array, and γ is known normal number, γ 0for known normal number, x (0) is satellite initial attitude, λ 0for ensureing the optimized variable of input-bound, ε is known normal number, for known normal number;
According to attitude of satellite system state equation, utilize the mincx function in LMI tool box, minimize λ 0, solve the convex optimization optimum solution under LMI (9), (10), (11) constraint, thus obtain state feedback controller gain matrix: K=WX -1.
4. a kind of Robust State-Feedback non-fragiie control method being applicable to the quick attitude of satellite and determining according to claim 3, it is characterized in that, given satellite initial attitude x (0) in described step 3, according to state feedback controller gain matrix K, obtain theoretical control inputs moment u (t); Judge whether theoretical control inputs moment is less than the working control input torque upper limit, and then determine that satellite is at t kthe attitude in moment, the working control input torque upper limit is determined by topworks; Detailed process is:
Given satellite initial attitude x (0), substitutes into Robust State-Feedback non-fragile controller (7) by state feedback controller gain matrix K, obtains theoretical control inputs moment u (t);
Judge whether theoretical control inputs moment u (t) obtained by state feedback controller gain matrix K is less than the working control input torque upper limit, and the working control input torque upper limit is determined by topworks;
If theoretical control inputs moment is less than or equal to working control input torque sat (u) upper limit, then preserve previous moment, i.e. t k-1the control inputs moment in moment, substitutes into Satellite Attitude Control System state equation, determines that satellite is at t kthe attitude in moment;
If theoretical control inputs moment is greater than the working control input torque upper limit, then saturated process is carried out to theoretical control inputs moment u (t), obtain t k-1working control input torque sat (u) in moment, substitutes into Satellite Attitude Control System state equation, determines that satellite is at t kthe attitude in moment;
Wherein, saturated process is carried out to theoretical control inputs moment u (t), obtain t k-1the process of working control input torque sat (u) in moment is:
Working control input torque is sat (u), and its form is
sat(u)=[sat(u x)sat(u y)sat(u z)] T(12)
In formula, sat (u x) be the working control input torque on x-axis component, sat (u y) be the working control input torque on y-axis component, sat (u z) be the working control input torque on z-axis component, T is matrix transpose symbol;
Detailed process is:
s a t ( u i ) = u m i u i > u m i u i - u m i &le; u i &le; u m i - u m i u i < - u m i - - - ( 13 )
Wherein, u mithe working control input torque upper limit that (i=x, y, z) can provide for topworks, m represents upper limit symbol, sat (u i) be working control input torque on the i-th axle component.
5. a kind of Robust State-Feedback non-fragiie control method being applicable to the quick attitude of satellite and determining according to claim 4, it is characterized in that, the working control input torque upper limit in described step 3 is when selecting counteraction flyback to be topworks, and the scope of its actual control inputs moment upper limit is 0 ~ 1Nm.
6. a kind of Robust State-Feedback non-fragiie control method being applicable to the quick attitude of satellite and determining according to claim 4, it is characterized in that, the working control input torque upper limit in described step 3 is when selecting control-moment gyro to be topworks, and the scope of its actual control inputs moment upper limit is 0 ~ 50Nm.
CN201510493674.4A 2015-08-12 2015-08-12 State feedback robustnon-fragile control method applicable for determination of agile satellite postures Pending CN105068425A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510493674.4A CN105068425A (en) 2015-08-12 2015-08-12 State feedback robustnon-fragile control method applicable for determination of agile satellite postures

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510493674.4A CN105068425A (en) 2015-08-12 2015-08-12 State feedback robustnon-fragile control method applicable for determination of agile satellite postures

Publications (1)

Publication Number Publication Date
CN105068425A true CN105068425A (en) 2015-11-18

Family

ID=54497816

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510493674.4A Pending CN105068425A (en) 2015-08-12 2015-08-12 State feedback robustnon-fragile control method applicable for determination of agile satellite postures

Country Status (1)

Country Link
CN (1) CN105068425A (en)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106828981A (en) * 2017-03-13 2017-06-13 上海航天控制技术研究所 Tiltedly winged large inertia couples the compensation method of constant value disturbance torque and the system of satellite
CN108121202A (en) * 2016-11-30 2018-06-05 中国科学院沈阳自动化研究所 A kind of feedback of status switch controller design method based on delayed switching strategy
CN111176317A (en) * 2020-02-05 2020-05-19 哈尔滨工业大学 Non-fragile performance-guaranteeing static output feedback attitude stability control method
CN113220003A (en) * 2021-03-31 2021-08-06 西北工业大学 Attitude stabilization hybrid non-fragile control method for non-cooperative flexible assembly spacecraft

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102073280A (en) * 2011-01-13 2011-05-25 北京科技大学 Fuzzy singular perturbation modeling and attitude control method for complex flexible spacecraft
CN103148853A (en) * 2013-03-20 2013-06-12 清华大学 Satellite attitude determination method and system based on star sensors
CN104090489A (en) * 2014-07-02 2014-10-08 中国科学院长春光学精密机械与物理研究所 Flexible agile satellite attitude maneuver rolling optimization control method
CN104252177A (en) * 2013-06-27 2014-12-31 上海新跃仪表厂 Ground target staring anti-saturation tracking control method of microsatellite

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102073280A (en) * 2011-01-13 2011-05-25 北京科技大学 Fuzzy singular perturbation modeling and attitude control method for complex flexible spacecraft
CN103148853A (en) * 2013-03-20 2013-06-12 清华大学 Satellite attitude determination method and system based on star sensors
CN104252177A (en) * 2013-06-27 2014-12-31 上海新跃仪表厂 Ground target staring anti-saturation tracking control method of microsatellite
CN104090489A (en) * 2014-07-02 2014-10-08 中国科学院长春光学精密机械与物理研究所 Flexible agile satellite attitude maneuver rolling optimization control method

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
CHUANG LIU,等: "Robust H∞ Control for Satellite Attitude Control System with Uncertainties and Additive Perturbation", 《INTERNATIONAL JOURNAL OF SCIENCE》 *
GAO. X,等: "Non-fragile robust H∞ control for uncertain spacecraft rendezvous system with pole and input constraints", 《INTERNATIONAL JOURNAL OF CONTROL》 *
王景,等: "控制输入受限情况下卫星姿态的鲁棒自适应控制", 《宇航学报》 *

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108121202A (en) * 2016-11-30 2018-06-05 中国科学院沈阳自动化研究所 A kind of feedback of status switch controller design method based on delayed switching strategy
CN106828981A (en) * 2017-03-13 2017-06-13 上海航天控制技术研究所 Tiltedly winged large inertia couples the compensation method of constant value disturbance torque and the system of satellite
CN106828981B (en) * 2017-03-13 2020-01-03 上海航天控制技术研究所 Constant interference moment compensation method and system for oblique flying large-inertia coupling satellite
CN111176317A (en) * 2020-02-05 2020-05-19 哈尔滨工业大学 Non-fragile performance-guaranteeing static output feedback attitude stability control method
CN111176317B (en) * 2020-02-05 2021-05-18 哈尔滨工业大学 Non-fragile performance-guaranteeing static output feedback attitude stability control method
CN113220003A (en) * 2021-03-31 2021-08-06 西北工业大学 Attitude stabilization hybrid non-fragile control method for non-cooperative flexible assembly spacecraft

Similar Documents

Publication Publication Date Title
Zhu et al. An enhanced anti-disturbance attitude control law for flexible spacecrafts subject to multiple disturbances
Ding et al. Nonsmooth attitude stabilization of a flexible spacecraft
CN106774373A (en) A kind of four rotor wing unmanned aerial vehicle finite time Attitude tracking control methods
CN105629732B (en) A kind of spacecraft attitude output Tracking Feedback Control method for considering Control constraints
CN106985139A (en) Robot for space active disturbance rejection control method for coordinating with compensating is observed based on extended mode
Zhao et al. Finite-time super-twisting sliding mode control for Mars entry trajectory tracking
Liu et al. Robust dynamic output feedback control for attitude stabilization of spacecraft with nonlinear perturbations
CN104345738A (en) Rope system releasing stable control method and electric force rope system off-tracking stable control method
CN105068425A (en) State feedback robustnon-fragile control method applicable for determination of agile satellite postures
CN102736518A (en) Composite anti-interference controller comprising measurement and input time delay for flexible spacecraft
CN110316402A (en) A kind of satellite attitude control method under formation control mode
CN104656447A (en) Differential geometry nonlinear control method for aircraft anti-interference attitude tracking
Malekzadeh et al. A robust nonlinear control approach for tip position tracking of flexible spacecraft
CN104843197B (en) The dicyclo method of guidance that a kind of great-jump-forward reenters
CN104991566A (en) Parameter uncertainty LPV system modeling method for hypersonic flight vehicles
Li et al. Anti-disturbance control for attitude and altitude systems of the helicopter under random disturbances
Lyu et al. Constrained multi‐observer‐based fault‐tolerant disturbance‐rejection control for rigid spacecraft
Guisser et al. A high gain observer and sliding mode controller for an autonomous quadrotor helicopter
He et al. Coning motion stability of spinning missiles with strapdown seekers
Li et al. Null‐space‐based optimal control reallocation for spacecraft stabilization under input saturation
Diao et al. An output feedback attitude tracking controller design for quadrotor unmanned aerial vehicles using quaternion
Bouadi et al. Flight path tracking based-on direct adaptive sliding mode control
CN112393835B (en) Small satellite on-orbit thrust calibration method based on extended Kalman filtering
Ignatyev et al. Wind tunnel tests for validation of control algorithms at high angles of attack using autonomous aircraft model mounted in 3DOF gimbals
Zaki et al. Robust trajectory control of an unmanned aerial vehicle using acceleration feedback

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
WD01 Invention patent application deemed withdrawn after publication
WD01 Invention patent application deemed withdrawn after publication

Application publication date: 20151118