The present invention relates to an attitude control device for space station with system parameter uncertainties and on-orbit dynamic disturbances that controls attitude angle of a space station with the presence of system parameter uncertainties due to astronaut motion, manipulation of payloads and docking with other spacecraft, combined with on-orbit dynamic disturbances such as disturbance torque caused by solar wind.
U.S. Pat. No. 5,959,861 discloses an adaptive robust control device for trajectory tracking of a robot manipulator with system parameter uncertainties and random disturbances that generates a control input comprising adaptive linearlization input based on identified system parameters, and robustness improving input.
The prior art in U.S. Pat. No. 5,959,861, if applied to attitude control of a space station, presents a poor transient performance when the rate of change of system parameters is not sufficiently small. Transient performance can be improved by high-gain robust control, however high-gain control introduces issues associated with noise sensitivity, and tradeoff between noise sensitivity and tracking performance becomes necessary. The best tradeoff is, in general, difficult to achieve since the rate of change of system parameters depends on astronaut motion, payload motion and motion of other spacecraft while docking with the space station, all of which are intricate and unpredictable.
The present invention provides an attitude control device for space station with system parameter uncertainties and on-orbit dynamic disturbances.
The attitude control device includes:
The novel features of the invention will be readily understood and appreciated by reference to the following detailed description taken in conjunction with the drawings, in which:
The space station structure 110 is a mechanical structure of a space station including a habitable area, a plurality of solar arrays, a plurality of propellant tanks, a plurality of propulsion systems, a plurality of docking ports that forms a basic shape of the space station, and mounts the plurality of state sensors 120, the attitude control device 130 and the plurality of thrusters 140.
The plurality of state sensors 120 measure a plurality of states of the space station such as three attitude angles about three principal axes and time derivatives thereof, and send them to the attitude control device 130 as a plurality of measured states.
The attitude control device 130 identifies time varying moment of inertia of the space station with moving astronauts and payloads, and a docking spacecraft, disturbance torque due to solar wind based on the plurality of states and sends a control signal to cause the plurality of thrusters 140 generate control torque stabilizing the three attitude angles of the space station structure 110. Detailed description of the attitude control device 130 is given together with its functional configuration in what follows.
The attitude control device 130 further includes: an identification frequency selecting device 131, a moment of inertia identification operator calculation unit 132, a moment of inertia identification device 133, a disturbance torque identification device 134 and a control torque calculation unit 135.
The identification frequency selecting device 131 finds a plurality of frequencies of disturbance torque using a frequency analysis method such as Fourier transform, and selects an identification frequency away from the plurality of frequencies of disturbance torque that is used in identification of the moment of inertia of the space station.
The moment of inertia identification operator calculation unit 132 calculates a moment of inertia identification operator, a matrix with components that are functions of a frequency component of the plurality of states at the identification frequency.
The moment of inertia identification device 133 calculates the moment of inertia of the space station using the moment of inertia identification operator from the moment of inertia identification operator calculation unit 132, and sends it to the disturbance torque identification device 134 and the control torque calculation unit 135.
The disturbance torque identification device 134 calculates disturbance torque due to solar wind using the moment of inertia of the space station from the moment of inertia identification device 133, and sends the disturbance torque to the control torque calculation unit 135.
The control torque calculation unit 135 calculates the control signal that causes the plurality of thrusters 140 to generate the control torque stabilizing the space station based on the moment of inertia from the moment of inertia identification device 133 and the disturbance torque from the disturbance torque identification device 134.
The plurality of thrusters 140 generate the control torque based on the control signal, and stabilize the three attitude angles.
Derived in what follows is a principle whereby the attitude control device 130 calculates control torque.
Equations of motion of the space station structure 110 are described as (1) through (3).
I
1{umlaut over (θ)}1+(I3−I2){dot over (θ)}2{dot over (θ)}3=Tc1+Td1 (1)
I
2{umlaut over (θ)}2+(I1−I3){dot over (θ)}3{dot over (θ)}1=Tc2+Td2 (2)
I
3{umlaut over (θ)}3+(I2−I1){dot over (θ)}1{dot over (θ)}2=Tc3+Td3 (3)
where I1 is a principal moment of inertia about a first principal axis (hereinafter referred to as “the first principal moment of inertia”) [kg·m2], I2 is a principal moment of inertia about a second principal axis (hereinafter referred to as “the second principal moment of inertia”) [kg·m2], I3 is a principal moment of inertia about a third principal axis (hereinafter referred to as “the third principal moment of inertia”) [kg·m2], θ1 is a component of the attitude angle about the first principal axis (hereinafter referred to as “the first component of attitude angle”) [rad], θ2 is a component of the attitude angle about the second principal axis (hereinafter referred to as “the second component of attitude angle”) [rad], θ3 is a component of the attitude angle about the third principal axis (hereinafter referred to as “the third component of attitude angle”) [rad] , Tc1 is a component of the control torque about the first principal axis (hereinafter referred to as “the first component of control torque”) [N·m], Tc2 is a component of the control torque about the second principal axis (hereinafter referred to as “the second component of control torque”) [N·m], Tc3 is a component of the control torque about the third principal axis (hereinafter referred to as “the third component of control torque”) [N·m], Td1 is a component of the disturbance torque about the first principal axis (hereinafter referred to as “the first component of disturbance torque”) [N·m], Td2 is a component of the disturbance torque about the second principal axis (hereinafter referred to as “the second component of disturbance torque”) [N·m], Td3 is a component of the disturbance torque about the third principal axis (hereinafter referred to as “the third component of disturbance torque”) [N·m].
Equations of motion in (1) through (3) are rewritten in a matrix form as (4).
where W is a matrix comprising first order and second order time derivatives of attitude angles (hereinafter referred to as “a state matrix”) [s−2], x is a moment of inertia vector [kg·m2], Tc is the control torque [N·m], Td is the disturbance torque [N·m].
When the space station is exposed to solar wind and starts vibrating, the control torque calculation unit 135 sends a control input to the plurality of thrusters 140 to generate a control torque given by (5).
where c1 is a first speed control parameter that increases damping of the first component of attitude angle [N·m·s/rad], c2 is a second speed control parameter that increases damping of the second component of attitude angle [N·m·s/rad], c3 is a third speed control parameter that increases damping of the third component of attitude angle [N·m·s/rad]. With the control torque in (5), a transient response of the attitude angle dies out. Once the transient response vanishes, the attitude angle contains frequencies comprising the disturbance torque Td (hereinafter referred to as “a plurality of disturbance frequencies”). The identification frequency selecting device 131 finds the plurality of disturbance frequencies by applying a frequency analysis method to the attitude angle. Examples of the frequency analysis method include but are not limited to fast Fourier transform. Then, the identification frequency selecting device 131 selects an identification frequency ωID sufficiently away from the plurality of disturbance frequencies. The control torque calculation unit 135 generates a control input to the plurality of thrusters 140 by adding a sinusoidal term having the identification frequency as in (6).
where δTID1 is amplitude of a first component of an identification torque (hereinafter referred to as “first identification torque amplitude”), δTID2 is amplitude of a second component of an identification torque (hereinafter referred to as “second identification torque amplitude”), δTID3 is amplitude of a third component of an identification torque (hereinafter referred to as “third identification torque amplitude”). A second term of (6) will be hereinafter referred to as “an identification torque vector”.
Moment of inertia identification operator calculation unit calculates a moment of inertia identification operator in (7).
where WID is the moment of inertia identification operator [s−2], θ1ID is a frequency component of the first component of attitude angle at the identification frequency (hereinafter referred to as “a first identification frequency component of attitude angle”) [rad], θ2ID is a frequency component of the second component of attitude angle at the identification frequency (hereinafter referred to as “a second identification frequency component of attitude angle”) [rad], θ3ID is a frequency component of the third component of attitude angle at the identification frequency (hereinafter referred to as “a third identification frequency component of attitude angle”) [rad]. The first identification frequency component of attitude angle, the second identification frequency component of attitude angle and the third identification frequency component of attitude angle can be obtained by applying a band pass filter in (8) to the first component of attitude angle, the second component of attitude angle and the third component of attitude angle, respectively.
where r is a depth of the band pass filter, ξ is a width of the band pass filter and s is Laplace variable.
A frequency component of the control torque at the identification frequency (hereinafter referred to as “an identification frequency component of control torque”) TcID [N·m] can be obtained by applying the band pass filter in (8) to the control torque Tc. A part of dynamics of the space station influenced by the identification frequency component of control torque can be expressed as (9).
WIDx=TcID (9)
The moment of inertia identification device obtains the moment of inertia vector x from (9) as (10).
{circumflex over (x)}=W
ID
−1
T
cID (10)
where {circumflex over (x)} is an identified moment of inertia vector [kg·m2]. The moment of inertia identification device 133 calculates the identified moment of inertia vector {circumflex over (x)} using (10) if the moment of inertia identification operator WID is not close to singular, otherwise holds a previously calculated value.
The disturbance torque identification device 134 calculates an identified disturbance torque {circumflex over (T)}d using (11) derived from (4) and (10).
{circumflex over (T)}
d
W{circumflex over (x)}−T
c (11)
The control torque calculation unit 135 calculates a control signal that causes the plurality of thrusters 140 to generate the control torque in (12).
where Î1 is a first component of the identified moment of inertia vector (hereinafter referred to as “a first identified moment of inertia”) [kg·m2], Î2 is a second component of the identified moment of inertia vector (hereinafter referred to as “a second identified moment of inertia”) [kg·m2], Î3 is a third component of the identified moment of inertia vector (hereinafter referred to as “a third identified moment of inertia”) [kg·m2], k1 is a first position control parameter that is used to control the first component of attitude angle [N·m/rad], k2 is a second position control parameter that is used to control the second component of attitude angle [N·m/rad], k3 is a third position control parameter that is used to control the third component of attitude angle [N·m/rad]. With the control torque in (12), the attitude angle converges to zero as the identification torque vector that is a second term in (12) is reduced to zero.
The identification torque vector is gradually reduced to zero as the aforementioned moment of inertia identification by (10) is completed, and remains zero while the vibration of space station due to the disturbance torque is suppressed using the control torque in (12). If astronaut motion, manipulation of payloads or docking with other spacecraft causes the moment of inertia vector x to deviate from the identified moment of inertia vector {circumflex over (x)} to the extent that the control torque vector in (12) can no longer suppress the vibration of space station, the aforementioned procedure is repeated and the control signal for the plurality of thrusters 140 to generate the control torque in (12) is recalculated by the attitude control device 130.
Next a processing flow of the attitude control device for space station is described using
The control torque calculation unit 135 generates the control signal causing the plurality of thrusters to generate the control torque given by (5) for finding the identification frequency, and sends it to the identification frequency selecting device 131 (S202).
The identification frequency selecting device 131 calculates the plurality of disturbance frequencies using a frequency analysis method such as Fourier transform, and selects an identification frequency ωID sufficiently away from the plurality of disturbance frequencies (S203).
The control torque calculation unit 135 calculates the control signal that causes the plurality of thrusters 140 to generate the control torque in (6) (S204).
The moment of inertia identification operator calculation unit 132 calculates the moment of inertia identification operator in (7) using the first frequency component of attitude angle, the second frequency component of attitude angle and the third frequency component of attitude angle, and sends the moment of inertia identification operator to the moment of inertia identification device 133 (S205).
The moment of inertia identification device 133 calculates the identified moment of inertia vector {circumflex over (x)} using (10), and sends the identified moment of inertia vector to the disturbance torque identification device 134 and the control torque calculation unit 135 (S206).
The disturbance torque identification device 134 calculates the identified disturbance torque vector {circumflex over (T)}d using (11), and sends the identified disturbance torque to the control torque calculation unit 135 (S207).
The control torque calculation unit 135 calculates the control signal that causes the plurality of thrusters 140 to generate the control torque in (12), and sends the control signal to the plurality of thrusters 140 (S208).
The control torque calculation unit 135 generates the control signal such that the second term in (12) is reduced to zero. Then, the attitude angle converges to zero. If astronaut movements, transfer of payloads and reaction force from a docking spacecraft are sufficiently small such that the attitude angle stays at zero, the control torque calculation unit 135 continues to generate the same control signal (NO of S209). Otherwise, steps S201 through S208 are repeated (YES of S209).
Hereinafter, simulation results of aforementioned control processes of the attitude control device for space station in accordance with an exemplary embodiment of the invention are described in detail. The simulation assumes a space station docking with other spacecraft such that the first principal moment of inertia I1, the second principal moment of inertia I2 and the third principal moment of inertia I3 increase as in
Although the above simulation assumes a space station represented by a lumped parameter system, the present invention can be applied, with a minor modification apparent to those skilled in the art, to a variety of space stations, all or a part of which is represented by a distributed parameter system.
The attitude control device for space station in the foregoing embodiment can be realized as an electrical/electronic/programmable electronic system. Examples of the electrical/electronic/programmable electronic system include but are not limited to a control system comprising an application specific integrated circuit (ASIC) and a microcontroller.
While, in the foregoing embodiment, the disturbance torque containing a single frequency component is considered, the present invention can be applied regardless of the number of frequency components comprising the disturbance torque.
The described embodiments of the current invention are only exemplary and numerous variations thereof apparent to those skilled in the art are intended to be within the scope of the current invention as defined in the following claims.