CN110502025B - Spacecraft attitude control method considering reactive flywheel characteristics and power limitation - Google Patents
Spacecraft attitude control method considering reactive flywheel characteristics and power limitation Download PDFInfo
- Publication number
- CN110502025B CN110502025B CN201910707553.3A CN201910707553A CN110502025B CN 110502025 B CN110502025 B CN 110502025B CN 201910707553 A CN201910707553 A CN 201910707553A CN 110502025 B CN110502025 B CN 110502025B
- Authority
- CN
- China
- Prior art keywords
- spacecraft
- constraint
- moment
- reaction flywheel
- attitude
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 45
- 238000006243 chemical reaction Methods 0.000 claims abstract description 125
- 238000005457 optimization Methods 0.000 claims abstract description 8
- 239000013598 vector Substances 0.000 claims description 34
- 239000011159 matrix material Substances 0.000 claims description 26
- 230000007246 mechanism Effects 0.000 claims description 13
- 230000008569 process Effects 0.000 claims description 8
- 230000009466 transformation Effects 0.000 claims description 8
- 230000015556 catabolic process Effects 0.000 claims description 6
- 238000006731 degradation reaction Methods 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 5
- 230000005855 radiation Effects 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 230000001131 transforming effect Effects 0.000 claims description 3
- 230000017105 transposition Effects 0.000 claims description 3
- 238000011217 control strategy Methods 0.000 abstract description 6
- 238000005265 energy consumption Methods 0.000 abstract description 6
- 238000001514 detection method Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 229920006395 saturated elastomer Polymers 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The invention discloses a spacecraft attitude control method considering the characteristics and power limitation of a reaction flywheel, which comprises the following steps of: establishing a spacecraft kinematics and dynamics model in a quaternion description mode; establishing a relation between the output power of the spacecraft body-mounted solar array and the solar incident angle; considering the characteristics of the reaction flywheel, establishing angular momentum constraint, control moment constraint and actual available power constraint of the reaction flywheel when the body-mounted solar array fails; designing a target performance function according to task requirements; and finishing the spacecraft attitude control task under the constraint condition based on a model prediction control strategy. The method can well solve the attitude control problem of the spacecraft when the characteristics of the reaction flywheel and the body-mounted solar array are considered and the body-mounted solar array fails, achieves comprehensive optimization of control accuracy and energy consumption through the design of the objective function, and ensures that the spacecraft can still complete high-accuracy attitude control tasks under the condition that the characteristics and the power of the reaction flywheel are limited.
Description
Technical Field
The invention belongs to the technical field of spacecraft attitude control, and particularly relates to a spacecraft attitude control method considering the characteristics of a reaction flywheel and limited power, which is mainly applied to the problem of spacecraft attitude control considering the change of a solar incident angle, the constraint of angular momentum of the flywheel, the constraint of control moment and the limited available power when a body-mounted solar panel fails.
Background
In recent years, with the rapid development of space technology and the trend of more diversification and complication of space flight tasks, the on-orbit attitude control of the spacecraft is an important guarantee for realizing various spacecraft engineering tasks including attitude adjustment operation, and is a key technology. The reaction flywheel has the advantages of fine control moment and no consumption of satellite working media, and gradually becomes one of main actuating mechanisms of the existing spacecraft, but the influence of the problems of angular momentum saturation, control moment saturation and the like which are easy to occur in the working process on the attitude control performance of the spacecraft cannot be ignored. Secondly, for a spacecraft which executes space tasks in orbit, energy sources required for completing tasks such as scientific detection, attitude control and the like are all derived from solar sailboards on the spacecraft, but the solar sailboards can be caused to break down due to a complex space environment. Meanwhile, considering that the energy generated by the solar sailboard needs to be used by the effective load, the attitude control system and other subsystems, the power which can be provided by the spacecraft for the attitude control system is limited and variable, and is mainly related to the spatial position of the spacecraft on the track, the solar incident angle of the sailboard and the attitude angle of the spacecraft body. Therefore, the research on the spacecraft can complete high-precision attitude control under the constraints of the characteristics of a reaction flywheel, the power limitation and the like, simultaneously meet the power consumption requirement and enable the energy consumed by an attitude control system to be as small as possible, thereby ensuring that the spacecraft can complete scientific tasks, and the method has certain engineering significance.
Aiming at the existing spacecraft attitude control method considering the characteristics of a reaction flywheel, patent 201610196190.8 provides a flexible spacecraft attitude control method aiming at the saturation and friction characteristics of the flywheel, but the method only considers the saturation characteristics of the control moment of the flywheel and does not consider the problem of limited power of the flywheel; similarly, patent 201810298997.1 proposes a model prediction control method for spacecraft attitude avoidance considering dynamic characteristics of a flywheel, but the method only considers angular momentum and control torque saturation characteristics of the flywheel, and does not consider the situation that available power of the flywheel is limited, and in actual situations, the actual power limitation of the flywheel will affect attitude control performance of the spacecraft.
Aiming at the research result of the attitude control problem of the spacecraft considering the power of the reaction flywheel at present, most of the existing control strategies are dedicated to realizing the optimal instantaneous total power of the reaction flywheel combination when providing the attitude control torque, but neglecting the condition that the optimal instantaneous total power is still larger than the minimum available power, and under the condition, the reaction flywheel combination still cannot provide the required control torque, thereby influencing the attitude control performance of the spacecraft.
Disclosure of Invention
The technical problem to be solved by the invention is as follows: in the process of attitude maneuver of the spacecraft, the angular momentum of the reaction flywheel is saturated, the control moment is saturated but not negligible, and meanwhile, the solar sailboard assembled in the spacecraft is likely to have faults, so that the available power provided by the sailboard is limited. Since this limited power is needed for the payload, attitude control system and other subsystems together, the power available for the attitude control system is only a small fraction of the faulty windsurfing board output power. In order to ensure the normal operation of the spacecraft, the attitude control system can complete high-precision and low-energy-consumption attitude control tasks under the requirement of small and variable available power. The invention provides a spacecraft attitude control method considering the characteristics and power limitation of a reaction flywheel based on a model prediction control strategy. The method can simultaneously process various practical engineering constraints, has good robustness, can enable the spacecraft to complete the attitude control task under the given power requirement, and can design the target performance function according to the task requirement so as to enable the spacecraft to realize the comprehensive optimization of control precision and energy consumption in the attitude control process.
The invention provides a spacecraft attitude control method considering the characteristics and power limitation of a reaction flywheel, which comprises the following steps of:
s1: aiming at the problem of spacecraft attitude control, establishing a spacecraft attitude kinematics and dynamics model in a quaternion description mode, discretizing the spacecraft attitude kinematics and dynamics model, and establishing a prediction model of a model prediction control method;
s2: establishing a relation between output power of the spacecraft body-mounted solar array and a solar incident angle, and converting the relation into an expression related to a spacecraft attitude angle;
s3: based on the characteristics of a reaction flywheel of a spacecraft actuating mechanism, establishing angular momentum constraint and control moment constraint of the reaction flywheel, and simultaneously establishing actual available power constraint of the reaction flywheel when the spacecraft-mounted solar panel fails;
s4: designing a target performance function according to task requirements;
s5: and (4) finishing the spacecraft attitude control task under the constraint established in the step S3 based on the prediction model of the model prediction control method established in the step S1.
Further, the spacecraft attitude kinematics and dynamics model in the quaternion description mode in the step S1 is as follows:
wherein J ∈ R3×3Is a spacecraft inertia matrix; ω ═ ω (ω)1,ω2,ω3)TThe three-axis angular velocity of the spacecraft body; h is belonged to R3The total angular momentum of the spacecraft is H ═ J omega + HRWA,HRWA∈R3Combining the projection of the angular momentum on the main axis of the inertia of the spacecraft for the reaction flywheel; u. ofc∈R3Controlling moment for the attitude of the spacecraft; q ═ q0,q1,q2,q3)TIs a quaternion for describing the attitude of the spacecraft and satisfiesXi (ω) is a skew antisymmetric matrix of specific form:
for any vector x ∈ R3Its corresponding oblique antisymmetric array x×The form is as follows:
when the influence of the orbital angular velocity of the spacecraft on the angular momentum of the reaction flywheel is neglected, the dynamic model of the reaction flywheel combination is as follows:
wherein, tauRWA∈RLIs the control moment generated by the L reaction flywheels; h isRWA∈RLIn order to counteract the angular momentum of the flywheel assembly,combining derivatives of angular momentum with respect to time for the reaction flywheel; j. the design is a squareRWA∈RL×LA matrix of moments of inertia in the form of a reaction flywheel assemblyThe moment of inertia of each reaction flywheel;for the rotational speed of the respective reaction flywheel,a derivative with respect to time for each reaction flywheel rotational speed;
based on a dynamic model of the reaction flywheel combination and a reaction flywheel combination configuration, the attitude control moment of the reaction flywheel combination applied to the spacecraft is obtained as follows:
wherein C ∈ R3×LInstalling a matrix for the reaction flywheel assembly;
acting on attitude control moment u of spacecraft according to the law of conservation of angular momentumcIs composed of
Substituting formula (5) into formula (1) to obtain a spacecraft attitude kinematics and dynamics model taking a reaction flywheel combination as an actuating mechanism:
discretizing the spacecraft attitude kinematics and dynamics model, taking a sampling time interval as delta t, and taking the spacecraft attitude kinematics and dynamics model as a prediction model of a model prediction control method, wherein the discretized spacecraft attitude kinematics and dynamics model is as follows:
subscripts k and k +1 represent time k and time k + 1; hkThe total angular momentum of the spacecraft at the moment k;I4×4is a fourth order identity matrix; the superscript x is an oblique antisymmetric matrix;
let xk=(qk,ωk)TThe state quantity of the spacecraft attitude control system at the kth moment represents the attitude and the angular speed of the spacecraft,and (3) simplifying the discretized spacecraft attitude kinematics and dynamics model (7) into the following form for the system control quantity at the kth moment:
definition of
Then
xk+1=F(xk,uk) (10)
Further, the relationship between the output power of the spacecraft-mounted solar array and the solar incident angle, which is established in step S2, is as follows:
wherein, PtotalThe total output power of the m individual solar sailboards on the spacecraft is obtained;the output power of the ith solar panel;the effective area of the ith solar array; thetaiThe solar incident angle represents the included angle between the normal of the ith solar sailboard and sunlight; pEOL(θi) Is the angle of incidence theta of the suniThe specific relation of the function of (b) represents the power per unit area of the ith solar sailboard, and is as follows:
wherein, PsIs incident solar radiation; eta is the photoelectric conversion rate of the solar sailboard; i isdIs an inherent degradation factor of the solar sailboard; l isdIs a solar panel life degradation factor;
however, considering that the solar incident angle is not a fixed value when the spacecraft operates on orbit and changes with the orbit of the spacecraft, the attitude angle of the spacecraft at the current moment and the position of the orbit, in order to obtain the instantaneous available total power of the spacecraft at any position on the orbit, a solar incident angle model is established as follows:
θi=arccos<ni,rsb>,i=1,2,...,m (13)
wherein n isi∈R3,|ni1 is a unit normal vector of the ith solar array in a spacecraft body coordinate system;<·,·>representing an inner product operation; r issb∈R3The projection of the sun unit vector in the spacecraft body coordinate system has the following conversion relationship:
rsb=RbIrsI (14)
wherein r issI=rs/|rs|∈R3Is a position vector r of the sun under the earth center inertial coordinate systems∈R3A unit vector of (a); rbIA transformation matrix from the geocentric inertial coordinate system to the spacecraft body coordinate system is related to the Euler rotation sequence and the attitude Euler angle;
converting the relation between the output power of the spacecraft-mounted solar array and the solar incident angle into an expression related to the attitude angle of the spacecraft:
wherein, Psolar∈RmThe vector of the output power of the body-mounted solar sailboard is output.
Further, the step S3 specifically includes the following steps:
the specific forms of the angular momentum constraint and the control moment constraint of the spacecraft actuating mechanism reaction flywheel are as follows:
1) the angular momentum constraint is expressed in terms of the rotational speed constraint as:
transforming equation (16) into incremental form:
2) the control torque constraint is expressed as:
because the spacecraft attitude control system is in a discrete system form, the following angular acceleration is used for controlling the moment constraintApproximately represents:
3) the actual available power of the reaction flywheel when the body-mounted solar panel fails is restricted:
firstly, the time of the spacecraft entering the ground shadow area is assumed to be negligible, namely, the body-mounted solar sailboard on the spacecraft is approximately considered to be always irradiated by sunlight;
secondly, considering that the output power of the upper body-mounted solar array of the spacecraft needs to be used by an effective load, an actuating mechanism and other subsystems; meanwhile, when the spacecraft runs to different orbit positions, the output power provided by the solar sailboard changes along with the solar incident angle or the attitude angle of the satellite of the spacecraft, and the solar sailboard possibly fails due to a complex space environment, so that the actual power available for an actuating mechanism is limited;
therefore, the expression of the actual power constraint available for the reactive flywheel in the case of a failure of the body-mounted solar panel is as follows:
wherein,instantaneous power vectors which can be provided for all the body-mounted solar sailboards at the moment k; kappa is the power ratio available for the actuator; ek=(e1,e2,…,em) A fault factor sequence of each solar array at the moment k, wherein e is more than or equal to 0i≤1,i=1,2,…,m;For moment k reaction flywheel combinationThe total power required to provide the desired attitude control torque is specified in the form:
wherein,the derivative of the combined angular momentum with respect to time for the moment k reaction flywheel,for the angular acceleration of the reaction flywheel combination at time k, the superscript T indicates transposition,
discretizing the formula (21) to obtain
By substituting formula (22) into formula (20):
and the angular momentum constraint and the control moment constraint of the reaction flywheel and the actual available power constraint of the reaction flywheel when the body-mounted solar array fails are organized into the following forms:
wherein,04L+1represents a 4L + 1-dimensional zero vector; and L is the total number of the reaction flywheels in the reaction flywheel combination.
Further, in the case of reducing the energy consumption as much as possible while satisfying the high control accuracy in the spacecraft attitude control process, the target performance function designed in step S4 is:
wherein, N is the prediction step length, and the subscript j | k represents the j prediction time at the k time; x is the number of0|kPredicting initial state quantity x in step length for spacecraft attitude control system at kth momentj|k=(qj|k,ωj|k)TPredicting the attitude control system state quantity of the spacecraft in the jth step in the step length at the kth moment, and representing the attitude and the angular speed of the spacecraft;is a desired state of the control system;predicting the system control quantity of the jth step in the step length at the kth moment; q and P are constant positive definite weight matrixes of the state quantity and the control quantity.
Further, the step S5 specifically includes the following steps:
based on the prediction model of the model predictive control method established in the step S1, the target performance function designed in the step S4, the angular momentum constraint and the control moment constraint of the reaction flywheel established in the step S3, and the actual available power constraint condition of the reaction flywheel when the body-mounted solar array fails, the spacecraft attitude control problem is converted into the following optimization problem:
subject to xj+1|k=F(xj|k,uj|k) (27)
K(xj|k,uj|k)≤04L+1 (28)
wherein x isj+1|k=F(xj|k,uj|k) The spacecraft attitude control system state equation is obtained; k (x)j|k,uj|k) To compriseThe system comprises angular momentum constraint and control moment constraint of a reaction flywheel and system constraint of actual available power constraint of the reaction flywheel when the body-mounted solar panel fails; the specific form of the state equation and the system constraint of the jth step in the k moment prediction step length of the spacecraft attitude control system is as follows:
solving the optimization problem to obtain an optimal control sequence of the system meeting constraint conditions at the moment k:
wherein the superscript denotes the optimal solution,
taking the first item in the optimal control sequence as the optimal control input quantity of the attitude control system of the spacecraft at the moment k, namely
Finally, letAnd solving the optimal control input quantity of the spacecraft attitude control system at the next moment, and completing the spacecraft attitude control task under the constraint established in the step S3.
The invention has the beneficial effects that:
(1) compared with the existing spacecraft attitude control method considering the characteristics of the reaction flywheel, the method considers the problem that the actual available power of the reaction flywheel is limited when the bulk solar panel fails on the basis of considering the angular momentum saturation and the moment saturation of the reaction flywheel, and more comprehensively analyzes the actual constraint which is possibly met when the reaction flywheel provides attitude control moment for the spacecraft in space;
(2) compared with the existing spacecraft attitude control method with the optimal instantaneous power of the reaction flywheel, the instantaneous optimal power obtained by the existing optimal method is possibly still larger than the maximum available power provided by the solar sailboard when the solar sailboard fails.
(3) The actual available power constraint of the reaction flywheel described in the invention is a dynamic constraint, which is not only related to the possible faults of the solar sailboard, but also closely related to the current orbit position and the current attitude angle of the spacecraft, so that the spacecraft attitude control problem under the dynamic constraint is solved, and the method has more engineering significance.
Drawings
FIG. 1 is a flow chart of a spacecraft attitude control method of the present invention that considers reactive flywheel characteristics and power constraints.
Detailed Description
The present invention will be described in further detail with reference to the accompanying drawings and embodiments.
The spacecraft attitude control method considering the characteristics of the reaction flywheel and the power limitation is based on a model prediction control strategy, and considers the spacecraft attitude control problem under the condition that the angular momentum, the control moment and the power of the reaction flywheel are limited. As shown in fig. 1, the method firstly establishes a spacecraft kinematics and dynamics model in a quaternion description mode; secondly, establishing a relation between the output power of the spacecraft body-mounted solar array and the solar incident angle; then, considering the characteristics of the reaction flywheel to establish angular momentum constraint and control moment constraint, and establishing the actual available power constraint of the reaction flywheel when the three-dimensional assembled solar array fails according to the relation between the output power of the spacecraft assembled solar array and the solar incident angle; then designing a target performance function to ensure that the spacecraft can meet high-precision control in the attitude maneuver process and reduce energy consumption as much as possible; and finally, solving the optimal control moment based on a model predictive control strategy, thereby completing the spacecraft attitude control task under the constraint condition.
The specific operation steps are as follows:
firstly, establishing a spacecraft attitude kinematics and dynamics model in a quaternion description mode as follows:
wherein J ═ diag (1, 0.5, 0.8) kg · m2∈R3×3Is a spacecraft inertia matrix; ω ═ ω (ω)1,ω2,ω3)TThe three-axis angular velocity of the spacecraft body; h is belonged to R3The total angular momentum of the spacecraft is H ═ J omega + HRWAAnd H isRWA∈R3Combining the projection of the angular momentum on the main axis of the inertia of the spacecraft for the reaction flywheel; u. ofc∈R3In order to act on the attitude control moment of the spacecraft, the attitude control moment is provided by a reaction flywheel combination; q ═ q0,q1,q2,q3)TIs a quaternion for describing the attitude of the spacecraft and satisfiesXi (ω) is a skew antisymmetric matrix of specific form:
for any vector x ∈ R3Its corresponding oblique antisymmetric array x×The form is as follows:
if the influence of the orbital angular velocity of the spacecraft on the angular momentum of the flywheel is neglected, a counteractive flywheel combined dynamic model is given:
wherein, tauRWA∈RLIs the control moment generated by the L reaction flywheels; h isRWA∈RLIn order to counteract the angular momentum of the flywheel assembly,combining derivatives of angular momentum with respect to time for the reaction flywheel; j. the design is a squareRWA∈RL×LA matrix of moments of inertia in the form of a reaction flywheel assemblyThe moment of inertia of each reaction flywheel;the rotational speed of each reaction flywheel. In this embodiment, the number of flywheels L is 4, and the reaction flywheel combination is configured as a three-orthogonal one-slant assembly.
According to the dynamic model of the reaction flywheel combination and the reaction flywheel combination configuration, the attitude control moment applied to the spacecraft by the reaction flywheel combination is as follows:
wherein C ∈ R3×4A matrix is assembled and installed for the reaction flywheel, and the concrete form is as follows;
according to the law of conservation of angular momentum, the total angular momentum of the spacecraft system is conserved under the action of no external moment, so that the attitude control moment acting on the spacecraft is
Substituting the attitude control torque provided by the reaction flywheel into the spacecraft attitude dynamics model can obtain a spacecraft attitude kinematics and dynamics model which takes the reaction flywheel combination as an actuating mechanism:
in order to use the above-described kinetic model as a prediction model of the model prediction control method, it is necessary to discretize the model, and when the sampling time interval Δ t is 0.4s, the discretized kinetic model is:
subscripts k and k +1 represent time k and time k + 1; hkThe total angular momentum of the spacecraft at the moment k;I4×4is a fourth order identity matrix; the superscript x is a skewed antisymmetric matrix.
Let xk=(qk,ωk)TThe state quantity of the spacecraft attitude control system at the kth moment represents the attitude and the angular speed of the spacecraft,for the system control quantity at the kth moment, the discrete dynamic model can be simplified into the following form:
if defined, are
Then there is
xk+1=F(xk,uk) (10)
Secondly, establishing the relation between the output power of the spacecraft body-mounted solar array and the solar incident angle:
wherein, PtotalThe method comprises the following steps of providing the total output power of m individual solar sailboards on a spacecraft, providing energy for the spacecraft to complete tasks such as scientific detection, attitude control and the like, wherein m is 4;the output power of the ith solar panel;the effective area of the ith solar array; thetaiThe solar incident angle represents the included angle between the normal of the ith solar sailboard and sunlight; pEOL(θi) Is the angle of incidence theta of the suniThe specific relation of the function of (b) represents the power per unit area of the ith solar sailboard, and is as follows:
wherein, Ps=1358W/m2Is incident solar radiation; eta is 0.14, which is the photoelectric conversion rate of the solar sailboard; i isd0.77 is the inherent degradation factor of the solar sailboard; l isd0.625 is the solar panel life degradation factor.
However, considering that the solar incident angle is not a fixed value when the spacecraft operates on orbit and changes with the orbit of the spacecraft, the attitude angle of the spacecraft at the current moment and the position of the orbit, in order to obtain the instantaneous available total power of the spacecraft at any position on the orbit, a solar incident angle model is established as follows:
θi=arccos<ni,rsb>,i=1,2,...,m (13)
wherein n isi∈R3,|ni1 is a unit normal vector of the ith solar array in a spacecraft body coordinate system;<·,·>representing an inner product operation; r issb∈R3The projection of the sun unit vector in the spacecraft body coordinate system has the following conversion relation:
rsb=RbIrsI (14)
wherein r issI=rs/|rs|∈R3Is a position vector r of the sun under the earth center inertial coordinate systems∈R3A unit vector of (a); rbIA transformation matrix from the geocentric inertial coordinate system to the spacecraft body coordinate system is related to the Euler rotation sequence and the attitude Euler angle;
converting the relation between the output power of the spacecraft-mounted solar array and the solar incident angle into an expression related to the attitude angle of the spacecraft:
wherein, Psolar∈RmThe vector of the output power of the body-mounted solar sailboard is output.
If the Euler rotation sequence is 2-3-1, the transformation matrix R from the geocentric inertial coordinate system to the spacecraft body coordinate systembIThe form of (A) is as follows:
wherein R isx(γ) is a primitive transformation matrix that rotates through a roll angle γ around the ox axis; ry(ψ) is a primitive transformation matrix that rotates through the yaw angle ψ about the oy axis;for turning over pitch angle about oz axisThe primitive transformation matrix of (2); the three primitive transformation matrices are of the form:
unfolding to obtain:
at this time, the relational expression (15) of the output power of the spacecraft-mounted solar panel and the solar incident angle can be converted into an expression related to the attitude angle of the spacecraft:
wherein the amount of the component phi, psi,gamma represents the Euler angles of the yaw, pitch and roll attitudes of the spacecraft respectively.
And thirdly, based on the relation between the output power of the body-mounted solar array of the spacecraft and the attitude angle of the spacecraft in the second step, further considering the characteristic of a reaction flywheel of an actuating mechanism of the spacecraft, and establishing angular momentum constraint, control moment constraint and actual available power constraint of the reaction flywheel when the body-mounted solar array fails:
because the reaction flywheel belongs to a mechanical structure, angular momentum constraint and control moment constraint exist, and the specific form is as follows:
1) and (3) angular momentum constraint: the angular momentum of the reaction flywheel is reflected in the flywheel speed, and the angular momentum constraint can be expressed in terms of a speed constraint, i.e. the angular momentum constraint is expressed in terms of the flywheel speed
Transforming the above into incremental form:
2) controlling torque constraint:
Because the spacecraft attitude control system is in a discrete system form, the control moment constraint can be realized by the following angular accelerationApproximately represents:
3) the actual available power of the reaction flywheel when the body-mounted solar panel fails is restricted:
firstly, the time of the spacecraft entering the ground shadow area is assumed to be negligible, namely, the body-mounted solar sailboard on the spacecraft is approximately considered to be always irradiated by sunlight;
secondly, considering that the output power of the upper body-mounted solar array of the spacecraft needs to be used by an effective load, an actuating mechanism and other subsystems; meanwhile, when the spacecraft runs to different orbit positions, the output power provided by the solar sailboard changes along with the solar incident angle or the spacecraft attitude angle, and the solar sailboard possibly fails due to a complex space environment, so that the actual power available for an actuating mechanism is limited;
therefore, the expression of the actual power constraint available for the reactive flywheel combination in the case of a failure of the body-mounted solar panel is as follows:
wherein,the yaw angle phi at the moment k is used as the instantaneous power vector which can be provided by each body-mounted solar array at the moment kkAnd a pitch angleAnd roll angle gammakThe instantaneous power vector which can be provided by each body-mounted solar array of the spacecraft at the current k moment and the current attitude can be obtained by specific substitutionThe concrete form is shown as a formula (15-3); kappa is the power ratio available for the actuator; ek=(e1,e2,…,em) A fault factor sequence of each solar array at the moment k, wherein e is more than or equal to 0i≤1,i=1,2,...,m;The total power required for generating the expected attitude control torque for the reaction flywheel combination at the moment k is specifically as follows:
wherein,the derivative of the combined angular momentum with respect to time for the moment k reaction flywheel,for the angular acceleration of the reaction flywheel combination at time k, the superscript T indicates transposition,
discretizing the above formula to obtain the product
The actual power constraint for the combination of the reaction flywheel when the assembled solar panel fails after the arrangement is as follows:
wherein the Euler angle psik,γkAnd quaternion qkThere is a mutual conversion relationship between them, so the above formula can be expressed as:
according to the above definitionRestrain the angular momentum of the reaction flywheel,The control moment constraint and the actual power constraint which can be used by the combination of the reaction flywheel when the body-mounted solar panel has a fault are organized into the following forms:
wherein, 04L+1Represents a 4L + 1-dimensional zero vector; and L is 4, which is the total number of the reaction flywheels in the reaction flywheel combination.
Fourthly, considering that the energy consumption is reduced as much as possible while meeting high control precision in the spacecraft attitude control process, the target performance function in the design step S4 is:
where N ═ 5 is the prediction step size, and the subscript j | k denotes the j-th prediction time at the k-th time; x is the number of0|kPredicting initial state quantity x in step length for spacecraft attitude control system at kth momentj|k=(qj|k,ωj|k)TPredicting the attitude control system state quantity of the spacecraft in the jth step in the step length at the kth moment, and representing the attitude and the angular speed of the spacecraft;the form of the control system is determined by the specific task in order to control the desired state of the system;predicting the system control quantity of the jth step in the step length at the kth moment; q is 0.7I7×7,P=0.3I4×4The weighting matrix is positively determined for the constant values of the state quantities and the control quantities.
And fifthly, based on the constraint conditions in the third step and the target performance function designed in the fourth step, completing the constrained spacecraft attitude control task based on the model prediction control strategy:
from the discretized dynamical model, the objective performance function and the constraint conditions, the control problem can be converted into the following optimization problem:
subject to xj+1|k=F(xj|k,uj|k) (27)
K(xj|k,uj|k)≤04L+1 (28)
wherein x isj+1|k=F(xj|k,uj|k) The spacecraft attitude control system state equation is obtained; k (x)j|k,uj|k) The method comprises the following steps of performing system constraint, wherein the system constraint comprises reaction flywheel angular momentum constraint, control moment constraint and actual available power constraint of a reaction flywheel when a body-mounted solar array fails; the specific form of the state equation and the system constraint of the jth step in the k moment prediction step length of the spacecraft attitude control system is as follows:
solving the optimization problem can obtain an optimal control sequence of the system meeting the constraint condition at the moment k:
taking the first item in the optimal control sequence as the optimal control input quantity of the attitude control system of the spacecraft at the moment k, namely
Finally, letAnd solving the optimal control input quantity of the spacecraft attitude control system at the next moment, thus finishing the constrained spacecraft attitude control task.
Those skilled in the art will appreciate that the invention may be practiced without these specific details.
Claims (4)
1. A spacecraft attitude control method considering the characteristics and power limitation of a reaction flywheel is characterized by comprising the following steps:
s1: aiming at the problem of spacecraft attitude control, establishing a spacecraft attitude kinematics and dynamics model in a quaternion description mode, discretizing the spacecraft attitude kinematics and dynamics model, and establishing a prediction model of a model prediction control method;
s2: establishing a relation between output power of the spacecraft body-mounted solar array and a solar incident angle, and converting the relation into an expression related to a spacecraft attitude angle;
s3: based on the characteristics of a reaction flywheel of a spacecraft actuating mechanism, establishing angular momentum constraint and control moment constraint of the reaction flywheel, and simultaneously establishing actual available power constraint of the reaction flywheel when the spacecraft-mounted solar panel fails;
s4: designing a target performance function according to task requirements;
s5: based on the prediction model of the model prediction control method established in the step S1, completing the spacecraft attitude control task under the constraint established in the step S3;
the spacecraft attitude kinematics and dynamics model in the quaternion description mode in step S1 is as follows:
wherein J ∈ R3×3Is a spacecraft inertia matrix, R3×3Representing a set of 3 x 3 matrices; ω ═ ω (ω)1,ω2,ω3)TThe three-axis angular velocity of the spacecraft body; h is belonged to R3Is the total angular momentum of the spacecraft, R3Represents a 3-dimensional real vector space, which is embodied in the form of H ═ J ω + HRWA,HRWA∈R3Combining the projection of the angular momentum on the main axis of the inertia of the spacecraft for the reaction flywheel; u. ofc∈R3Controlling moment for the attitude of the spacecraft; q ═ q0,q1,q2,q3)TIs a quaternion for describing the attitude of the spacecraft and satisfiesXi (ω) is a skew antisymmetric matrix of specific form:
for any vector x ∈ R3Its corresponding oblique antisymmetric array x×The form is as follows:
when the influence of the orbital angular velocity of the spacecraft on the angular momentum of the reaction flywheel is neglected, the dynamic model of the reaction flywheel combination is as follows:
wherein, tauRWA∈RLFor control torque produced by L reaction flywheels, RLRepresenting an L-dimensional real vector space; h isRWA∈RLIn order to counteract the angular momentum of the flywheel assembly,combining derivatives of angular momentum with respect to time for the reaction flywheel; j. the design is a squareRWA∈RL×LIs a matrix of moments of inertia of the counteracting flywheel combination,in the form ofFor the moment of inertia of each reaction flywheel, RL×LRepresenting a set of L × L matrices;for the rotational speed of the respective reaction flywheel,a derivative with respect to time for each reaction flywheel rotational speed;
based on a dynamic model of the reaction flywheel combination and a reaction flywheel combination configuration, the attitude control moment of the reaction flywheel combination applied to the spacecraft is obtained as follows:
wherein C ∈ R3×LMounting matrices, R, for reaction flywheel combinations3×LRepresenting a 3 × L matrix set;
acting on attitude control moment u of spacecraft according to the law of conservation of angular momentumcIs composed of
Substituting formula (5) into formula (1) to obtain a spacecraft attitude kinematics and dynamics model taking a reaction flywheel combination as an actuating mechanism:
discretizing the spacecraft attitude kinematics and dynamics model, taking a sampling time interval as delta t, and taking the spacecraft attitude kinematics and dynamics model as a prediction model of a model prediction control method, wherein the discretized spacecraft attitude kinematics and dynamics model is as follows:
subscripts k and k +1 respectively represent the k time and the k +1 time; hkThe total angular momentum of the spacecraft at the moment k;I4×4is a fourth order identity matrix; the superscript x is an oblique antisymmetric matrix;
let xk=(qk,ωk)TThe state quantity of the spacecraft attitude control system at the kth moment represents the attitude and the angular speed of the spacecraft,and (3) simplifying the discretized spacecraft attitude kinematics and dynamics model (7) into the following form for the system control quantity at the kth moment:
definition of
Then
xk+1=F(xk,uk) (10);
The relationship between the output power of the spacecraft-mounted solar array and the solar incident angle, which is established in the step S2, is as follows:
wherein, PtotalThe total output power of the m individual solar sailboards on the spacecraft is obtained;the output power of the ith solar panel;the effective area of the ith solar array; thetaiThe solar incident angle represents the included angle between the normal of the ith solar sailboard and sunlight; pEOL(θi) Is the angle of incidence theta of the suniThe specific relation of the function of (b) represents the power per unit area of the ith solar sailboard, and is as follows:
wherein, PsIs incident solar radiation; eta is the photoelectric conversion rate of the solar sailboard; i isdIs an inherent degradation factor of the solar sailboard; l isdIs a solar panel life degradation factor;
the solar incident angle changes with the orbit of the spacecraft, the attitude angle of the spacecraft at the current moment and the position of the orbit, and in order to obtain the instantaneous available total power of the spacecraft at any position on the orbit, a solar incident angle model is established as follows:
θi=arccos<ni,rsb>,i=1,2,...,m (13)
wherein n isi∈R3,|ni1 is a unit normal vector of the ith solar array in a spacecraft body coordinate system;<·,·>representing an inner product operation; r issb∈R3The projection of the sun unit vector in the spacecraft body coordinate system has the following conversion relationship:
rsb=RbIrsI (14)
wherein r issI=rs/|rs|∈R3Is a position vector r of the sun under the earth center inertial coordinate systems∈R3A unit vector of (a); rbIA transformation matrix from the geocentric inertial coordinate system to the spacecraft body coordinate system is related to the Euler rotation sequence and the attitude Euler angle;
converting the relation between the output power of the spacecraft-mounted solar array and the solar incident angle into an expression related to the attitude angle of the spacecraft:
wherein, Psolar∈RmFor the output power vector, R, of the body-mounted solar panelmRepresenting an m-dimensional real vector space.
2. The method according to claim 1, wherein step S3 is implemented as follows:
the specific forms of the angular momentum constraint and the control moment constraint of the spacecraft actuating mechanism reaction flywheel are as follows:
1) the angular momentum constraint is expressed in terms of the rotational speed constraint as:
transforming equation (16) into incremental form:
2) the control torque constraint is expressed as:
because the spacecraft attitude control system is in a discrete system form, the following angular acceleration is used for controlling the moment constraintApproximately represents:
3) the actual available power of the reaction flywheel when the body-mounted solar panel fails is restricted:
under the condition that the body-mounted solar array on the spacecraft is always irradiated by sunlight, the actual power constraint expression of the reactive flywheel when the body-mounted solar array fails is as follows:
wherein,instantaneous power vectors which can be provided for all the body-mounted solar sailboards at the moment k; kappa is the power ratio available for the actuator; ek=(e1,e2,…,em) A fault factor sequence of each solar array at the moment k, wherein e is more than or equal to 0i≤1,i=1,2,…,m;For moment-k reaction flywheel combinationThe total power required to expect the attitude control moment is specifically formed as follows:
wherein,the derivative of the combined angular momentum with respect to time for the moment k reaction flywheel,for the angular acceleration of the reaction flywheel combination at time k, the superscript T indicates transposition,
discretizing the formula (21) to obtain
By substituting formula (22) into formula (20):
and the angular momentum constraint and the control moment constraint of the reaction flywheel and the actual available power constraint of the reaction flywheel when the body-mounted solar array fails are organized into the following forms:
3. The method according to claim 2, wherein the target performance function designed in step S4 is, in the spacecraft attitude control process, as much as possible while satisfying high control accuracy, the following:
wherein, N is the prediction step length, and the subscript j | k represents the j prediction time at the k time; x is the number of0|kPredicting initial state quantity x in step length for spacecraft attitude control system at kth momentj|k=(qj|k,ωj|k)TPredicting the attitude control system state quantity of the spacecraft in the jth step in the step length at the kth moment, and representing the attitude and the angular speed of the spacecraft;is a desired state of the control system;predicting the system control quantity of the jth step in the step length at the kth moment; q and P are constant positive definite weight matrixes of the state quantity and the control quantity.
4. The method according to claim 3, wherein step S5 is implemented as follows:
based on the prediction model of the model predictive control method established in the step S1, the target performance function designed in the step S4, the angular momentum constraint and the control moment constraint of the reaction flywheel established in the step S3, and the actual available power constraint condition of the reaction flywheel when the body-mounted solar array fails, the spacecraft attitude control problem is converted into the following optimization problem:
satisfies the following conditions:
xj+1|k=F(xj|k,uj|k) (27)
K(xj|k,uj|k)≤04L+1 (28)
wherein x isj+1|k=F(xj|k,uj|k) The spacecraft attitude control system state equation is obtained; k (x)j|k,uj|k) The system constraint comprises angular momentum constraint and control moment constraint of a reaction flywheel and actual available power constraint of the reaction flywheel when the body-mounted solar sailboard fails; the specific form of the state equation and the system constraint of the jth step in the k moment prediction step length of the spacecraft attitude control system is as follows:
solving the optimization problem to obtain an optimal control sequence of the system meeting constraint conditions at the moment k:
wherein the superscript denotes the optimal solution,
taking the first item in the optimal control sequence as the optimal control input quantity of the attitude control system of the spacecraft at the moment k, namely
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910707553.3A CN110502025B (en) | 2019-08-01 | 2019-08-01 | Spacecraft attitude control method considering reactive flywheel characteristics and power limitation |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910707553.3A CN110502025B (en) | 2019-08-01 | 2019-08-01 | Spacecraft attitude control method considering reactive flywheel characteristics and power limitation |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110502025A CN110502025A (en) | 2019-11-26 |
CN110502025B true CN110502025B (en) | 2020-11-10 |
Family
ID=68587069
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910707553.3A Active CN110502025B (en) | 2019-08-01 | 2019-08-01 | Spacecraft attitude control method considering reactive flywheel characteristics and power limitation |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110502025B (en) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111633656B (en) * | 2020-06-08 | 2022-11-11 | 西北工业大学 | Distributed energy balancing method for cooperative operation of multiple space robots |
CN113625554B (en) * | 2021-06-28 | 2023-06-30 | 北京控制工程研究所 | Method and system for optimizing configuration of reaction wheel in consideration of fault condition |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9764858B2 (en) * | 2015-01-07 | 2017-09-19 | Mitsubishi Electric Research Laboratories, Inc. | Model predictive control of spacecraft |
CN104898686B (en) * | 2015-06-02 | 2016-04-27 | 北京航空航天大学 | A kind of anti-interference attitude control method based on reaction wheel rubbing characteristics |
CN105786008B (en) * | 2016-03-31 | 2017-09-22 | 北京航空航天大学 | A kind of Flexible Spacecraft control method for being directed to flywheel saturation and frictional behavior |
CN108536014B (en) * | 2018-04-04 | 2020-02-21 | 北京航空航天大学 | Model prediction control method for spacecraft attitude avoidance considering dynamic characteristics of flywheel |
CN108983801B (en) * | 2018-08-14 | 2021-05-28 | 北京航空航天大学 | Anti-interference attitude control method for spacecraft based on dynamic characteristics of reaction flywheel |
CN109164822B (en) * | 2018-09-26 | 2020-02-21 | 北京航空航天大学 | Spacecraft attitude control method based on hybrid actuating mechanism |
CN109164824B (en) * | 2018-10-25 | 2020-04-21 | 北京航空航天大学 | Spacecraft attitude control method considering uncertainty of flywheel |
CN109782787B (en) * | 2019-03-08 | 2020-10-30 | 北京航空航天大学 | Dual-mode MPC control method for attitude of under-actuated spacecraft under assistance of sunlight pressure |
-
2019
- 2019-08-01 CN CN201910707553.3A patent/CN110502025B/en active Active
Also Published As
Publication number | Publication date |
---|---|
CN110502025A (en) | 2019-11-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106292681B (en) | A kind of satellite Active Fault-tolerant Control Method distributed based on observer and On-line Control | |
CN104527994B (en) | Multi-polar cross-over becomes the track set time soon and holds position sensing tracking and controlling method | |
Bayat | Model predictive sliding control for finite-time three-axis spacecraft attitude tracking | |
Show et al. | An LMI-based nonlinear attitude control approach | |
Hu et al. | Disturbance observer based finite-time attitude control for rigid spacecraft under input saturation | |
Qinglei et al. | Adaptive integral-type sliding mode control for spacecraft attitude maneuvering under actuator stuck failures | |
CN106020221B (en) | A kind of anti-interference gesture stability verification platform and verification method based on output feedback | |
Zhang et al. | Extended state observer based robust adaptive control on SE (3) for coupled spacecraft tracking maneuver with actuator saturation and misalignment | |
CN110844122B (en) | Satellite attitude control method for restraining attitude tracking error | |
CN104267732B (en) | Flexible satellite high stability attitude control method based on frequency-domain analysis | |
CN109164822B (en) | Spacecraft attitude control method based on hybrid actuating mechanism | |
CN106896821B (en) | A kind of angular momentum management method of variable speed control moment gyro | |
CN108227728B (en) | Spacecraft attitude dynamic control distribution method considering hybrid actuating mechanism switching | |
CN105867401A (en) | Spacecraft posture fault tolerance control method of single gimbal control moment gyroscope groups | |
CN109782787B (en) | Dual-mode MPC control method for attitude of under-actuated spacecraft under assistance of sunlight pressure | |
Li et al. | Adaptive quantized sliding mode attitude tracking control for flexible spacecraft with input dead-zone via Takagi-Sugeno fuzzy approach | |
CN110502025B (en) | Spacecraft attitude control method considering reactive flywheel characteristics and power limitation | |
CN111338368B (en) | Self-adaptive robust control method for spacecraft rapid maneuver attitude tracking | |
Zhang et al. | Active vibration suppression for flexible satellites using a novel component synthesis method | |
CN113619814A (en) | Method for controlling relative attitude and orbit coupling of final approach section of rendezvous and docking | |
CN105867406B (en) | A kind of assembly spacecraft closed-loop Feedback Optimal Control distribution method | |
Lang et al. | Non-cooperative differential game based output feedback control for spacecraft attitude regulation | |
CN110119153B (en) | Under-actuated spacecraft attitude control method under active assistance of light pressure moment | |
CN108891625B (en) | Combined control method for solid micro-propeller array and magnetic torquer | |
Yang et al. | Fault tolerant pi control design for satellite attitude systems with actuator fault |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |