Method for attitude controlling based on finite time friction estimation for flexible spacecraft
09663252 ยท 2017-05-30
Assignee
Inventors
- Lei Guo (Beijing, CN)
- Peixi Zhang (Beijing, CN)
- Jianzhong Qiao (Beijing, CN)
- Yukai Zhu (Beijing, CN)
- Jianwei Xu (Beijing, CN)
Cpc classification
B64G1/245
PERFORMING OPERATIONS; TRANSPORTING
F16F15/30
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
International classification
Abstract
The present invention provides a method for attitude control based on finite time friction estimation for a flexible spacecraft. The control method includes the following steps: a. introducing spacecraft flywheel friction disturbance into a spacecraft dynamics system, and establishing a flexible spacecraft dynamics system with flywheel friction disturbance; b. converting the flexible spacecraft dynamics system with flywheel friction disturbance into a state-space form; c. constructing a flywheel friction disturbance estimator; d. constructing a flexible appendage vibration disturbance observer; and e. combining the flywheel friction disturbance estimator in the step c and the flexible appendage vibration disturbance observer in the step d with a nominal controller to obtain a compound controller; the compound controller compensating for flywheel friction according to an estimated value of a flywheel friction moment; and the compound controller compensating for flexible appendage vibration disturbance according to an estimated value of flexible appendage vibration disturbance.
Claims
1. A method for attitude controlling based on finite time friction estimation for a flexible spacecraft, the control method comprising the following steps: a) introducing spacecraft flywheel friction disturbance into a flexible spacecraft dynamics system, and establishing a flexible spacecraft dynamics system .sub.1 with flywheel friction disturbance; b) converting the flexible spacecraft dynamics system .sub.1 with flywheel friction disturbance into a state-space form; c) constructing a flywheel friction disturbance estimator, the flywheel friction disturbance estimator estimating a value of a flywheel friction moment, wherein the method for constructing the flywheel friction disturbance estimator comprises the following steps: 1) establishing a flywheel dynamics model, the flywheel dynamics model being expressed as:
2. The control method according to claim 1, wherein the flexible spacecraft dynamics system .sub.1 with flywheel friction disturbance is expressed as:
3. The control method according to claim 2, wherein the control moment exerted by the flywheel on the spacecraft body is a resultant moment of the control moment resolved by the controller and the flywheel friction moment, the control moment exerted by the flywheel on the spacecraft body being expressed as:
T.sub.r(t)=T.sub.c(t)+M.sub.f(t) wherein T.sub.r(t) is an actual control moment exerted by the flywheel on the spacecraft body.
4. The control method according to claim 1, wherein the flexible spacecraft dynamics system .sub.1 with flywheel friction disturbance is converted into a system .sub.2 by means of mathematical manipulation: (JFF.sup.T){umlaut over ()}(t)=T.sub.c(t)+M.sub.l(t)+M.sub.f(t)+T.sub.d(t), wherein M.sub.l(t) represents vibration disturbance caused by flexible appendage vibration, and M.sub.l(t)=F(2{dot over ()}(t)+.sup.2(t)).
5. The control method according to claim 4, wherein
6. The control method according to claim 1, wherein a method for constructing the flexible appendage vibration disturbance observer in the step d comprises the following steps of: (1) establishing a flexible appendage vibration disturbance model, and constructing state variables w(t), W, and V of the flexible appendage vibration disturbance, the state variables of the flexible appendage vibration disturbance satisfying
L=[L.sub.11L.sub.12;L.sub.21L.sub.22;L.sub.31L.sub.32;L.sub.41L.sub.42].
7. The control method according to claim 1, wherein the nominal controller is a universal feedback controller, and the nominal controller is expressed as: u.sub.c(t)=Kx(t), wherein K is a gain matrix of the nominal controller, and the gain matrix of the nominal controller satisfies K=[K.sub.11; K.sub.21]; and the compound controller is expressed as: u(t)=u.sub.c(t){circumflex over (M)}.sub.l(t){circumflex over (M)}.sub.f(t), wherein u.sub.c(t) is an input of the nominal controller, and u(t) is the control moment exerted on the flywheel.
8. The control method according to claim 6, wherein the gain matrix L of the flexible appendage vibration disturbance observer is solved using an LMI toolbox, and the gain matrix K of the nominal controller is solved using an LMI tool.
9. A spacecraft for attitude controlling based on finite time friction estimation, comprising a spacecraft shell, a spacecraft dynamics module, a flywheel friction disturbance estimation module, a flexible appendage vibration disturbance observation module, a compound control module, a central processing unit (CPU), a control unit, and a flexible spacecraft wing flap, wherein the spacecraft dynamics module is used to introduce flywheel friction disturbance into a flexible spacecraft dynamics system; the flywheel friction disturbance estimation module is used to estimate a value of a flywheel friction moment by the flywheel friction disturbance estimator; the flexible appendage vibration disturbance observation module is used to estimate a value of a flexible appendage vibration disturbance by the flexible appendage vibration disturbance observer; the compound control module is used to compensate for the flywheel friction disturbance according to the estimated value of the flywheel friction moment, and to compensate for the flexible appendage vibration disturbance according to the estimated value of the flexible appendage vibration disturbance by the compound controller; the CPU reads and processes data from the anti-disturbance compound control module; the control unit performs spacecraft attitude control according to the execution result of the CPU, and adjusts the attitude of the spacecraft by using the compound control module to compensate for the flywheel friction disturbance and the flexible appendage vibration disturbance; and the flexible spacecraft wing flap unfolds at two ends of the spacecraft shell.
10. A spacecraft using the method of claim 1.
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 attitude controlling based on finite time friction estimation for a flexible spacecraft.
(8) For purpose of description, the method for attitude controlling based on finite time friction estimation for a flexible spacecraft according to the present invention is implemented using different modules.
(9) As shown in
(10) The spacecraft dynamics module 202 is used to introduce flywheel friction disturbance into a flexible spacecraft dynamics system.
(11) The flywheel friction disturbance estimation module 203 is used to estimate a value of a flywheel friction moment by the flywheel friction disturbance estimator.
(12) The flexible appendage vibration disturbance observation module 204 is used to estimate a value of a flexible appendage vibration disturbance by the flexible appendage vibration disturbance observer.
(13) The compound control module 205 is used to compensate for the flywheel friction disturbance according to the estimated value of the flywheel friction moment, and to compensate for the flexible appendage vibration disturbance according to the estimated value of the flexible appendage vibration disturbance by the compound controller.
(14) The CPU 206 reads and processes data from the anti-disturbance compound control module 205.
(15) The control unit 207 performs spacecraft attitude control according to the execution result of the CPU 206. Specifically, the control unit 207 adjusts the attitude of the spacecraft by using the compound control module 205 to compensate for the flywheel friction disturbance and the flexible appendage vibration disturbance.
(16) The method for attitude control for a flexible spacecraft according to this embodiment is specifically described below with reference to
(17) Step S101: Introducing flywheel friction disturbance into a spacecraft dynamics system, and establishing a flexible spacecraft dynamics system .sub.1 with flywheel friction disturbance.
(18) A flywheel system for spacecraft attitude control is an independent electromechanical execution component. The flywheel system is not only under the action of the electromagnetic driving moment of a flywheel motor, but also is influenced by the bearing friction force. A control moment exerted by the flywheel on the spacecraft body is a resultant moment of a control moment resolved by the controller and the flywheel friction moment, and is specifically expressed as T.sub.r(t)=T.sub.c(t)+M.sub.f(t), wherein T.sub.r(t) is an actual control moment exerted by the flywheel on the spacecraft body, T.sub.c(t) is a control moment resolved by an attitude controller, and M.sub.f(t) is the flywheel friction moment. Considering the influence of the friction force on attitude control, a flexible spacecraft dynamics system .sub.1 with flywheel friction disturbance is established, specifically expressed as:
(19)
(20) wherein J is rotational inertia of the spacecraft, {umlaut over ()}(t) is an angular acceleration of spacecraft attitude, F is a coupling matrix between the spacecraft attitude and a flexible structure, (t) is a flexible appendage vibration mode, {umlaut over ()}(t) is a second derivative of the flexible appendage vibration mode, is a vibration frequency corresponding to the flexible appendage vibration mode, is damping of the flexible appendage mode, T.sub.c(t) is the control moment resolved by the attitude controller, M.sub.f(t) is the flywheel friction moment, and T.sub.d(t) is a bounded disturbance torque of disturbance of an outer space environment on the spacecraft.
(21) Step S102: Converting the flexible spacecraft dynamics system with flywheel friction disturbance into a state-space form.
(22) The flexible spacecraft dynamics system .sub.1 with flywheel friction disturbance is converted into a system .sub.2 by means of mathematical manipulation: (JFF.sup.T){umlaut over ()}(t)=T.sub.c(t)+M.sub.l(t)+M.sub.f(t)+T.sub.d(t), wherein M.sub.l(t) represents vibration disturbance caused by flexible appendage vibration, and M.sub.l(t)=F(2{dot over ()}(t)+.sup.2(t)). The disturbance on the spacecraft caused by flexible appendage vibration is introduced into the system .sub.2.
(23)
is constructed, and the system .sub.2 is converted into a state-space form: {dot over (x)}(t)=Ax(t)+B.sub.1(u(t)+M.sub.f(t)+M.sub.l(t))+B.sub.2T.sub.d(t), wherein (t) is an attitude angle of the spacecraft, {dot over ()}(t) is an angular speed of spacecraft attitude, {dot over (x)}(t) is a derivative of x(t),
(24)
is a system matrix, and
(25)
is a control input matrix.
(26) Step S103: Constructing a flywheel friction disturbance estimator to estimate a value of a flywheel friction disturbance moment.
(27) In the step 101 of this embodiment, the flywheel friction disturbance is introduced into the spacecraft dynamics system, and the flywheel friction disturbance moment needs to be estimated in order to implement precise spacecraft attitude control. In the present invention, a flywheel friction disturbance estimator is constructed to estimate the flywheel friction disturbance moment.
(28) In addition, in some embodiments, the friction moment M.sub.f(t) of the flywheel system is a solid friction moment of a bearing. In some embodiments, the friction moment M.sub.f(t) of the flywheel system is a viscous friction moment caused by lubrication. In some other embodiments, the friction moment M.sub.f(t) of the flywheel system includes, but not limited to, a solid friction moment of a bearing and a viscous friction moment caused by lubrication. Generally, the solid friction moment of the bearing and the viscous friction moment caused by lubrication are both related to the rotational speed of the flywheel.
(29) The flywheel system has a low-speed friction characteristic. Considering the low-speed friction characteristic of the flywheel system, a flywheel friction disturbance estimator is constructed. A method for constructing the flywheel friction disturbance estimator in this embodiment is described below in detail:
(30) 1) establishing a flywheel dynamics model, the flywheel dynamics model being expressed as:
(31)
(32) wherein (t) is a rotational speed of a motor in a flywheel, the rotational speed is an angular speed, {dot over ()}(t) is an angular acceleration of the motor in the flywheel, {dot over (M)}.sub.f(t) is a rate of change of the flywheel friction moment, D is a damping coefficient of the flywheel, J.sub.w is rotational inertia of the flywheel, is a bearing rest slope parameter, and M.sub.f0 is a Coulomb friction moment;
(33) 2) constructing the flywheel friction disturbance estimator, the flywheel friction disturbance estimator being expressed as:
(34)
(35) wherein {circumflex over ()}(t) is an estimated value of the rotational speed (t) of the flywheel, {circumflex over (M)}.sub.f(t) is an estimated value of the flywheel friction moment M.sub.f(t), k.sub.1, k.sub.2, .sub.1, and .sub.2 are parameters, and e.sub.1(t)=(t){circumflex over ()}(t). By appropriately selecting the parameters k.sub.1, k.sub.2, .sub.1, and .sub.2, the estimated value {circumflex over ()}(t) of the rotational speed of the flywheel and the estimated value {circumflex over (M)}.sub.f(t) of the flywheel friction moment are made to converge at (t) and M.sub.f(t) in finite time. The parameters k.sub.1 and k.sub.2 are determined using a pole assignment method, k.sub.1 has a value ranging from 0 to 100, k.sub.2 has a value ranging from 80 to 0, and the parameters .sub.1 and .sub.2 are positive constants having a value ranging from 0 to 1.
(36) The flywheel friction moment is estimated by using the flywheel friction disturbance estimator constructed in this embodiment of the present invention.
(37) Step S104: Constructing a flexible appendage vibration disturbance observer to estimate a value of flexible appendage vibration disturbance.
(38) Considering the disturbance on the spacecraft attitude caused by flexible appendages, a flexible appendage vibration disturbance observer is constructed to estimate the flexible appendage vibration disturbance. A method for constructing the flexible appendage vibration disturbance observer in this embodiment includes the following steps:
(39) (1) establishing a flexible appendage vibration disturbance model, and constructing state variables w(t), W, and V of the flexible appendage vibration disturbance, the state variables of the flexible appendage vibration disturbance satisfying
(40)
(41)
and
(42)
and the flexible appendage vibration disturbance model being expressed as:
(43)
(44) wherein
(45)
and R=(1F.sup.T I.sup.1 F).sup.1;
(46) (2) constructing the flexible appendage vibration disturbance observer, the flexible appendage vibration disturbance observer is expressed as:
(47)
(48) wherein v(t) is an auxiliary state variable of the flexible appendage vibration disturbance observer, {circumflex over (M)}.sub.l(t) is the estimated value of the flexible appendage vibration disturbance M.sub.l(t), L is a gain matrix of the flexible appendage vibration disturbance observer, and the gain matrix of the flexible appendage vibration disturbance observer satisfies L=[L.sub.11 L.sub.12; L.sub.21 L.sub.22; L.sub.31 L.sub.32; L.sub.41 L.sub.42], and the gain matrix L of the flexible appendage vibration disturbance observer is solved using an LMI toolbox.
(49) In this embodiment, the spacecraft the flexible appendage vibration disturbance is estimated by using the flexible appendage vibration disturbance observer.
(50) Step S105: Configuring a compound controller to compensate for the flywheel friction and the flexible appendage vibration disturbance.
(51) A universal feedback controller is used as a nominal controller, and the nominal controller being specifically expressed as: u.sub.c(t)=Kx(t), wherein K is a gain matrix of the nominal controller, the gain matrix of the nominal controller satisfies K=[K.sub.11; K.sub.21] and the gain matrix K of the nominal controller is solved using an LMI tool. The nominal controller is combined with the flywheel friction disturbance estimator and the flexible appendage vibration disturbance observer to obtain a compound controller, the compound controller being specifically expressed as: u(t)=u.sub.c(t){circumflex over (M)}.sub.l{circumflex over (M)}.sub.f
(52) wherein u.sub.c(t) is an input of the nominal controller, u(t) is the control moment exerted on the flywheel, that is, the moment resolved by the attitude controller, and u(t)=T.sub.c(t).
(53) On the basis of a standard controller, the compound controller compensates for the flywheel friction disturbance according to the estimated value {circumflex over (M)}.sub.f(t) of the flywheel friction moment. On the basis of the nominal controller, the compound controller compensates for the flexible appendage vibration disturbance according to the estimated value {circumflex over (M)}.sub.l(t) of the flexible appendage vibration disturbance. By appropriately selecting the parameters k.sub.1, k.sub.2, .sub.1, and .sub.2, the estimated value {circumflex over (M)}.sub.f(t) of the flywheel friction moment is made to converge at M.sub.f(t) in finite time. The estimated value {circumflex over (M)}.sub.l(t) of the flexible appendage vibration disturbance obtained by the flexible appendage vibration disturbance observer is determined by solving the gain matrix L.
(54) The method for attitude controlling based on finite time friction estimation for a flexible spacecraft, which can rapidly track the friction force of a flywheel system and control flexible spacecraft friction disturbance and flexible appendage vibration disturbance, thereby implementing high-precision attitude control of the flexible spacecraft system.
(55) In certain aspects, the present invention relates to a spacecraft using the method as described above.
(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.