Method for disturbance compensation based on sliding mode disturbance observer for spacecraft with large flexible appendage

09694918 ยท 2017-07-04

Assignee

Inventors

Cpc classification

International classification

Abstract

The present invention provides a method for disturbance compensation based on a sliding mode disturbance observer for a spacecraft with a large flexible appendage, comprising steps of: a) building a spacecraft attitude control system; b) constructing an external system, the external system being incorporated with an uncertain portion of a damping matrix of a flexible appendage of the spacecraft; the external system being incorporated with an uncertain portion of a rigidity matrix of the flexible appendage of the spacecraft and describing a sum of flexible vibration and environmental disturbance; c) configuring a sliding mode disturbance observer for estimating the value of the sum of flexible vibration and environmental disturbance; d) compounding a nominal controller with the sliding mode disturbance observer in step c) to obtain a compound controller; the compound controller compensating for the sum of flexible vibration and environmental disturbance.

Claims

1. A method for disturbance compensation based on a sliding mode disturbance observer for a spacecraft with a large flexible appendage, comprising the following steps of: a) building a spacecraft attitude control system .sub.1, the spacecraft attitude control system .sub.1 being incorporated with environmental disturbance and being converted into the spacecraft attitude control system .sub.2, and the spacecraft attitude control system .sub.2 being incorporated with a sum of flexible vibration and environmental disturbance; b) constructing an external system .sub.3, the external system .sub.3 describing the sum of flexible vibration and environmental disturbance; wherein, the external system .sub.3 is constructed through the following steps: (1) incorporating an uncertain portion C.sub. of a damping matrix C of the flexible appendage of the spacecraft, and incorporating an uncertain portion D.sub. of a rigidity matrix D of the flexible appendage of the spacecraft; describing the damping matrix and rigidity matrix of the spacecraft as below: { C = C 0 + C D = D 0 + D in which, C.sub.0 and D.sub.0 are respectively nominal parameters measured on the ground; (2) defining state variables w.sub.1=, w.sub.2={dot over ()} and w.sub.3=d, obtaining the following equation: [ w . 1 w . 2 w . 3 ] = [ 0 I 0 - GD - GC - G J - 1 0 0 0 ] [ w 1 w 2 w 3 ] - [ 0 G 0 ] J - 1 ( - x J + u ) + [ 0 0 d . ] in which, I is a unit matrix, and a matrix G=(IJ.sup.1.sup.T).sup.1; (3) defining the following coefficient matrix: W = [ 0 I 0 - GD 0 - GC 0 - G J - 1 0 0 0 ] , B = - [ 0 G 0 ] J - 1 , and V = [ T D T C I ] ; (4) the external system .sub.3 being described as below: .Math. 3 : { w . = ( W + W ) w + B ( - x J + u ) + d _ = V w in which, w=[w.sub.1.sup.T w.sub.2.sup.T w.sub.3.sup.T].sup.T, is an uncertain vector, and is expressed as: =[0 0 {dot over (d)}].sup.T; W.sub. satisfies a bounded condition W.sub.=MF(t)N, M and N are constant matrixes of a proper number of dimensions, F(t) is a time-varying matrix and satisfies F.sup.T(t)F(t)I; a state variable w satisfies a norm bounded condition w, the sum d of flexible vibration and environmental disturbance satisfies a norm bounded condition d, in which and are known constants; c) configuring a sliding mode disturbance observer for estimating the value of the sum of flexible vibration and environmental disturbance; d) compounding a nominal controller with the sliding mode disturbance observer in step c) to obtain a compound controller; the compound controller compensating for the sum of flexible vibration and environmental disturbance according to the estimated value of the sum of flexible vibration and environmental disturbance.

