Adaptive Spacecraft Attitude Control Using Single-Gimbal Control Moment Gyroscopes Without Singularity Avoidance
JOURNAL OF GUIDANCE,CONTROL, AND DYNAMICS
Adaptive Spacecraft Attitude Control Using Single-Gimbal Control Moment Gyroscopes Without Singularity Avoidance
Zhanzhan Zhao,∗ Gerardo Cruz,† and Dennis S. Bernstein‡ University of Michigan, Ann Arbor, Michigan 48109 DOI: 10.2514/1.G003926 This paper applies retrospective cost adaptive control (RCAC) to spacecraft attitude control with a rotation-matrix attitude parameterization using constant-speed single-gimbal control moment gyroscopes. Unlike control laws that use torque-steering laws to synthesize torque requests while avoiding gimbal singularities, the adaptive control law requests the rate of each gimbal. Because no torque request is provided, there is no need to invert the mapping from the gimbal rates to the control torque, and thus no attempt is made to avoid gimbal singularities. The RCAC implementation is based on a target model involving a single Markov parameter corresponding to the initial gimbal configuration. The parameters and weights for RCAC are based on nominal-model tuning, which uses no explicit knowledge of the nonlinear equations of motion. This paper investigates the robustness of RCAC to off-nominal conditions of commands, noise, and unknown bus inertia; and it examines the performance of RCAC in the case where an approximately singular gimbal configuration occurs during attitude command, following as well as the case of an initial gimbal-lock singularity. The performance of the adaptive controller in the presence of sensor/actuator misalignment is also investigated.
Nomenclature k = discrete-time step kw = initial waiting period A = attitude parameter matrix diag a1;a2;a3 lz = dimension of z a1;a2;a3 = attitude parameters lu = dimension of u BCMG;B1;B2 = control input matrices Θ c = center of mass of the spacecraft lΘ = dimension of mi = mass of Wi ci = center of mass of the ith wheel e = rotation eigenaxis for the rotated bus inertia n = number of the gimbals ⇀ nc = controller order O matrix J B;rot B∕G = direction cosine matrix obtained by resolving × i ! ei = ith column of the 3 3 identity matrix I3 R G ∕B in FB 0 i e = misalignment eigenaxis from F to F 0 O 0 B B B ∕B =! direction cosine matrix obtained by resolving FB = bus-fixed frame R B∕B 0 in FB 0 FB 0 = sensor-fixed frame O 0∕ = direction cosine matrix obtained by resolving B Gi ! F = frame representing the attitude command for F 0 0 C B R Gi∕B in FB F = frame fixed to gimbal G O O Gi i i = B∕Gi F = inertial frame O 0 O 0 I i = B ∕Gi
FWi = frame fixed to wheel Wi Pi;k = controller coefficient matrix Gi = ith gimbal Qi;k = controller coefficient matrix Gf q = finite impulse response filter used by q = forward shift operator R retrospective cost adaptive control B∕I = direction cosine matrix obtained by resolving H = matrix that models the initial gimbal configu- ! R B∕I in FB ration used in Gf R C∕I = direction cosine matrix obtained by resolving I3 = 3 × 3 identity matrix ! ! R C∕I in FC J = inertia tensor J SC∕c of the spacecraft relative η Downloaded by UNIV OF MICHIGAN on August 20, 2019 | http://arc.aiaa.org DOI: 10.2514/1.G003926 Ru = control weighting matrix uIlu to c resolved in FB η ! Rz = performance weighting matrix zIlz J = inertia tensor J ∕ of the bus relative to c η B B c RΘ = regularization weighting matrix ΘIlΘ resolved in F ~ B R = attitude-error rotation matrix between RB∕I and J = rotated bus inertia matrix R B;rot ! ! C∕I J = inertia tensor J ∕ of W relative to c i Wi ci i i R B∕B 0 = rotation tensor that rotates FB 0 into FB resolved in FW ! !i R B∕I = rotation tensor that rotates FI into FB Ji;c = inertia tensor J W ∕c of Wi relative to c resolved ! i R C∕I = rotation tensor that rotates FI into FC in FB ! ^ Θ^ R ∕ = rotation tensor that rotates F into F Jk = retrospective cost function !Gi B B Gi 0 0 R Gi∕B = rotation tensor that rotates FB into FGi ri = position of ci relative to c resolved in FB Received 22 June 2018; revision received 8 June 2019; accepted for S = vector representation of the attitude error R~ publication 1 July 2019; published online 19 August 2019. Copyright © 2019 s = scalar attitude-error metric by Dennis S. Bernstein. Published by the American Institute of Aeronautics ϕ and Astronautics, Inc., with permission. All requests for copying and Ts = settling time to bring and maintain eig within permission to reprint should be submitted to CCC at www.copyright.com; ϕ∞ employ the eISSN 1533-3884 to initiate your request. See also AIAA Rights t = continuous-time variable and Permissions www.aiaa.org/randp. u = vector of gimbal rates *Graduate Student, Department of Aerospace Engineering; zhanzhao@ ui = gimbal rate of Gi around j^G relative to FB umich.edu. i † Wi = ith wheel Staff Member, NASA Goddard Space Flight Center; gerardo.e.cruz- z = performance variable [email protected]. ‡ z^ = retrospective performance variable Professor, Department of Aerospace Engineering; [email protected]. k
Article in Advance / 1 2 Article in Advance / ZHAO, CRUZ, AND BERNSTEIN
αi = moment of inertia of Wi around the spin axis In contrast to CMG-driven attitude control laws based on torque- ^ iWi steering laws, the present paper focuses on direct gimbal-rate-requested β = pyramidal face angle adaptive control of single-gimbal constant-speed CMGs without a β ^ ^ i = moment of inertia of Wi around jWi and kWi torque-steering law. In Fig. 2, the controller directly requests the gimbal Θk = controller coefficient vector rates u without a torque-steering law, and thus without specifying a Θ^ = retrospectively optimized controller coefficient requested torque. The gimbal motors implement the requested gimbal vector rates u that, as a result of the CMG dynamics, produce the actuation θ = rotation eigenangle for the rotated bus inertia torque τCMG applied to the spacecraft. Because no torque request is matrix JB;rot specified, there is no need to invert the mapping from the gimbal rates to θi = rotation angle of Gi the control torque, and thus no attempt is made to avoid gimbal θ 0 = misalignment eigenangle from FB to FB 0 . singularities. The direct gimbal-rate approach was used in Refs. [31– ν i = spin rate of the frame FW relative to FG around 33]. In particular, the approach of Ref. [31] was confined to open-loop ^ i i iWi control, Ref. [32] linearized the nonlinear system and applies an ξC = commanded eigenaxis resolved in FI optimal control law, and Ref. [33] applied sliding mode control. τ CMG = torque applied to the spacecraft by the control Nevertheless, approximate gimbal singularities can occur using moment gyroscopes the direct gimbal-rate approach. In these cases, the impact of τdist = torque applied to the spacecraft by the singularities encountered during a maneuver is limited due to the fact disturbances that the control input matrix B is time dependent, and thus rank- τ CMG G = torque applied to the spacecraft by Gi deficient conditions tend to hold at only isolated points. This property Φ i k = regressor matrix thus facilitates a simplified approach to the use of constant-speed ϕ C = commanded eigenangle CMGs for spacecraft attitude control. ϕ eig = rotation angle around the eigenaxis that rotates The adaptive control law adopted in the present paper is R B∕I t to RC t retrospective cost adaptive control (RCAC). RCAC was developed ϕ ϕ ∞ = bound on eig for linear systems in Refs. [34–36]. As shown in the present paper, ω B = angular velocity of FB relative to FI resolved in RCAC requires extremely limited modeling information for a FB spacecraft with CMG actuation, namely, geometric information ω C = angular velocity of FC relative to FI resolved in concerning the initial gimbal configuration. The ability of RCAC to FC control the spacecraft with limited modeling information is ω ~ B = angular velocity of FB relative to FC resolved in demonstrated by tuning RCAC in numerical simulations based on a FB nominal model and by subsequently evaluating its performance using ω⇀ B∕I = angular velocity of FB relative to FI a perturbed model. In this approach, the spacecraft equations of ω⇀ C∕I = angular velocity of FC relative to FI motion are used only for numerical simulation; no explicit knowledge of these equations is used by RCAC. Closed-loop stability for linear systems using RCAC was addressed in Ref. [35]. I. Introduction Proof of closed-loop stability for nonlinear systems in general and CMG control of spacecraft is an open problem. CONTROL moment gyroscope (CMG) consists of a spinning A pyramidal CMG arrangement consisting of four CMGs is A wheel mounted on one or two gimbals; the wheel may considered in this paper. The RCAC law is based on a rotation-matrix spin at either a constant or variable rate. The gimbal or gimbals attitude parameterization, which avoids singularities arising with ’ rotate the wheel s spin axis relative to the spacecraft bus, thereby Euler angles and Rodrigues parameters as well as the double covering applying a reaction torque to the spacecraft. The high torque levels and arising from quaternions. These issues and their ramifications were accuracy provided by CMGs make them well suited for attitude control discussed in Refs. [37,38]. – of large space stations, orbiting telescopes, and agile spacecraft [1 3]. The specific contributions of this paper are as follows: – CMGs are typically operated using torque-steering laws [2 6]. In 1) In contrast with torque-steering laws, a gimbal-rate controller is § τ Fig. 1, the controller requests the torque req, and the torque-steering shown to achieve approximate singularity passthrough and escape law synthesizes the requested gimbal-rate control input u, resulting in from a singularity. τ the actuation torque CMG applied to the spacecraft. When the control 2) The adaptive controller uses no explicit knowledge of the τ input matrix BCMG becomes rank deficient, the torque CMG along spacecraft equations of motion, including the bus inertia and one direction cannot be generated, and thus all possible torque nonlinearities. Downloaded by UNIV OF MICHIGAN on August 20, 2019 | http://arc.aiaa.org DOI: 10.2514/1.G003926 vectors are coplanar [4], which indicates a singular gimbal 3) A robustness study demonstrates the performance of the configuration. In Ref. [7], geometric methods are used to determine adaptive controller over a wide range of unknown inertia matrices, the CMG singular surfaces. If a CMG singularity can be reconfigured and in the presence of sensor/actuator misalignment. These results by null motion BCMG t u t 0 into a nonsingular gimbal extend preliminary results given in Refs. [39,40] and complement the configuration, it is called hyperbolic or passable; otherwise, it is application of RCAC to spacecraft with reaction wheels, magnetic called elliptic or impassable [8]. torquers, and an appendage in Refs. [41–43]. Singularities are inherent in every array of constant-speed CMGs [5]. The contents of the paper are as follows. Section II enumerates At the expense of greater hardware complexity, gimbal singularities do assumptions for a spacecraft actuated by a collection of constant- not arise with variable-speed CMGs [9,10]. Alternatively, Refs. [11,12] speed single-axis CMGs, and it summarizes the equations of motion. considered CMGs under rotor offset to avoid singularities. Singularities Section III defines the performance variable for the attitude control can be mitigated using singularity-avoidance torque-steering laws [13– problem. Section IV briefly reviews RCAC. Section V describes the 23]. In particular, rapid escape from impassable internal singularities pyramidal arrangement of four CMGs and constructs the target model was discussed in Refs. [18,19,24]. needed by RCAC for an initial gimbal configuration. Section VI Torque-steering laws based on adaptive control algorithms have investigates the performance of RCAC for a spacecraft controlled by been applied to both constant-speed and variable-speed CMGs. In CMGs in the pyramidal arrangement with sensor noise, off-nominal particular, adaptive control of constant-speed single-gimbal CMGs commands, an unknown bus inertia matrix, an approximate was considered in Refs. [25–27]; adaptive control of double-gimbal singularity passthrough, escape from an initially singular gimbal CMGs was considered in Ref. [28]; and adaptive control of variable- configuration, and sensor/actuator misalignment. Finally, the speed CMGs was considered in Refs. [29,30]. Appendix provides a derivation of the equations of motion for the spacecraft controlled by CMGs. This derivation shows explicitly how § Note that eatt attitude error and ratt attitude command in Figs. 1 and 2 each assumption is used to arrive at the equations of motion used for only. nominal-model tuning and perturbed-model testing. Article in Advance / ZHAO, CRUZ, AND BERNSTEIN 3
Controller Torque-Steering Law Spacecraft
Fig. 1 The controller requests the torque τreq, and the torque-steering law requests the gimbal rates u.
Controller Spacecraft
Fig. 2 The controller directly requests the gimbal rates u without a torque-steering law.
II. Spacecraft Attitude Dynamics with Direct Gimbal- Rate Request The dynamics of a spacecraft SC consisting of a bus B and n single- gimbal constant-speed CMGs in an arbitrary arrangement are considered. For i 1; :::;n, CMGi is composed of wheel⇀ Wi mounted on gimbal Gi as shown in Fig.! 3. Vectors denoted by r and Fig. 3 Notation and conventions for CMGi. second-order tensors denoted by R are component free.¶ Differentiation of component-free vectors and tensors is performed Assumption 1: The bus and wheels are rigid bodies. with respect to a frame; differentiation of resolved vectors and tensors Assumption 2: The gimbals are massless. does not require a frame. Assumption 3: For all i 1; :::;n, the center of mass ci of Wi is fixed in the bus. A. Kinematics and Frames Assumption 4: For all i 1; :::;n, the direction of the axis i^W is ^ ^ i Let FI be an inertial frame, and let FB be a bus frame defined by the fixed in FGi . In particular, iWi iGi . pyramidal CMG arrangement as discussed in Sec. V. The rotational Assumption 5: For all i 1; :::;n, the wheel Wi is inertially attitude kinematics of the bus are described by Poisson’s equation symmetric around i^W . i ^ Assumption 6: For all i 1;:::;n, the frame FWi spins around iWi B• at the constant rate νi > 0 relative to FG . ! ! ω⇀× i R B∕I R B∕I B∕I (1) Assumption 7: For all i 1;:::;n, gimbal Gi is actuated by requesting its rate u around j^ relative to F . ! i Gi B • Figure 3 and Assumptions 4 and 5 imply that the inertia matrix of where B denotes the frame derivative with respect to FB, ⇀R B∕I is the ω W relative to c resolved in both F and F is given by rotation tensor that rotates FI into FB (see footnote ¶), B∕I is the i i Gi Wi “×” angular velocity of FB relative to FI, and the superscript denotes 2 3 the skew-symmetric cross-product matrix. For all i 1; :::;n, the α 00 ! ! 4 i 5 frame FG is fixed to Gi, and the frame FW is fixed to Wi. J ≜ J ∕ j J ∕ j 0 β 0 (6) i ! i i Wi ci Gi Wi ci Wi i Resolving the second-order tensor R ∕ yields the rotation matrix B I 00βi R ≜ ! ! α B∕I R B∕I R B∕I (2) where i is the moment of inertia of Wi around the spin axis B I ^ ^ β iWi iGi , and i is the moment of inertia around the remaining axes
of FWi and FGi . Therefore, Downloaded by UNIV OF MICHIGAN on August 20, 2019 | http://arc.aiaa.org DOI: 10.2514/1.G003926 which is a 3 × 3 direction cosine matrix. The second equality is due to the fact that the rotation tensor represents a rotation about an ! ! T T J ∕ j O J ∕ j O O J O (7) O Wi ci B i Wi ci Gi i i i i eigenaxis that is fixed in both frames. The orientation matrix B∕I is defined by and the 3 × 3 orientation matrix Oi is defined by O RT R B∕I B∕I I∕B (3) ! ! O ≜ O ∕ R ∕ j R ∕ j (8) i B Gi Gi B Gi Gi B B × ⇀ which is also a 3 3 direction cosine matrix. If x is a coordinate-free ! vector, then where R G ∕B is the rotation tensor that rotates FB into FG . For a i ⇀ ⇀ O ⇀ i coordinate-free vector x, xjB i xjGi . ⇀ O ⇀ Next, define xjB B∕I xjI (4) ⇀ ⇀ ! T ×2 J ≜ J ∕ j O J O − m r ;r≜ r ∕ j (9) and, if J is a second-order tensor, then i;c Wi c B i i i i i i ci c B
! O ! O where m is the mass of W . Note that r is the position of c relative to J jB B∕I J jI I∕B (5) i i i i c resolved in FB. Define the bus inertia matrix The following assumptions are made. ≜ ! JB J B∕cjB ¶Kovecses, J., “Dynamics of Mechanical Systems Part 1: Concepts, Geometry and Kinematic Considerations,” 2017, https://hal.archives- Then, the inertia tensor of the spacecraft relative to its center of mass ouvertes.fr/hal-01534010 [retrieved 01 June 2019]. resolved in FB is given by 4 Article in Advance / ZHAO, CRUZ, AND BERNSTEIN
Xn Xn ! ! ⇀ ! ! ! R ∕ ≜ R ∕ j R ∕ j ; ω ≜ ω ∕ j (17) J ≜ J ∕ j J ∕ j J ∕ j J J (10) C I C I C C I I C C I C SC c B B c B Wi c B B i;c i 1 i 1 R R The error between B∕I and C∕I is given in terms of the attitude- B. Dynamics error rotation matrix In equation (4.81) of Ref. [4], setting the inertial derivative of the ! ! ! ! T ! T! R~ ≜ R ∕ j R ∕ j R ∕ j R ∕ R ∕ j R ∕ j R ∕ j spacecraft angular momentum B C B B I B I C B B I B I B C I I B I B RT R ∕ B∕I ⇀ C I NdH (18) dt which satisfies τ to be CMG and setting the wheel angular accelerations to be zero yield B• ! ! ⇀ × R_~ ω R~ ω× Xn R B∕CjB R B∕CjB B∕CjB ~ B (19) Jω_ ω × Jω α ν O e τ τ (11) B B B i i i 1 CMG dist ! ω⇀ i 1 where R B∕C is the rotation tensor that rotates FC into FB, B∕C is the angular velocity of FB relative to FC, and the angular-velocity error where ω~ B is defined as ⇀ ⇀ ⇀ ⇀ ~ T ω ≜ ω ω~ B ≜ ωB∕Cj ωB∕I − ωC∕I j ωB − R ωC (20) B B∕IjB B B τ Note that dist is the torque disturbance applied to the spacecraft, and B. Performance Variable the torque τ applied to the spacecraft by the CMGs is given by CMG The objective of the attitude control problem is to align FB with the attitude-command frame F . To follow attitude commands, a τ ≜ C CMG BCMGu B1u_ (12) performance variable z is defined and used for adaptive control. A vector representation of the attitude error R~ in Eq. (18) is given by ≜ ω× − ∈ R3×n 2 3 BCMG BB1 B2 (13) R~ − R~ X3 a3 32 a2 23 ≜ R~ T × 4 R~ − R~ 5 ∈ R3 ∈ R3×n S ai ei ei a1 13 a3 31 (21) where the ith column of B1 is given by i 1 ~ ~ a2R21 − a1R12 −β O ∈ R3 B1i i ie2 (14) where a1, a2, and a3 are real numbers. Note that S depends on the off- ∈ R3×n R~ and the ith column of B2 is given by diagonal entries of the error matrix in Eq. (19). Lemma 1: Assume that a1, a2, and a3 are distinct, positive O × − × OTω − α ν O ∈ R3 numbers. Then, S 0 if, and only if, B2i i e2 Ji Jie2 i B i i ie3 (15) R~ ∈ − − − where ei denotes the ith column of the 3 × 3 identity matrix I3.Asin fI3; diag 1; 1; 1 ; diag 1; 1; 1 ; diag 1; 1; 1 g Ref. [4] (p. 80), the term B u_ is not considered in the subsequent 1 □ development. Proof: See lemma 3 of Ref. [38]. In Ref. [44], the equations of motion for a spacecraft controlled by Lemma 1 shows that using S as the sole metric of attitude error constant-speed single-gimbal CMGs are derived where, in the gives rise to three spurious attitude equilibria. These equilibria can be σ removed by considering the additional attitude-error metric notation of Ref. [44], B1u_ in Eq. (12) is expressed as B and BCMGu is σ expressed as D1 D2 D3 _. Various torque-steering laws ~ ~ ~ ~ s ≜ trace A − AR a1 1 − R11 a2 1 − R22 a3 1 − R33 involving Bσ , D2, and D3 were considered in Ref. [44]. In equation (4.81) in Ref. [4], the term (22)
Xn where the attitude parameter matrix A ≜ diag a1;a2;a3 is positive R~ R~ R~ R~ Jg;iδig^ i definite; and 11, 22, and 33 are the diagonal entries of .In R~ Downloaded by UNIV OF MICHIGAN on August 20, 2019 | http://arc.aiaa.org DOI: 10.2514/1.G003926 i 1 contrast to S, which depends on the off-diagonal entries of , the error metric s depends on the diagonal entries of R~ . The following is equivalent to B1u_ in Eq. (12). Related developments appeared in result is needed. Refs. [29,45]. Lemma 2: For all i; j ∈ f1; 2; 3g, the i; j entry Rij of a rotation matrix R satisfies jRijj ≤ 1. III. Performance Variable for the Attitude Control Proof: See fact 4.13.14 of Ref. [46]. □ Problem The following result shows that S and s can be used together to ensure R~ I . A. Commanded Attitude and Attitude Error 3 Proposition 1: Assume that a1, a2, and a3 are distinct, positive Let FC be a frame that represents the commanded attitude for FB. R~ numbers. Then, S 0 and s 0 if, and only if, I3. The control objective is to have the spacecraft attitude Proof: Sufficiency is immediate. To prove necessity, note that s 0 implies that R ≜ ! B R B∕IjB − R~ − R~ − R~ − R~ a1 1 11 a2 1 22 a3 1 33 trace A A 0 follow the commanded attitude maneuver given by ~ Lemma 2 implies that, for i 1; 2; 3, ai 1 − Rii ≥ 0, and C• − R~ − R~ − R~ _ d ! ! ! ⇀ × × thus a1 1 11 a2 1 22 a3 1 33 0. RC∕I R C∕Ij R C∕Ij R C∕Ij ωC∕Ij RC∕Iω (16) dt C C C C C Because a1, a2, and a3 are positive, it follows that R~ R~ R~ R~ 11 22 33 1. Because, by Lemma 1, is diagonal, it ! ω⇀ R~ □ where R C∕I is the rotation tensor that rotates FI into FC, C∕I is the follows that I3. • angular velocity of FC relative to FI, C indicates the frame derivative To apply RCAC to attitude control, Lemma 1 and Proposition 1 are with respect to FC, and used to define the performance variable z by Article in Advance / ZHAO, CRUZ, AND BERNSTEIN 5