US 5,996,941 AGrant
Method for Controlling the Attitude of a Three-Axis Stabilized, Earth Oriented Bias Momentum Spacecraft
Issue Date:1999-12-07
•3 Claims
•5 Drawing Sheets
Abstract
An attitude controller for a 3-axis stabilized, Earth oriented bias momentum spacecraft is described, where only 2-axis attitude measurements from the Earth sensor are available. In contrast to the classical spacecrafts that are controlled w.r.t. a fixed orbital Earth pointing reference frame, (possibly large angle) time varying reference signals are considered here, i.e. the control task consists of a tracking problem. The controller design consists of a decoupling controller and axis-related PID controllers based on yaw observer estimates.
Metadata
Assignee
- Daimler-Benz Aerospace AG
Inventors
- Michael Surauer
- Walter Fichter
- Peter Zentgraf
Application Information
Application Number:US 8774676
Filing Date:1997-06-17
Priority Date:1995-08-11
Art Unit:361
Classifications
IPC:
B64G 128
Field of Search:
244701158 R;164;16513
Patent Drawings (5 sheets)
Description
The invention is related to a method and apparatus for controlling the attitude of a three-axis stabilized, earth oriented bias momentum spacecraft.
BACKGROUND AND SUMMARY OF THE INVENTION
Earth oriented three axis stabilized satellites have generally no continuous yaw attitude information available or even no yaw measurement at all. This is true especially for commercial communication satellites which have to be designed under stringent economic conditions. The common approach to achieve 3-axis stabilization with a 2-axis attitude sensor only (Earth sensor) is to establish a bias momentum perpendicular to the orbit plane which leads to observability of the yaw motion by the roll measurement. An early publication in this field is e.g. [DoSR68], which is well-known as the "Whecon"-principle.
The invention provides a control design approach for a generalized Earth pointing control mode with 2-axis Earth sensor measurements only and bias momentum coupling, where time varying attitude reference signals with respect to an Earth pointing reference frame are considered. This means, the control method according to the invention addresses a tracking problem in addition to a disturbance rejection problem. A possible control task is shown in FIG. 1. The desired spacecraft attitude, here a roll-bias angle .alpha. and zero pitch- and yaw angles, can be expressed as a time varying reference attitude with respect to the orbital Earth pointing reference frame (x.sub.a y.sub.a z.sub.o). Furthermore, roll-tracking is necessary in case of inclined orbit operations of geosynchronous satellites, where proper Earth orientation for antenna pointing purposes has to be maintained.
Another example is small satellites in low Earth orbits, that use--besides the solar array rotation--one degree of freedom around the satellite yaw axis for the optimal orientation of the solar panels, i.e. to assure that the sun vector is always (nearly) perpendicular to the panel surface.
The subsequent explanations cover as far as possible a general case. Examples are given for the above mentioned application of roll tracking operations.
The minimum sensor and actuator hardware configuration which is necessary for the realization of this attitude control approach consists of the following components:
a.) A set of wheels that span the 3-dimensional space, i.e. practically linear actuators which produce torques around the 3 spacecraft axes. Usually 4 wheels are used for redundancy.
b.) An Earth sensor that delivers a 2-axis attitude information around the roll- and pitch axis.
Additionally, an actual spacecraft has to be equipped with actuators for angular momentum control, such as magnetic torquers, thrusters, and/or solar array drives for solar torque compensation, depending on the spacecraft mission.
BRIEF DESCRIPTION OF THE DRAWINGS
FIG. 1 is a schematic representation of a spacecraft orbit and reference system used for explaining the control method according to the invention;
FIG. 2 is a graphic depiction of a roll reference .alpha. and the controlled roll attitude .phi.;
FIG. 3 is a graphic depiction of the time variation of attitude control errors in roll, pitch and yaw;
FIG. 4 shows wheel angular momentum as a function of time during a roll tracking maneuver;
FIG. 5 shows the yaw transient behavior of a geostationary satellite as a function of time;
FIG. 6 is a block diagram which illustrates the control process according to the invention; and
FIG. 7 shows the structure of a yaw observer utilized according to the invention.
DETAILED DESCRIPTION OF THE DRAWINGS
Spacecraft Dynamics and Kinematics
Transformations between Involved Coordinate Systems
Transformation from orbit system to reference system. The spacecraft is rotated from the orbit system by time-varying bias Euler-angles .gamma.(t) about the yaw-axis, .beta.(t) about the pitch-axis and .alpha.(t) about the roll-axis with corresponding transformation matrices T.sub..alpha., T.sub..beta., T.sub..gamma. : ##EQU1## Applying the rotation in this order yields the transformation matrix from orbit to reference system ##EQU2## with column vectors
Transformation from reference system to body system. The satellite is deviated from its reference attitude by the Euler-angles .PHI.=[.phi. .THETA. .psi.].sup.T, which the controller tries to suppress in the presence of disturbances. For small Euler-angles the transformation matrix from reference system to body system can be linearized to give
Kinematics
The dynamic behaviour of the spacecraft has to be described in terms of Euler-angles. Therefore, the body angular velocity and the body angular acceleration appearing in the angular momentum equation need to be expressed by the Euler-angles. The absolute body angular velocity of the spacecraft .omega. expressed in body system can be split into three parts:
where .omega..sub.0 is the orbit angular velocity of the orbit system relative to the inertial system, .omega..sub.R is the reference angular velocity of the reference system relative to the orbit system and .omega. describes the body angular velocity relative to the reference system.
Orbit angular velocity .PHI..sub.0. The orbit angular velocity expressed in the reference system is .omega..sub.0.sup.R =[0-.omega..sub.0 0].sup.T and can be expressed in the body system applying two subsequent transformations:
Reference angular velocity .omega..sub.R. Defining the vectors ##EQU3## .omega..sub.R can be written as
with
Expressing the Euler Equation in Terms of Measured Roll and Pitch Angles
The well known Euler equation describing the behaviour of a rigid body tumbling alone in space [J. Wittenburg, Dynamics of Systems of Rigid Bodies. Teubner Verlag, Stuttgart, 1977] is
where the variables in eq. (2.9) have the following meaning:
I--inertia matrix w.r.t. principle axes
h--angular momentum of wheels
T.sub.C --external control torque
T.sub.D --external disturbance torque.
Hereinbelow a control law is developed which linearizes the Euler equation. However, it is assumed, that only roll- and pitch-angles are known by measurement. Because these signals will be used for the control law the Euler equation (2.10) is rewritten in terms of the new measurement vector .PHI..sub.M =[.phi..THETA.0].sup.T. Therefore, the spacecraft angular velocity vector .omega. in eq. (2.5) is only partially known and it is replaced by .omega..sub.M.
The measured part of the orbit angular velocity .omega..sub.DM is obtained by replacing .PHI. in eq. (2.6) by .PHI..sub.M :
Defining the vector .psi.=[0 0 .psi.].sup.T, adding of
recovers .omega..sub.0. Similarly, .omega..sub.RM is obtained by replacing .PHI. in eq. (2.8) by .PHI..sub.M.
and adding of
recovers .omega..sub.R.
The spacecraft angular velocity vector .omega. can be written as
with
yielding the spacecraft angular acceleration
The measured spacecraft angular acceleration .omega..sub.M is further split into
with
because the signal .omega..sub.CM rather than .omega..sub.M is decoupled in order to leave terms of .phi. and .theta. in the system equation. Before eqs. (2.16, 2.18, 2.19) are inserted into Euler equation (2.10), the second term in eq. (2.10) is simplified: Inserting eq. (2.16) in this term gives ##EQU4##
Inserting eqs. (2.16, 2.18, 2.19, 2.21) in eq. (2.10) gives after rearranging terms ##EQU5##
Decoupling and Tracking Control
Herein a wheel control torque is developed to satisfy two design objects: First, to decouple yaw-dynamic from roll- and pitch-dynamic and second, to enable tracking of arbitrary bias angles .alpha.(t), .beta.(t) and .gamma.(t). The wheel torque is decomposed in
where h.sub.D is the decoupling and h.sub.C is the tracking control part.
Decoupling Control Law
In the reformulated Euler equation (2.22) the measurable terms except the term "I.PHI..sub.M " are put into -h.sub.D, i.e.
Inserting eq. (3.2) in eq. (2.22) results in the decoupled system equation ##EQU6##
Because of eq. (2.19) the matrices in brackets in eq. (3.3) still contain Euler-angles .phi. and .theta.. Here, they can be neglected, because they are subsequently multiplied with .psi.and .psi., respectively, resulting in "small" products which can be neglected. It remains only a one-way-directed coupling between roll/pitch-dynamics and roll-dynamics: yaw couples in roll/pitch but not vice versa.
Tracking Control and Yaw Estimation
Equation (3.3) that describes the already partially decoupled plant dynamics with respect to the reference attitude will now be divided into two subsystems according to the roll/pitch motion and the yaw motion. Remembering that the first two components of .psi. are zero, eq. (3.3) can formally be rewritten as ##EQU7##
where c.sub.1 (t), d.sub.1 (t) are (2.times.1) vectors, c.sub.2 (t), d.sub.2 (t) are scalars; the "*"-superscript indicates, that the torques on the right side of eqs. (3.4, 3.5) are normalized with respect to the diagonal elements of I. For a property established bias momentum along the orbit normal, evaluation of these coefficients shows the following properties:
(i.) d.sub.2 (t) and .vertline.c.sub.1 (t).vertline. have a dominating bias. This means that at least one component of c.sub.1 (t) is relatively large. Comparison: For an Earth pointing geostationary satellite is c.sub.1 =[h.sub.y 0].sup.T and d.sub.2 =.omega..sub.o h.sub.y.
(ii.) .vertline.d.sub.t (t).vertline. is relatively small. For the geostationary case is d.sub.1 =[0 0 ].sup.T.
(iii.) c.sub.2 (t)=0. This reflects the fact that a bias momentum satellite is a gyroscopic system, i.e. there is no dissipative damping.
Eqs. (3.4, 3.5) demonstrate that yaw-dynamic couples in roll/pitch-dynamic but not vice versa.
Axis related controllers. The roll/pitch subsystem is controlled by a standard PID control law ##EQU8## using the measurements of the Earth sensor. Roll and pitch angle derivatives are obtained by numerical differentiation (filtering). K.sub.p, K.sub.D, K.sub.I are diagonal (2.times.2) gain matrices. Remember that .phi. and .theta. are the deviations from the time varying reference attitude system.
The yaw-axis is controlled by a PD control law
where k.sub.D, k.sub.P are scalar gains and .psi., .psi. are estimates of the yaw state w.r.t. the reference yaw attitude. They are provided by the yaw observer which is discussed subsequently.
Yaw observer. Basically, the yaw state estimates are obtained by a reduced order observer. Although there are standard design procedures--at least for time invariant systems--the subsequent explanations are based on an "engineering approach" rather than a strict mathematical approach, because it considers a feel for the physics of bias momentum satellites and it is very similar for both cases, time-varying and -invariant reference attitude.
For simplicity T.sub.C T.sub.D, and K.sub.I are assumed to be zero for the time being. With properties (i.), (ii.), and eq. (3.6), eq. (3.4) can be rewritten as ##EQU9## Then Laplace transformation of eq. (3.8) for a particular time instant t.sub.0 yields ##EQU10## i.e. (.phi..theta.) can be regarded as a (delayed) measurement of .psi., scaled by c.sub.1 (t). In order to obtain a pseudo-measurement .psi..sub.m, eq. (3.9) is multiplied by a vector w=[w.sub.1 w.sub.2 ].sup.T leading to ##EQU11##
The vector w can be chosen in such a way, that the steady state transfer function in eq. (3.10) from .psi. to .psi..sub.m equals one, i.e. ##EQU12##
Because of property (i.) and the diagonality-property of K.sub.P the numerator in eq. (3.11) is nonzero, and in all cases a vector w can be computed according to eq. (3.11).
Another possibility to generate .psi..sub.m is to switch between the first and second row of eqs. (3.9) and (3.10), respectively, depending on the components of c.sub.I. In this case the corresponding components of w have to be zero.
If the second derivative of [.phi..theta.].sup.T in eq. (3.8) is neglected, then even an unfiltered pseudo-measurement .psi..sub.m is availabe, because the roll and pitch angles and its derivatives are known. Experience shows, that this is possible for many applications.
Now .psi..sub.m can be used to design a standard observer for the yaw angle .psi. based on the plant model eq. (3.5), which is decoupled from the roll/pitch subsystem. Observability can be verified using property (i.).
In case of nonzero external torques T.sub.C, T.sub.D, the known contributions can be considered in eq. (3.10), the unknown contributions result in errors of the pseudo-measurement .psi..sub.m. For nonzero K.sub.I, the integrals of the roll- and pitch angle have to be used for measurement purposes instead of the attitude angles.
Stability Analysis. Due to the periodic variation of the parameters of the plant dynamics (3.4), (3.5), the closed loop stability analysis can be performed by means of Floquet theory. See e.g. M. Vidyasagar, Nonlinear Systems Analysis. Prentice Hall, second edition, 1993.
As already mentioned there is provided a three axis wheel torque capability and a wheel configuration which can establish a wheel angular momentum vector in any desired direction so that also any change of this direction becomes possible. The torque command vector to the wheels is
There is performed a transformation of the open loop spacecraft dynamics given by the Euler equation (2.10) by means of a transformation or decoupling controller. This first feed back control loop leads to a "new spacecraft dynamics" given in equations (3.4) and 3.5) having a two-dimensional part (3.4) coupling the non measurable yaw component .psi. to the measurable roll and pitch components .phi. and .theta., respectively.
The transformation controller generates a first torque command or control signal (3.2) -h.sub.D =T.sub.CWD for the wheels and uses as inputs the measurable parts .omega..sub.M of the spacecraft angular velocity vector .omega. and .omega..sub.CM of the spacecraft angular acceleration vector, the measured angular moment vector h of the wheels and the inertia matrix I of the spacecraft.
The essential feature of this approach is the artificial decoupling of roll-pitch dynamics from the yaw dynamics but not vice versa, see equations (3.4) and (3.5). Considering that c.sub.2 (t) and d.sub.1 (t) can be neglected, see (iii), these equations then take the form: ##EQU13##
Due to the fact that .PHI. can be measured, a standard PID controller is used, see equation (3.6) for roll and pitch control. Equation (3.13) shows that only a feed back D control law -k.sub.D .psi. is needed to stabilize the yaw control loop if d.sub.2 (t)>0. This can be ensured by proper selection of the size of the wheel angular momentum vector. A disadvantage of this approach is that one can only vary the damping of the yaw closed loop. Therefore a PD control law gives the possibility to optimize the yaw control loop w.r.t. damping and bandwidth.
Equation (3.10) shows one of the possibilities to generate a pseudo measurement of the yaw rate .psi..sub.m. In case that for the yaw closed loop dynamics only D control is sufficient, the control law is given by
In case an improved yaw closed loop performance it needed, a standard observer approach for the yaw axis can be chosen. .psi..sub.m is then input to a time variant Luenenberg type yaw observer, the yaw control law for this approach being
with the estimated value .psi. for the yaw variable .psi..
The method of the invention can be applied in generalized roll, pitch and yaw tracking on the basis of only two-axis attitude measurements, for example for roll-pitch tracking in the case of inclined orbit operation or for yaw tracking in the case of yaw steering operation.
In FIG. 6 there is shown a block diagram of the method of the invention, exhibiting the input variables and parameters for the signal processing and control device as well as the output control signal to be fed to the wheel configuration including signal flow within the device and references to the equations to be performed in the device components represented by the respective blocks. FIG. 7 shows the structure of the mentioned yaw observer.
SIMULATION RESULTS
The simulation assumptions and results are taken from M. Surauer, Private communications, 1995.
LEO-application
Some typical applications for LEO-control tasks are Earth pointing (i.e. pitch tracking), roll and yaw tracking. For the simulations the corresponding spacecraft parameters, disturbance torques and orbit parameters are listed below:
Inertia matrix I=diag {850, 200, 860} Nms.sup.2.
Orbit frequency .omega..sub.0 =2.pi./(7200 s).
Disturbance torque T.sub.D=a.sub.0 +a.sub.1 cos .omega..sub.0 t+a.sub.0 sin .omega..sub.0 t
with
a.sub.0.sup.T =[4 20 10] 10.sup.-6 Nm
a.sub.1.sup.T =[-15 10 0] 10.sup.-6 Nm
a.sub.2.sup.T =[0 10 15] 10.sup.-6 Nm
Reference angular momentum h.sub.y.sup.R =-12 Nms.
IRES noise: 3.sigma.=0.1 degree.
Angular momentum control is performed taking magneto torquers to generate external control torques. An example for a roll-tracking maneuver is shown in FIGS. 4.1, 4.2, 4.3. FIG. 4.1 shows the roll-reference .alpha. and the controlled roll attitude .phi.. With this ordinate scaling no difference between the two signals can be noticed.
In FIG. 4.2 the time history of attitude control errors in roll, pitch, and yaw is plotted. FIG. 4.3 shows the wheel angular momentum during the roll-tracking maneuver.
GEO-application
In order to demonstrate the benefits of the yaw observer derived in section 3.2 the transient behaviour of a GEO satellite with large initial yaw angle (.psi..sub.0 =25 deg.) is considered. No disturbance torque is assumed. The orbit frequency is now .omega..sub.0 =2.pi./(24 h), the remaining data are the same as in section 4.1. The time history of .psi. is shown in FIG. 5.
Steady state conditions are reached after 2 hours, whereas a whecon controller needs 6 hours to reach steady state.
CONCLUSIONS
A control law for Earth oriented momentum bias satellites with time varying attitude reference signals was derived. Such reference signals have to be applied e.g. for roll tracking maneuvers. The corresponding minimum hardware configuration consists basically of a 2-axis Earth sensor, and wheels that provide a linear torque capability around all 3 spacecraft axes.
The control laws consists of a nonlinear decoupling part that leads to a linear, but time-varying plant dynamics, and axis related PID controllers for the control with respect to the reference attitude. The yaw state estimates are provided by an observer for the time-varying plant.
This approach has the advantage that it can be applied to a more general class of normal mode operations. It also results in an improved transient behaviour for nonzero initial conditions, without serious degradation of the disturbance rejection properties. This was demonstrated by simulation time histories for a classical geostationary satellite in an equatorial orbit revealing fast transient behaviour and for a satellite in LEO performing roll tracking maneuvers.
The forgoing disclosure has been set forth merely to illustrate the invention and is not intended to be limiting. Since modifications of the disclosed embodiments incorporating the spirit and substance of the invention may occur to persons skilled in the art, the invention should be construed to include everything within the scope of the appended claims and equivalents thereof.
Claims
We claim:
1. Method for controlling attitude of a three-axis-stabilized, earth oriented bias momentum spacecraft being suppled on its orbit with time varying attitude reference signals with respect to an orbital earth pointing reference coordinate system, and having measurement means for two-axis attitude measurement and a set of wheels for establishing an angular momentum in any desired direction and for producing torques about three axes of a spacecraft-related orthogonal coordinate system, the method comprising: feeding to a signal processing and control device said time varying attitude reference signals, measurement signals from said measurement means and signals representing an angular momentum vector of said set of wheels; said signal processing and control device generating first, second and third control signals; using the sum of said first, second and third control signals as a torque command signal for said set of wheels; for the generation of said first control signal; starting from an Euler equation describing dynamics of the spacecraft, transforming the Euler equation by introducing measurable parts .omega..sub.M and .omega..sub.M of a spacecraft angular velocity vector .omega. and its derivative .omega., respectively as derived from .PHI..sub.M .tbd.[.phi..THETA.0].sup.T, a measurable part of vector .PHI..tbd.[.phi..THETA..psi.].sup.T representing deviation of the spacecraft from its reference attitude; and determining said first control signal as one part of the torque vector figuring in the Euler equation, being related to said set of wheels in such a way that said one part compensates all relevant terms in the Euler equation that are measurable by means of said measurement means except for the term I.PHI., wherein I is the spacecraft inertia matrix; determining a sum of said second and third control signals as a second part of said torque vector; said second control signal being generated by one of a PID and a PD control law, using measurable components .phi., .THETA. of vector .PHI. as control input; and said third control signal being generated by one of a D control law using the computed derivative .psi. as controller input and a PD control law using the computed .psi. as input for a time varying observer; and the estimated observer state variables as controller input.
2. Method for controlling attitude of a three-axis stabilized, earth oriented bias momentum spacecraft being supplied on its orbit with time varying attitude reference signals with respect to an orbital earth pointing reference coordinate system, and having measurement means for two-axis attitude measurement and a set of wheels for establishing an angular momentum in any desired direction and for producing torques about three axes of a spacecraft-related orthogonal coordinate system, the method comprising: feeding to a signal processing and control device said time varying attitude reference signals, measurement signals from said measurement means and signals representing the angular momentum vector of said set of wheels; said signal processing and control device generating first, second and third control signals; using the sum of said first, second and third control signals as a torque command signal for said set of wheels; said first control signal being determined as a relevant part of a sum of terms being previously obtainable from a transformation of an Euler equation which describes dynamics of the spacecraft, the transformation comprising: replacing the vectors .omega. and .omega. representing the spacecraft angular velocity and its time derivative, respectively, by vector sums (.omega..sub.M +.DELTA..omega.) and (.omega..sub.M +.DELTA..omega.), respectively, containing parts .omega..sub.M and .omega..sub.M which are determinable taking into account their dependency upon a two-axial measurement vector .PHI..sub.M .tbd.[.phi..THETA.0].sup.T, being the measurable part of vector .PHI..tbd.[.phi..THETA..psi.].sup.T representing the spacecraft's deviation from its reference attitude, upon the orbit angular velocity .omega..sub.0 and upon said time varying reference signals, and parts .DELTA..omega. and .DELTA..omega. which are not determinable because of the lacking information in yaw (.psi.); said sum of terms comprising all terms of the transformed Euler equation which are determinable in view of said dependency, except for the term I.PHI., I being a spacecraft inertia matrix; said second control signal being generated by one of a PID and a PD control law, using measurable components .phi., .THETA.of vector .PHI. as control input; and said third control signal being generated by one of a D control law using the computed .psi. as controller input and a PD control law using the computed .psi. as input for a time varying observer; and the estimated observer state variables as controller input.
3. Method for controlling attitude of a three-axis-stabilized, earth oriented bias momentum spacecraft being supplied on its orbit with time varying attitude reference signals with respect to an orbital earth pointing reference coordinate system, and having measurement means for two-axis attitude measurement related to deviations in roll and pitch from the time varying reference attitude and a set of wheels for establishing an angular momentum in any desired direction and for producing torques about three axes of a spacecraft-related orthogonal coordinate system, the method comprising: feeding to a signal processing and control device said time varying attitude reference signals, measurement signals from said measurement means and signals representing an angular momentum vector of said set of wheels; said signal processing and control device generating first, second and third control signals; using the sum of said first, second and third control signals as a torque command signal for said set of wheels; said first control signal being formed in a partial decoupling controller such that yaw dynamics couples into roll and pitch dynamics, but not vice versa; said second control signal being generated by means of one of a PID and PD control law, using deviations in roll and pitch as control input; said third control signal being generated by means of one of a D control law using a computed derivative of yaw deviation as controller input, and a PD control law using said computed derivative of the yaw deviation as input for a time varying reduced order observer, and estimated observer state variables as controller input; and said computer derivative of the yaw deviation being determined on the basis of a spacecraft dynamics subsystem related to roll-pitch-motion, taking into account control of the subsystem by said second control signal.