Method for refined attitude control based on output feedback for flexible spacecraft
09776741 · 2017-10-03
Assignee
Inventors
- Lei Guo (Beijing, CN)
- Jianzhong Qiao (Beijing, CN)
- Ran Zhang (Beijing, CN)
- Peixi Zhang (Beijing, CN)
- Dafa Zhang (Beijing, CN)
Cpc classification
B64G1/245
PERFORMING OPERATIONS; TRANSPORTING
International classification
B64G1/24
PERFORMING OPERATIONS; TRANSPORTING
G06F17/16
PHYSICS
Abstract
The present invention provides a method for refined attitude control based on output feedback for a flexible spacecraft. The control method comprises the following steps of: a) building a flexible spacecraft dynamical system Σ.sub.1, converting the flexible spacecraft dynamical system Σ.sub.1 into a flexible spacecraft dynamical system Σ.sub.2, and incorporating spacecraft rigid-flexible coupling dynamic disturbance into the flexible spacecraft dynamical system Σ.sub.2; b) constructing an external system Σ.sub.3, and describing the rigid-flexible coupling dynamic disturbance through the external system Σ.sub.3; c) configuring a disturbance observer for estimating the value of the rigid-flexible coupling dynamic disturbance; d) configuring a dynamic output feedback H.sub.∞ controller; e) compounding the disturbance observer in step c) with the dynamic output feedback H.sub.∞ controller in step d) to obtain a flexible spacecraft refined attitude control system Σ.sub.6; the flexible spacecraft refined attitude control system Σ.sub.6 compensating for the rigid-flexible coupling dynamic disturbance through the estimated value.
Claims
1. A method for refined attitude control based on output feedback for a flexible spacecraft, comprising the following steps of: a) building a flexible spacecraft dynamical system Σ.sub.1, converting the flexible spacecraft dynamical system Σ.sub.1 into a flexible spacecraft dynamical system Σ.sub.2, and incorporating spacecraft rigid-flexible coupling dynamic disturbance into the flexible spacecraft dynamical system Σ.sub.2; b) constructing an external system Σ.sub.3, and describing the rigid-flexible coupling dynamic disturbance through the external system Σ.sub.3; the rigid-flexible coupling dynamic disturbance d.sub.0 is expressed as d.sub.0=F(C.sub.d{dot over (η)}+Λη), in which F is a rigid-flexible coupling matrix of a flexible appendage and a body, C.sub.d is a modal damping matrix, Λ is a rigidity matrix, η is a mode of the flexible appendage, and {dot over (η)} is a derivative of the mode {dot over (η)} of the flexible appendage; the external system Σ.sub.3 describing the rigid-flexible coupling dynamic disturbance d.sub.0 as:
Σ.sub.5:ė.sub.w=(W+LCBV)e.sub.w+LVAx+(LVB+H)d.sub.1 wherein, e.sub.w=w−ŵ, ŵ is an estimated value of the disturbance state variable w and ė.sub.w is a derivative of e.sub.w; d) configuring a dynamic output feedback H.sub.∞ controller; wherein the dynamic output feedback H.sub.∞ controller in the step d) is expressed as:
2. The method according to claim 1, wherein the flexible spacecraft dynamical system Σ.sub.1 is expressed as:
3. The method according to claim 2, wherein the modal damping matrix C.sub.d is expressed as C.sub.d=diag{2ζ.sub.iω.sub.i} (i=1, 2, . . . N), in which N is a number of orders of the mode, ζ.sub.i is modal damping, ω.sub.i is a modal frequency, and the rigidity matrix Λ is expressed as Λ=diag{ω.sub.i.sup.2} (i=1, 2, . . . N).
4. The method according to claim 1, wherein the system Σ.sub.2 is expressed as:
Σ.sub.2:(J−FF.sup.T){umlaut over (θ)}=F(C.sub.d{dot over (η)}+Λη)+u+d.sub.1 wherein, {umlaut over (θ)} is the second-order derivative of the spacecraft attitude angle θ, J is the spacecraft rotational inertia, F is the rigid-flexible coupling matrix of the flexible appendage and the body, F.sup.T is the transposed matrix of the rigid-flexible coupling matrix, u is the control input, d.sub.1 is the environmental disturbance torque, η is the mode of the flexible appendage, {dot over (η)} is the derivative of the mode η of the flexible appendage, C.sub.d is the modal damping matrix, and Λ is the rigidity matrix.
5. The method according to claim 1, wherein in the coefficient matrix W, the matrix M is expressed as M=I−F.sup.T J.sup.−1F, in which I is the unit matrix.
6. The method according to claim 1, wherein the disturbance controller gain matrix L and the controller parameter matrixes A.sub.x, B.sub.x, C.sub.x, D.sub.x to be determined are solved through a convex optimization algorithm as below: making the systems Σ.sub.4, Σ.sub.5 and Σ.sub.6 simultaneous, and obtaining:
7. A spacecraft using the method of claim 1.
8. A spacecraft with the refined attitude control for a flexible spacecraft, comprising a spacecraft shell, an external system module, a disturbance observation module, a dynamic output feedback module, a refined attitude control module, a central processing unit (CPU), a control unit, a spacecraft flexible wing plate and a flexible spacecraft dynamical module, wherein the external system module is used to describe the rigid-flexible coupling dynamic disturbance, and delivers the description result of the rigid-flexible coupling dynamic disturbance to the refined attitude control module; the disturbance observation module is used to estimate the value of the rigid-flexible coupling dynamic disturbance by a disturbance observer; the dynamic output feedback module is used to suppress the environmental disturbance by a dynamic output feedback H.sub.∞ controller; the refined attitude control module is combined by the disturbance observation module and the dynamic output feedback module, and is used to compensate for the rigid-flexible coupling dynamic disturbance of the spacecraft with the estimated value of the rigid-flexible coupling dynamic disturbance of the spacecraft; the flexible spacecraft dynamical module is used to incorporate the spacecraft rigid-flexible coupling disturbance into a flexible spacecraft dynamical system; the central processing unit (CPU) reads the data of the refined attitude control module and processes the data; the control unit compensates for the rigid-flexible coupling dynamic disturbance of the spacecraft through the refined attitude control module, and adjusts the attitude of the spacecraft; and the spacecraft flexible wing plate is unfolded at two ends of the spacecraft shell.
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)
(3)
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 refined attitude control based on output feedback for a flexible spacecraft. As shown in
(8) With the purpose of illustration, the method for refined attitude control based on output feedback for a flexible spacecraft provided in the present invention is implemented by different modules. As shown in
(9) As shown in
(10) The external system module 202 is used to describe the rigid-flexible coupling dynamic disturbance. The external system module 202 delivers the description result of the rigid-flexible coupling dynamic disturbance to the refined attitude control module 205.
(11) The disturbance observation module 203 is used to estimate the value of the rigid-flexible coupling dynamic disturbance by a disturbance observer.
(12) The dynamic output feedback module 204 is used to suppress the environmental disturbance by a dynamic output feedback H.sub.∞ controller.
(13) The refined attitude control module 205 is combined by the disturbance observation module 203 and the dynamic output feedback module 204. The refined attitude control module 205 is used to compensate for the rigid-flexible coupling dynamic disturbance of the spacecraft with the estimated value of the rigid-flexible coupling dynamic disturbance of the spacecraft.
(14) The flexible spacecraft dynamical module 209 is used to incorporate the spacecraft rigid-flexible coupling disturbance into a flexible spacecraft dynamical system.
(15) The central processing unit (CPU) 206 reads the data of the refined attitude control module 205 and processes the data.
(16) The control unit 207 executes the processing result of the central processing unit (CPU) 206 and performs refined control for the attitude of the spacecraft. Specifically, the control unit 207 compensates for the rigid-flexible coupling dynamic disturbance of the spacecraft through the refined attitude control module 205, thereby adjusting the attitude of the spacecraft.
(17) The spacecraft attitude control method according to this embodiment will be described in detail below with reference to
(18) In step S101: incorporating spacecraft rigid-flexible coupling disturbance into a flexible spacecraft dynamical system, and incorporating rigid-flexible coupling dynamic disturbance.
(19) A flexible spacecraft dynamical system Σ.sub.1 is built and the system Σ.sub.1 is expressed as:
(20)
(21) wherein, θ is a spacecraft attitude angle, {umlaut over (θ)} is a second-order derivative of the spacecraft attitude angle θ, J is a spacecraft rotational inertia, F is the rigid-flexible coupling matrix of the flexible appendage and the body, F.sup.T is a transposed matrix of the rigid-flexible coupling matrix, u is control input, d.sub.1 is environmental disturbance torque, η is the mode of the flexible appendage, {dot over (η)} is the derivative of the mode η of the flexible appendage, {umlaut over (η)} is a second-order derivative of the mode η of the flexible appendage, C.sub.d is the modal damping matrix, and Λ is the rigidity matrix. The modal damping matrix C.sub.d is expressed as C.sub.d=diag{2ζ.sub.iω.sub.i} (i=1, 2, . . . N), in which N is a number of orders of the mode, ζ.sub.i is modal damping, ω.sub.i is a modal frequency; the rigidity matrix A is expressed as Λ=diag{ω.sub.i.sup.2} (i=1, 2, . . . N).
(22) The flexible spacecraft dynamical system Σ.sub.1 is converted into a system Σ.sub.2, which is expressed as: Σ.sub.2: (J−FF.sup.T){umlaut over (θ)}=F(C.sub.d {dot over (η)}+Λη)+u+d.sub.1, and in the system Σ.sub.2, F(C.sub.d{dot over (η)}+Λη) is flexible spacecraft rigid-flexible coupling dynamic disturbance.
(23) In step S102, describing the rigid-flexible coupling dynamic disturbance through an external system Σ.sub.3.
(24) Make d.sub.0=F(C.sub.d{dot over (η)}+Λη), d.sub.0 indicates the rigid-flexible coupling dynamic disturbance, and the rigid-flexible coupling dynamic disturbance d.sub.0 is described using the external system Σ.sub.3:
(25)
(26) w is a disturbance state variable of the external system Σ.sub.3, {dot over (w)} is a derivative of w, W, H and V are defined coefficient matrixes, and in the matrix W, the matrix M is expressed as M=I−F.sup.T J.sup.−1F, and I is a unit matrix.
(27) In step S103, configuring a disturbance observer for estimating the value of the incorporated rigid-flexible coupling dynamic disturbance.
(28) The rigid-flexible coupling dynamic disturbance is incorporated into the spacecraft dynamical system in step S101, and it needs to estimate the value of the rigid-flexible coupling dynamic disturbance. The disturbance observer is used to estimate the value of the rigid-flexible coupling dynamic disturbance. The configuration of the disturbance observer will be described below in detail.
(29) The disturbance observer is specifically configured in the following steps:
(30) (1) constructing a spacecraft attitude angle input matrix
(31)
(32) (2) converting the system Σ.sub.2 into a state space system Σ.sub.4, which is expressed as:
(33)
(34) wherein,
(35)
A and B are coefficient matrixes, y is a measurement output, and C is a measurement matrix;
(36) (3) configuring the disturbance observer with the aid of the measurement output y, and the disturbance observer is specifically expressed through the following formula:
(37)
(38) wherein, {circumflex over (d)}.sub.0 is an estimated value of the rigid-flexible coupling dynamic disturbance d.sub.0, v is an auxiliary variable, {dot over (v)} is a derivative of the auxiliary variable v, y is the measurement output, and L is a disturbance observer gain matrix; observation error dynamic Σ.sub.5 of the disturbance controller is expressed as:
Σ.sub.5:ė.sub.w=(W+LCBV)e.sub.w+LVAx+(LVB+H)d.sub.1
(39) wherein, e.sub.w=w−ŵ, ŵ is an estimated value of the disturbance state variable w, and ė.sub.w is a derivative of e.sub.w. The disturbance observer configured through the formula (1) estimates the value of {circumflex over (d)}.sub.0 of the rigid-flexible coupling dynamic disturbance d.sub.0.
(40) In step S104, configuring a dynamic output feedback H.sub.∞ controller for suppressing the environmental disturbance.
(41) The dynamic output feedback H.sub.∞ controller is specifically expressed though the following formula:
(42)
(43) wherein, u.sub.1 is input of the dynamic output feedback H.sub.∞ controller, x.sub.k is a controller state, A.sub.x, B.sub.x, C.sub.x and D.sub.x are controller parameter matrixes to be determined, and the dynamic output feedback H.sub.∞ controller suppresses environmental disturbance.
(44) In step S105, compounding the disturbance observer with the dynamic output feedback H.sub.∞ controller to compensate the estimated value of the rigid-flexible coupling dynamic disturbance.
(45) In order to clearly describe the refined attitude control of the spacecraft, it needs to compensate for the rigid-flexible coupling dynamic disturbance incorporated into the spacecraft dynamical system with the estimated value. In the present invention, a refined attitude control system is used to compound the disturbance observer with the dynamic output feedback H.sub.∞ controller to compensate the estimated value of the rigid-flexible coupling dynamic disturbance.
(46) In this embodiment, in particular, the expression (1) of the disturbance observer is compounded with the expression (1) of the dynamic output feedback H.sub.∞ controller to obtain a flexible spacecraft refined attitude control system Σ.sub.6 which is specifically expressed as:
(47)
(48) in which, u is the control input, and {circumflex over (d)}.sub.0 is the value of the rigid-flexible coupling dynamic disturbance d.sub.0 estimated by the disturbance observer.
(49) In the above flexible spacecraft refined attitude control system Σ.sub.6 the control input u is subtracted by the estimated value {circumflex over (d)}.sub.0 of the rigid-flexible coupling dynamic disturbance d.sub.0 on the basis of input u.sub.1 of the dynamic output feedback H.sub.∞ controller. When the value {circumflex over (d)}.sub.0 estimated by the disturbance observer is approximate to the rigid-flexible coupling dynamic disturbance d.sub.0, i.e., {circumflex over (d)}.sub.0≈d.sub.0, the flexible spacecraft refined attitude control system Σ.sub.6 realizes the compensation for the rigid-flexible coupling dynamic disturbance d.sub.0 through the estimated value {circumflex over (d)}.sub.0 of the rigid-flexible coupling dynamic disturbance.
(50) The disturbance controller gain matrix L and the controller parameter matrixes A.sub.x, B.sub.x, C.sub.x, D.sub.x to be determined are solved through a convex optimization algorithm as below:
(51) making the systems Σ.sub.4, Σ.sub.5 and Σ.sub.6 simultaneous, and obtaining:
(52)
(53) solving the following convex optimization problem:
(54)
(55) Using the method for refined attitude control based on output feedback for a flexible spacecraft according to the present invention, a disturbance model is set up with respect to rigid-flexible coupling dynamics, and disturbance information is fully used. The configuration of the controller and disturbance observer is implemented using output feedback, which has more engineering value compared with the control methods based on state feedback.
(56) In certain aspects, the present invention relates to a spacecraft using the method as described above.
(57) Other examples of the present invention are obvious and easy to conceive for a person skilled in the art by combining the description disclosed herein and practice. The description and examples are only for illustration, and the real scope and essence of the present invention will be defined by the claims.
(58) 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.
(59) 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.