2. The method according to claim 1, wherein the spacecraft attitude control system .sub.1 is expressed as: .Math. 1 : { J . + T .Math. = - x J + u + d .Math. + C . + D + . = 0 in which, J is an inertia matrix of the flexible spacecraft, is an absolute angular velocity of the flexible spacecraft, .sup.x indicates a cross product matrix, {dot over ()} is a derivative of the absolute angular velocity of the flexible spacecraft, is a rigid-flexible coupling matrix, is a modal coordinate, {umlaut over ()} is a second-order derivative of the modal coordinate ; u is control input, d is environmental disturbance, C is the damping matrix of the flexible appendage, and D is the rigidity matrix of the flexible appendage.

3. The method according to claim 2, wherein the damping matrix C of the flexible appendage is expressed as: C=diag{2.sub.i.sub.ni,i=1, 2, . . . , n}R.sup.nn, and the rigidity matrix D of the flexible appendage is expressed as: D=diag{.sub.ni.sup.2,i=1, 2, . . . , n}R.sup.nn, in which is a damping coefficient, .sub.ni is a natural frequency, and n is modal number.

4. The method according to claim 2, wherein the system .sub.2 is expressed as:
.sub.2: J.sub.0{dot over ()}=.sup.xJ+u+d in which, a coefficient matrix J.sub.0=J.sup.T, and the sum d of flexible vibration and environmental disturbance is expressed as d=.sup.T(C{dot over ()}+D)+d.

5. The method according to claim 1, wherein the steps for configuring the sliding mode disturbance observer are as follows: (1) constructing an auxiliary system .sub.4, which is expressed as: J.sub.0{circumflex over ({dot over ()})}=.sup.x+u+v, in which {circumflex over ()} is a state variable of the auxiliary system, and v is a sliding mode term; (2) making the sliding mode term v = k ~ .Math. .Math. , in which, {tilde over ()}={circumflex over ()}, k> is a given constant, and converting the auxiliary system .sub.4 to a system .sub.5, which is expressed as: J.sub.0{tilde over ({dot over ()})}=dv; (3) constructing a Lyapunov function V.sub.1={tilde over ()}.sup.TJ.sub.0{tilde over ()} for the system .sub.5, and taking derivative for the Lyapunov function V.sub.1, obtaining the following relationship: V . 1 - 2 ( k - ) m a x ( J 0 ) V 1 1 2 , in which, .sub.max(J.sub.0) is the maximum eigenvalue of J.sub.0; (4) configuring a sliding mode disturbance observer .sub.6, which is expressed as: .Math. 6 : { d _ ^ = V w ^ , w ^ = + L J 0 . = ( W - LV ) w ^ + ( B - L ) ( - x J + u ) + P - 1 V T sign ( v ) in which, {circumflex over (d)} is the estimated value of the sum d of flexible vibration and environmental disturbance, is an estimated value of the state variable w, is an auxiliary state variable, L is an observer gain to be determined, >0 is an adjustable constant, P>0 is a positive definite symmetric matrix to be solved, sign(.Math.) is a sign function, and for a n-dimensional vector, x = [ x 1 .Math. x n ] T , the sign function sign(.Math.) satisfies sign ( x ) = [ sign ( x 1 ) .Math. sign ( x n ) ] T .

6. The compensation method according to claim 5, wherein in the step (3), {tilde over ()} is converged to zero within a limited time of t.sub.r, the sliding mode term v is equivalent to d, wherein t r = m a x ( J 0 ) V 1 1 2 ( 0 ) k - , V.sub.1(0) is an initial value of the Lyapunov function V.sub.1.

7. The compensation method according to claim 1, wherein, the sliding mode disturbance observer observes that an error e.sub.w asymptotically converges into an adjustable area near a balance point, and the adjustable area is expressed as: = { e w R 2 n .Math. .Math. Ve w .Math. 1 .Math. N .Math. 2 + 2 .Math. .Math. 2 2 } , wherein, .sub.1>0, .sub.2>0 are given constants.

8. The compensation method according to claim 5, wherein, the observer gain L to be determined and the positive definite symmetric matrix P to be solved are solved as below: the positive definite symmetric matrix P and a matrix P.sub.L satisfy the following linear matrix inequality: [ ( PW - P L V ) + ( PW - P L V ) T PM P * - 1 I 0 * * - 2 I ] < 0 in which, .sub.1>0, .sub.2>0 are given constants, I is a unit matrix with a proper number of dimensions, the symbol * represents a symmetrical portion of a symmetrical matrix, and the gain matrix is selected to be L=P.sup.1P.sub.L.

9. The compensation method according to claim 1, wherein, the compound controller is expressed as: u=u.sub.n{circumflex over (d)}, u.sub.n is the nominal controller used for stabilizing a nominal system without flexible vibration or environmental disturbance, and {circumflex over (d)} is a value of the sum d of flexible vibration and environmental disturbance estimated by the sliding mode disturbance observer.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

(1) Further objectives, effects, and advantages of the present invention will become apparent from the following description of the embodiments of the present invention with reference to the accompanying drawings, wherein:

(2) FIG. 1 illustrates a design flow chart of the method for disturbance compensation based on a sliding mode disturbance observer for a spacecraft with a large flexible appendage according to the present invention;

(3) FIG. 2 shows a module block diagram of a spacecraft according to an embodiment of the present invention.

DETAILED DESCRIPTION OF THE INVENTION

(4) Objects and functions of the present invention as well as methods for realizing these objects and functions will be elucidated with reference to exemplary embodiments. However, the present invention is not limited to the following disclosed exemplary embodiments, but may be implemented in different ways. The description of the invention is merely provided to assist those of ordinary skill in the art in a comprehensive understanding of specific details of the invention in nature.

(5) As used herein, the term module may refer to, be part of, or include an Application Specific Integrated Circuit (ASIC); an electronic circuit; a combinational logic circuit; a field programmable gate array (FPGA); a processor (shared, dedicated, or group) that executes code; other suitable hardware components that provide the described functionality; or a combination of some or all of the above, such as in a system-on-chip. The term module may include memory (shared, dedicated, or group) that stores code executed by the processor.

(6) Hereinafter, embodiments of the present invention will be described with reference to the drawings. In the drawings, like reference numerals designate like or similar parts or steps.

(7) The present invention provides a method for disturbance compensation based on a sliding mode disturbance observer for a spacecraft with a large flexible appendage. As shown in FIG. 1, it is a design flow chart of the method for disturbance compensation based on a sliding mode disturbance observer for a spacecraft with a large flexible appendage according to the present invention. In the spacecraft disturbance method 100 of this embodiment, a spacecraft attitude control system is built, and an external system is constructed for describing the sum of flexible vibration and external environmental disturbance of the spacecraft. A sliding mode disturbance observer is configured for estimating the value of the sum of flexible vibration and external environmental disturbance, and the sliding mode disturbance observer is compounded with a nominal controller to compensate for the sum of flexible vibration and external environmental disturbance and stabilize the attitude control system.

(8) With the purpose of illustration, the method for disturbance compensation based on a sliding mode disturbance observer for a spacecraft with a large flexible appendage provided by the present invention is implemented through different modules. As shown in FIG. 2, it is a module block diagram of the spacecraft with a large flexible appendage based on a sliding mode disturbance observer according to an embodiment of the present invention. Specifically, the spacecraft comprises a spacecraft shell 201, an external system module 202, a sliding mode disturbance observation module 203, a nominal control module 204, a compound control module 205, a central processing unit (CPU) 206, a control unit 207, a spacecraft flexible wing plate 208 and a spacecraft attitude control module 209.

(9) As shown in FIG. 2, the sliding mode disturbance observation module 203, the nominal control module 204, the compound control module 205, the central processing unit (CPU) 206, the control unit 207, the external system module 202 and the spacecraft attitude control module 209 are mounted inside the spacecraft shell 201. The spacecraft flexible wing plate 208 is unfolded at two ends of the spacecraft shell 201.

(10) The external system module 202 is configured to describe the sum of flexible vibration and external environmental disturbance by the external system. The external system module 202 delivers the description result of the sum of flexible vibration and external environmental disturbance to the compound control module 205.

(11) The sliding mode disturbance observation module 203 is configured to estimate the sum of flexible vibration and external environmental disturbance by a sliding mode disturbance observer.

(12) The nominal control module 204 is configured to control a nominal controller to compound with the sliding mode disturbance observer in the sliding mode disturbance observation module 203.

(13) The compound control module 205 is configured to compensate for the sum of flexible vibration and external environmental disturbance according to the estimated value {circumflex over (d)} of the sum d of flexible vibration and external environmental disturbance by a compound controller.

(14) The spacecraft attitude control module 209 is configured to incorporate the sum of flexible vibration and external environmental disturbance.

(15) The central processing unit (CPU) 206 reads the data of the compound control module 205, and processes the data.

(16) The control unit 207 executes the processing result of the central processing unit (CPU) 206 and controls the attitude of the spacecraft. Specifically, the control unit 207 compensates for the sum of flexible vibration and external environmental disturbance according to the estimated value {circumflex over (d)} of the sum d of flexible vibration and external environmental disturbance through the compound control module 205, there by adjusting the attitude of the spacecraft. The method for disturbance compensation based on a sliding mode disturbance observer for a spacecraft with a large flexible appendage will be described in detail with reference to FIG. 1. The specific steps are as follows:

(17) In step S101, building a spacecraft attitude control system, and the sum of flexible vibration and external environmental disturbance is incorporated into the spacecraft attitude control system.

(18) An external environmental disturbance is incorporated, and a spacecraft attitude control system .sub.1 is built. It is expressed as:

(19) .Math. 1 : { J . + T .Math. = - x J + u + d .Math. + C . + D + . = 0
in which, J is an inertia matrix of the flexible spacecraft, is an absolute angular velocity of the flexible spacecraft, .sup.x indicates a cross product matrix, {dot over ()} is a derivative of the absolute angular velocity of the flexible spacecraft, is a rigid-flexible coupling matrix, is a modal coordinate, {umlaut over ()} is a second-order derivative of the modal coordinate ; u is control input, d is environmental disturbance, C is the damping matrix of the flexible appendage, and is expressed as: C=diag{2.sub.i.sub.ni,i=1, 2, . . . , n}R.sup.nn; D is the rigidity matrix of the flexible appendage, and is expressed as: D=diag{.sub.ni.sup.2,i=1, 2, . . . , n}R.sup.nn, in which .sub.i is a damping coefficient, .sub.ni is a natural frequency, and n is modal number.

(20) A spacecraft attitude control system .sub.1 is converted into a spacecraft attitude control system .sub.2 through a mathematical conversion. The spacecraft attitude control system .sub.2 is incorporated into the sum of flexible vibration and environmental disturbance. The spacecraft attitude control system .sub.2 is expresses as: .sub.2: J.sub.0{dot over ()}=.sup.xJ+u+d, in which, a coefficient matrix J.sub.0=J.sup.T, and the sum d of flexible vibration and external environmental disturbance is expresses as: d=.sup.T(C{dot over ()}+D)+d.

(21) In step S102, describe the sum of flexible vibration and external environmental disturbance by constructing an external system .sub.3.

(22) Firstly, an uncertain portion C.sub. of a damping matrix C of the flexible appendage of the spacecraft is incorporated, and an uncertain portion D.sub. of a rigidity matrix D of the flexible appendage of the spacecraft is incorporated; the damping matrix and rigidity matrix of the spacecraft are described as below:

(23) { C = C 0 + C D = D 0 + D

(24) in which, C.sub.0 and D.sub.0 are respectively nominal parameters measured on the ground.

(25) Secondly, state variables w.sub.1=, w.sub.2={dot over ()} and w.sub.3=d are defined, obtaining the following equation:

(26) [ w . 1 w . 2 w . 3 ] = [ 0 I 0 - GD - GC - G J - 1 0 0 0 ] [ w 1 w 2 w 3 ] - [ 0 G 0 ] J - 1 ( - x J + u ) + [ 0 0 d . ]

(27) in which, I is a unit matrix, and a matrix G=(IJ.sup.1.sup.T).sup.1; a coefficient matrix is defined:

(28) W = [ 0 I 0 - GD 0 - GC 0 - G J - 1 0 0 0 ] , B = - [ 0 G 0 ] J - 1 , and V = [ T D T C I ] ;

(29) Finally, an external system .sub.3 is constructed and is described as below:

(30) .Math. 3 : { w . = ( W + W ) w + B ( - x J + u ) + d _ = V w
in which, w=[w.sub.1.sup.T w.sub.2.sup.T w.sub.3.sup.T].sup.T, is an uncertain vector, and is expressed as: =[0 0 {dot over (d)}].sup.T; W.sub. satisfies a bounded condition W.sub.=MF(t)N, M and N are constant matrixes of a proper number of dimensions, F(t) is a time-varying matrix and satisfies F.sup.T(t)F(t)I; a state variable w satisfies a norm bounded condition w, the sum d of flexible vibration and environmental disturbance satisfies a norm bounded condition d, in which and are known constants.

(31) In step S103, configuring a sliding mode disturbance observer for estimating the value of the sum of flexible vibration and environmental disturbance.

(32) The sum of flexible vibration and external environmental disturbance is incorporated into the spacecraft attitude control system built in step S101, and it needs to estimate the value of the sum of flexible vibration and external environmental disturbance. In the embodiment of the present invention, specifically, a sliding mode disturbance observer is used to estimate the sum of flexible vibration and external environmental disturbance.

(33) The steps for configuring the sliding mode disturbance observer are as follows:

(34) (1) constructing an auxiliary system .sub.4, which is expressed as: J.sub.0{dot over ()}=.sup.xJ+u+v, in which {circumflex over ()} is a state variable of the auxiliary system, and v is a sliding mode term;

(35) (2) making the sliding mode term

(36) 0 v = k ~ .Math. .Math. ,
in which, {tilde over ()}={circumflex over ()}, k> is a given constant, and converting the auxiliary system .sub.4 to a system .sub.5, which is expressed as: J.sub.0{tilde over ({dot over ()})}=dv;

(37) (3) constructing a Lyapunov function V.sub.1={tilde over ()}.sup.TJ.sub.0{tilde over ()} for the system .sub.5, and taking derivative for the Lyapunov function V.sub.1, obtaining the following relationship:

(38) V . 1 - 2 ( k - ) m a x ( J 0 ) V 1 1 2 ,
in which, .sub.max(J.sub.0) is the maximum eigenvalue of J.sub.0; then {tilde over ()} is converged to zero within a limited time of t.sub.r, the sliding mode term v is equivalent to d, wherein

(39) t r = m a x ( J 0 ) V 1 1 2 ( 0 ) k - ,
V.sub.1(0) is an initial value of the Lyapunov function V.sub.1.

(40) (4) configuring a sliding mode disturbance observer .sub.6, which is expressed as:

(41) .Math. 6 : { d _ ^ = V w ^ , w ^ = + L J 0 . = ( W - LV ) w ^ + ( B - L ) ( - x J + u ) + P - 1 V T sign ( v )

(42) in which, {circumflex over (d)} is the estimated value of the sum d of flexible vibration and environmental disturbance, is an estimated value of the state variable w, is an auxiliary state variable, L is an observer gain to be determined, >0 is an adjustable constant, P>0 is a positive definite symmetric matrix to be solved, sign(.Math.) is a sign function, and for a n-dimensional vector,

(43) x = [ x 1 .Math. x n ] T ,
the sign function sign(.Math.) satisfies

(44) sign ( x ) = [ sign ( x 1 ) .Math. sign ( x n ) ] T .

(45) In the present embodiment, the observer gain L to be determined and the positive definite symmetric matrix P to be solved are solved by way of an inequality as below:

(46) The positive definite symmetric matrix P and a matrix P.sub.L satisfy the following linear matrix inequality:

(47) [ ( PW - P L V ) + ( PW - P L V ) T PM P * - 1 I 0 * * - 2 I ] < 0
in which, .sub.1>0, .sub.2>0 are given constants, I is a unit matrix with a proper number of dimensions, the symbol * represents a symmetrical portion of a symmetrical matrix, and the gain matrix is selected to be L=P.sup.1P.sub.L. The sliding mode disturbance observer constructed in this embodiment observes that an error e.sub.w asymptotically converges into an adjustable area near a balance point, and the adjustable area , which is expressed as:

(48) = { e w R 2 n .Math. .Math. V e w .Math. 1 .Math. N .Math. 2 + 2 .Math. .Math. 2 2 } .

(49) A gain array of linear feedback is easily solved using the above linear matrix inequality in this embodiment. A sliding mode term parameter is selected according to accuracy and rate requirement. Through the selection of the sliding mode term parameter, the observation error is converged into an adjustable area including an original point, thereby improving the estimation accuracy of the observer.

(50) In step S104, compounding a nominal controller with the sliding mode disturbance observer to obtain a compound controller stabilizing system for compensating for the sum of flexible vibration and environmental disturbance.

(51) In the embodiment of the present invention, the sum of flexible vibration and environmental disturbance is incorporated into a spacecraft attitude control system, and the value of the sum is estimated through a configured disturbance observer. In the embodiment, the spacecraft attitude control system needs to compensate for the estimated value of the sum of flexible vibration and environmental disturbance, thus ensuring the precise control of the spacecraft attitude. A compound controller is used to compensate for the sum of flexible vibration and environmental disturbance in the present invention.

(52) The nominal controller is compounded with the sliding mode disturbance observer configured in step S103 to obtain a compound controller for stabilizing the system. The compound controller stabilizing system is specifically expressed as: u=u.sub.n{circumflex over (d)}, in which u.sub.n is the nominal controller used for stabilizing a nominal system without flexible vibration or environmental disturbance, and {circumflex over (d)} is a value of the sum d of flexible vibration and environmental disturbance estimated by the sliding mode disturbance observer. In the compound controller stabilizing system, the control input u is subtracted by the estimated value {circumflex over (d)} of the sum d of flexible vibration and environmental disturbance estimated by the sliding mode disturbance observer on the basis of the nominal controller u.sub.n, thereby allowing the compound controller to compensate for the sum d of flexible vibration and environmental disturbance with the estimated value {circumflex over (d)} of the sum of flexible vibration and environmental disturbance.

(53) In certain aspects, the present invention relates to a spacecraft using the method as described above.

(54) By combining the description and practice of the present invention disclose herein, other embodiments of the present invention are also easy to conceive and understand for a person skilled in the art. The description and embodiments are only illustrative, and the real scope and essence of the present invention shall be defined by the claims.

(55) According to the present invention, a sliding mode disturbance observer with high observation accuracy, strong robustness and easy gain scheduling is provided, which solves the difficulty of accurate estimation and compensation for disturbance with uncertain parameters that can be modeled, and improves the control accuracy of the system.

(56) Based on the description and practice of the present invention as disclosed herein, other embodiments of the present invention are readily conceived of and understood to those skilled in the art. The description and embodiments are provided for exemplary purpose only, the real scope and spirit of the present invention are defined by the claims.

(57) Other embodiments will be conceivable and understood by those skilled in the art upon consideration of this description or from practice of the invention disclosed herein. The description and embodiments are merely exemplary, and the true scope and spirit are intended to be defined by the claims.