attitude stabilization of a rigid spacecraft using two ... · of a rigid spacecraft and that...

8
JOURNAL OF GUIDANCE, CONTROL, AND DYNAMICS Vol. 18, No. 2, March-April 1995 Attitude Stabilization of a Rigid Spacecraft Using Two Momentum Wheel Actuators Hariharan Krishnan* National University of Singapore, 0511 Singapore N. Harris McClamroch^ University of Michigan, Ann Arbor, Michigan 48109-2140 and Mahmut Reyhanoglu* King Fahd University of Petroleum and Minerals, Dhahran 31261, Saudi Arabia It is well known that three momentum wheel actuators can be used to control the attitude of a rigid spacecraft and that arbitrary reorientation maneuvers of the spacecraft can be accomplished using smooth feedback. If failure of one of the momentum wheel actuators occurs, we demonstrate that two momentum wheel actuators can be used to control the attitude of a rigid spacecraft and that arbitrary reorientation maneuvers of the spacecraft can be accomplished. Although the complete spacecraft equations are not controllable, the spacecraft equations are controllable under the restriction that the total angular momentum vector of the system is zero. The spacecraft dynamics under such a restriction cannot be asymptotically stabilized to any equilibrium attitude using a time- invariant continuous feedback control law, but discontinuous feedback control strategies are constructed that stabilize any equilibrium attitude of the spacecraft in finite time. Consequently, reorientation of the spacecraft can be accomplished using discontinuous feedback control. I. Introduction W E consider the attitude control of a spacecraft modeled as a rigid body. It is well known that three actuators, either gas jets or momentum wheels, can be used to control the attitude of a rigid spacecraft and that arbitrary reorientation maneuvers of the spacecraft can be accomplished using smooth feedback. 1 " 7 If failure of one of the actuators occurs, then one is left with only two actuators. In this paper, the attitude stabilization problem of a rigid spacecraft using only two control torques supplied by momentum wheel actuators is considered. Since we are considering a space- based system, the problem considered here, namely, the attitude stabilization of a spacecraft operating in an actuator failure mode, is an important control problem. It is assumed that the center of mass of the system consisting of the spacecraft and the momentum wheel actuators is fixed in space. Attitude stabilization of a rigid spacecraft using two momentum wheel actuators is not a mature subject in the literature. Controlla- bility results for a rigid spacecraft controlled by momentum wheel actuators are presented in Ref. 8. We mention that most of the previ- ous researchers have considered the problem of controlling a rigid spacecraft using less than three gas jet actuators. 8 " 23 Attitude stabi- lization of a rigid spacecraft using two gas jet actuators is considered in Refs. 8-13. References 14-23 consider the stabilization of the an- gular velocity equations of a rigid spacecraft using less than three gas jet actuators. In Ref. 19, an expression is given for the geo- metric phase 24 of the attitude of a rigid body with two momentum wheel actuators under the assumption that the total angular momen- tum vector of the system is zero. It is mentioned that the geometric phase can be used to compensate for the attitude drift of the rigid body. However, explicit control methods are not presented. Related work on spacecraft control appears in Refs. 25 and 26, but they do not consider the same problem being studied in this paper. We consider the attitude stabilization of a spacecraft using con- trol torques supplied by two momentum wheel actuators about axes Received Feb 16, 1993; revision received May 11, 1994; accepted for publication Sept. 6, 1994. Copyright © 1995 by the American Institute of Aeronautics and Astronautics, Inc. All rights reserved. * Lecturer, Department of Mechanical and Production Engineering. ''"Professor, Department of Aerospace Engineering. Member AIAA. * Assistant Professor, Department of Mechanical Engineering. spanning a two-dimensional plane orthogonal to a principal axis of the spacecraft. The first-order linearization of the complete space- craft dynamic equations at any equilibrium attitude has an uncon- trollable eigenvalue at the origin. Consequently, controllability and stabilizability properties of the spacecraft cannot be inferred using classical linearization ideas. The complete spacecraft dynamics is, in fact, not controllable. Under the assumption that the total angular momentum vector of the system is zero, the spacecraft dynamics is locally controllable at any equilibrium attitude. The spacecraft dynamics under such a restriction cannot be asymptotically sta- bilized to any equilibrium attitude using time-invariant continu- ous feedback. Nevertheless, two different discontinuous feedback control strategies are constructed that achieve reorientation of the spacecraft in finite time. Using the concept of geometric phase, 24 a discontinuous feedback control strategy is presented based on the nonholonomic control theory in Ref. 27. An alternate discontinuous feedback control strategy, based on the fact that rigid-body rotations do not commute, is also presented. This paper is based on our earlier work presented in Ref. 10 and is a companion to Refs. 11 and 12, which treat the attitude stabilization of a rigid spacecraft using two gas jet actuators. II. Kinematic and Dynamic Equations The orientation of a rigid spacecraft can be specified using vari- ous parametrizations of the special orthogonal group SO(3). Here we use the 3-2-1 Euler angle convention for parametrizing the ori- entation of the rigid spacecraft. 28 Consider an inertial X\X 2 X 3 co- ordinate frame; let * 1*2*3 be a coordinate frame aligned with the principal axes of the spacecraft with origin at the center of mass of the spacecraft. If the two frames are initially coincident, a se- ries of three rotations about the body axes performed in the proper sequence is sufficient to allow the spacecraft to reach any orienta- tion. The three rotations are a positive rotation of frame X\X 2 X^ by angle ^ about the X 3 axis (let x[x 2 x' 3 denote the resulting coor- dinate frame), a positive rotation of frame x(x 2 x' 3 by angle 0 about the x' 2 axis (let x"x 2 x'J denote the resulting frame), and a positive rotation of frame x'{x 2 x' 3 by angle 0 about the x" axis (let x\X2X$ denote the final coordinate frame). The corresponding rotation ma- trix is denoted as R(t/>, 9, (/>), where tj), 9, and </> are the Euler angles. We assume that the Euler angles are limited to the ranges -n < ^ < TT, -Ti/2 < 0 < n/2, -n < $ < TT. The 3-2-1 256

Upload: others

Post on 23-Mar-2020

0 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: Attitude Stabilization of a Rigid Spacecraft Using Two ... · of a rigid spacecraft and that arbitrary reorientation maneuvers of the spacecraft can be accomplished using smooth feedback.1"7

JOURNAL OF GUIDANCE, CONTROL, AND DYNAMICSVol. 18, No. 2, March-April 1995

Attitude Stabilization of a Rigid Spacecraft UsingTwo Momentum Wheel Actuators

Hariharan Krishnan*National University of Singapore, 0511 Singapore

N. Harris McClamroch^University of Michigan, Ann Arbor, Michigan 48109-2140

andMahmut Reyhanoglu*

King Fahd University of Petroleum and Minerals, Dhahran 31261, Saudi Arabia

It is well known that three momentum wheel actuators can be used to control the attitude of a rigid spacecraft andthat arbitrary reorientation maneuvers of the spacecraft can be accomplished using smooth feedback. If failureof one of the momentum wheel actuators occurs, we demonstrate that two momentum wheel actuators can beused to control the attitude of a rigid spacecraft and that arbitrary reorientation maneuvers of the spacecraft canbe accomplished. Although the complete spacecraft equations are not controllable, the spacecraft equations arecontrollable under the restriction that the total angular momentum vector of the system is zero. The spacecraftdynamics under such a restriction cannot be asymptotically stabilized to any equilibrium attitude using a time-invariant continuous feedback control law, but discontinuous feedback control strategies are constructed thatstabilize any equilibrium attitude of the spacecraft in finite time. Consequently, reorientation of the spacecraft canbe accomplished using discontinuous feedback control.

I. Introduction

W E consider the attitude control of a spacecraft modeled asa rigid body. It is well known that three actuators, either

gas jets or momentum wheels, can be used to control the attitudeof a rigid spacecraft and that arbitrary reorientation maneuvers ofthe spacecraft can be accomplished using smooth feedback.1"7 Iffailure of one of the actuators occurs, then one is left with only twoactuators. In this paper, the attitude stabilization problem of a rigidspacecraft using only two control torques supplied by momentumwheel actuators is considered. Since we are considering a space-based system, the problem considered here, namely, the attitudestabilization of a spacecraft operating in an actuator failure mode, isan important control problem. It is assumed that the center of massof the system consisting of the spacecraft and the momentum wheelactuators is fixed in space.

Attitude stabilization of a rigid spacecraft using two momentumwheel actuators is not a mature subject in the literature. Controlla-bility results for a rigid spacecraft controlled by momentum wheelactuators are presented in Ref. 8. We mention that most of the previ-ous researchers have considered the problem of controlling a rigidspacecraft using less than three gas jet actuators.8"23 Attitude stabi-lization of a rigid spacecraft using two gas jet actuators is consideredin Refs. 8-13. References 14-23 consider the stabilization of the an-gular velocity equations of a rigid spacecraft using less than threegas jet actuators. In Ref. 19, an expression is given for the geo-metric phase24 of the attitude of a rigid body with two momentumwheel actuators under the assumption that the total angular momen-tum vector of the system is zero. It is mentioned that the geometricphase can be used to compensate for the attitude drift of the rigidbody. However, explicit control methods are not presented. Relatedwork on spacecraft control appears in Refs. 25 and 26, but they donot consider the same problem being studied in this paper.

We consider the attitude stabilization of a spacecraft using con-trol torques supplied by two momentum wheel actuators about axes

Received Feb 16, 1993; revision received May 11, 1994; accepted forpublication Sept. 6, 1994. Copyright © 1995 by the American Institute ofAeronautics and Astronautics, Inc. All rights reserved.

* Lecturer, Department of Mechanical and Production Engineering.''"Professor, Department of Aerospace Engineering. Member AIAA.* Assistant Professor, Department of Mechanical Engineering.

spanning a two-dimensional plane orthogonal to a principal axis ofthe spacecraft. The first-order linearization of the complete space-craft dynamic equations at any equilibrium attitude has an uncon-trollable eigenvalue at the origin. Consequently, controllability andstabilizability properties of the spacecraft cannot be inferred usingclassical linearization ideas. The complete spacecraft dynamics is,in fact, not controllable. Under the assumption that the total angularmomentum vector of the system is zero, the spacecraft dynamicsis locally controllable at any equilibrium attitude. The spacecraftdynamics under such a restriction cannot be asymptotically sta-bilized to any equilibrium attitude using time-invariant continu-ous feedback. Nevertheless, two different discontinuous feedbackcontrol strategies are constructed that achieve reorientation of thespacecraft in finite time. Using the concept of geometric phase,24 adiscontinuous feedback control strategy is presented based on thenonholonomic control theory in Ref. 27. An alternate discontinuousfeedback control strategy, based on the fact that rigid-body rotationsdo not commute, is also presented.

This paper is based on our earlier work presented in Ref. 10 and isa companion to Refs. 11 and 12, which treat the attitude stabilizationof a rigid spacecraft using two gas jet actuators.

II. Kinematic and Dynamic EquationsThe orientation of a rigid spacecraft can be specified using vari-

ous parametrizations of the special orthogonal group SO(3). Herewe use the 3-2-1 Euler angle convention for parametrizing the ori-entation of the rigid spacecraft.28 Consider an inertial X\X2X3 co-ordinate frame; let * 1*2*3 be a coordinate frame aligned with theprincipal axes of the spacecraft with origin at the center of massof the spacecraft. If the two frames are initially coincident, a se-ries of three rotations about the body axes performed in the propersequence is sufficient to allow the spacecraft to reach any orienta-tion. The three rotations are a positive rotation of frame X\X2X^by angle ̂ about the X3 axis (let x[x2x'3 denote the resulting coor-dinate frame), a positive rotation of frame x(x2x'3 by angle 0 aboutthe x'2 axis (let x"x2x'J denote the resulting frame), and a positiverotation of frame x'{x2x'3 by angle 0 about the x" axis (let x\X2X$denote the final coordinate frame). The corresponding rotation ma-trix is denoted as R(t/>, 9, (/>), where tj), 9, and </> are the Eulerangles. We assume that the Euler angles are limited to the ranges-n < ^ < TT, -Ti/2 < 0 < n/2, -n < $ < TT. The 3-2-1

256

Page 2: Attitude Stabilization of a Rigid Spacecraft Using Two ... · of a rigid spacecraft and that arbitrary reorientation maneuvers of the spacecraft can be accomplished using smooth feedback.1"7

KRISHNAN, MCCLAMROCH, AND REYHANOGLU: ATTITUDE STABILIZATION 257

c.m of system

/

V

/

\

/

^

d2 N;

/nf

i>

u___ _

*̂— d-

1l|

Fig. I Spacecraft system.

Euler angle system is commonly used to represent the orientationof aerospace systems.28 Moreover, the 3-2-1 Euler angle system hasa singularity when 9 — ±7T/2, whereas a number of other Eulerangle systems have a singularity when 0 = 0. Since it is con-ventional in control theory to formulate the stabilization problemabout the origin, many of the Euler angle systems with singularityat 9 = 0 would render the formulation ill posed. The Euler an-gle system used here has no additional restrictions in comparisonto other Euler angle systems, and the control strategy developedhere can be modified to suit other Euler angle representations aswell.

Suppose a)i,co2, <&$ are the principal axis components of the ab-solute angular velocity vector u; of the spacecraft. Then we have28

0 — co i 4- 0)2 sin 0 tan 9 H- co^ cos 0 tan 9 (1)

9 = a}2 cos (j) — COT, sin 0 (2)

VT = a>2 sin 0 sec 9 + co3 cos 0 sec 9 (3)

Next we consider the dynamic equations that describe the evolutionof the angular velocity components of the spacecraft. Consider twomomentum wheel actuators, wheels 1 and 2, spinning about axesdefined by unit vectors b\,b2 fixed in the spacecraft (see Fig. 1).The center of mass of wheel 1 lies on the axis defined by b\, andthe center of mass of wheel 2 lies on the axis defined by £2. Controltorques —u\ and — u2 are supplied to wheels 1 and 2 about the axisdefined by b\ and £2, respectively, by motors fixed in the spacecraft.Consequently, equal and opposite torques u\ and u2 are exerted bywheels 1 and 2, respectively, on the spacecraft. We assume that b\defines a principal axis for wheel 1, which is symmetric about thataxis, and Z>2 defines a principal axis for wheel 2, which is symmetricabout that axis. Further b\ and b2 span a two-dimensional plane thatis orthogonal to a principal axis of the spacecraft. Without loss ofgenerality, b{ and b2 are assumed to be of the form

= (b2x,b2y,Q)T

(4)

(5)

The mass of the spacecraft, wheel 1, and wheel 2 are denotedas m0, mi, and ra2, respectively, and p0, p1? p2 denote the positionvectors of the center of mass of the spacecraft, wheel 1, and wheel 2,respectively, with respect to the center of mass of the whole system.Thus from the location of the wheels

p{ = (6)

(7)

where d\, d2 are constants that are the distances of wheels 1 and 2from the center of mass of the spacecraft along the unit vectors b\and Z»2, respectively. Since, by the definition of center of mass,

(8)

further manipulation of Eqs. (6-8) gives expressions for p0, p t, andp2, which we denote as p, = (p /JC, p / y , 0)r, i = 0, 1, 2. The total

angular momentum vector of the system is given, in the spacecraftbody frame, by

, 9,

where

Piy

/=0 1=1

O^P/y 0

A? 0

(9)

(10)

/ =0,1,2

v = /! (u; + MO + I2(u + b202)

(11)

(12)

(13)

(14)

where /o,/i, and 72 denote the inertial tensors of the spacecraft,wheel 1, and wheel 2, respectively, ji is the moment of inertia ofwheel 1 about the axis defined by b\, j2 is the moment of inertiaof wheel 2 about the axis defined by b2, and 0i, 92 are the anglesof rotation of wheels 1 and 2 about the axes defined by b{ and b2,respectively. The vector v in Eq. (9), which is defined by Eq. (14),is the sum of the angular momentum of wheels 1 and 2 relative tothe spacecraft. Here H denotes the angular momentum vector ofthe system expressed in the inertial coordinate frame. The angularmomentum vector H is a constant since there is no external momentabout the center of mass of the system. Suppose MI and u2 are thecontrol torques; then

v = -(b\u\ -f £2i/2)

Differentiating Eq. (9) with respect to time, we obtain

/cj = S(u)R(i£>, 9, 0)# + biu} + b2u2

where

(15)

(16)

0 Ct>3

-W3 0(W2 — ft>l

CD\0

Note that

70 = diag(/oi,/02, /os)

/i = block diag(/u, 712)

12 = block diag(/2i, 722)

where/n,/2i are invertible 2 x 2 matrices, 70i, 702, /os, /i2, /22 arenonzero real numbers, and therefore / is a positive-definite matrixof the form

J = block diag(/, ,y2) (17)

where J\ is an invertible 2x2 matrix and J2 is a nonzero real number.

III. Controllability and Stabilization PropertiesIn this section we consider the controllability and stabilizability

properties of the spacecraft dynamics controlled by two momentumwheel actuators. Define

^ ,-l1

^2,(18)

Page 3: Attitude Stabilization of a Rigid Spacecraft Using Two ... · of a rigid spacecraft and that arbitrary reorientation maneuvers of the spacecraft can be accomplished using smooth feedback.1"7

258 KRISHNAN, MCCLAMROCH, AND REYHANOGLU: ATTITUDE STABILIZATION

From Sec. II the complete spacecraft dynamics can be rewritten as

7_i „ r w i iJ l _ t i*3^u7;/vi;(/j, c/, </;;/! i-

L o

Define the Lie bracket of two vector fields/i (x) and/2(jt) as29

;,= ' U(27 hL°(lx2) J^ J

(19)

0 = ct>1 -f- o>2 sin 0 tan # + 0)3 cos 0 tan # (20)

0 = o)2 cos 0 — o;3 sin 0 (21)

•ft = 0)2 sin 0 sec 0 + &>3 cos 0 sec 9 (22)

where // is a constant vector.The first-order linearization of the complete spacecraft dynamic

Eqs. (19-22) at any equilibrium attitude has an uncontrollable eigen-value at the origin. Consequently, the controllability and stabiliz-ability properties of the complete spacecraft dynamics cannot beinferred using classical linearization ideas. However, from Eqs. (4),(5), and (12-14) and the definition

c = (0,0, l)r

we have CTV — 0. Therefore from Eq. (9) we have

>, 0,

(23)

(24)

Since H is a constant vector, this equation represents a constraint onthe motion of the spacecraft irrespective of the controls applied. Thusthe complete spacecraft dynamics is not completely controllable.Therefore we ask the following question: What restricted controland stabilization properties of the spacecraft can be demonstratedin this case? Our analysis begins by demonstrating that, under anappropriate restriction of interest, the spacecraft equations have re-stricted controllability and stabilizability properties.

Consider Eqs. (19-22) and suppose the angular momentum vectorH of the system is zero. From Eqs. (17), (23), and (24) it followsthat the angular velocity component of the spacecraft about theuncontrolled principa' axis is identically zero, i.e., 0)3 = 0. Undersuch a restriction, the reduced spacecraft dynamics are described by

= Ml

> — o)\ + ah sin 0 tan 0

0 = 0)2 COS 0

}jf = o)2 sin 0 sec 0

(25)

(26)

(27)

(28)

(29)

Notice that the first-order linearization of Eqs. (25-29) at any equi-librium has an uncontrollable eigenvalue at the origin. Thereforeanalysis of the controllability and stabilizability properties of thereduced spacecraft dynamics requires inherently nonlinear tech-niques. Equations (25-29) are of the form

x =f(x) + gilli Jrg2U2 (30)

where jc = (o)\, o)2, 0, 0, i/0r € M where M denotes the set

M = [x:u), e /?, / = 1,2, 0, V € [-TT, TT],

0 € (-0.57T,0.57T)} (31)

and/(jt), g\, ̂ 2 are vector fields defined appropriately on M.Let r(p, t) denote the set of reachable states from the initial state

p in time exactly t for Eq. (30). The following definition is standard(see Refs. 29 and 30).

Definition L Consider the system (30) and let/? e M:1) The system is said to be accessible at p if, for any T >

0, U/< r r(p, 0 has a nonvoid interior with respect toM. If this holdsfor all p <E M, then the system is said to be accessible.

2) The system is said to be small time locally controllable (STLC)at/? if, for any T > O,/? is an interior point of Ur<r r(/7, t).

(32)

The following results follow directly based on an analysis similarto that in Ref. 27.

Theorem L The reduced dynamics of a spacecraft controlled bytwo momentum wheel actuators are STLC at any equilibrium.

Proof. The vector f ieldsg l ,g2 , fei,/], fe2,/], [fe2,/], fei,/]]span a five dimensional space at every x e M. Thus the accessibil-ity Lie algebraic rank condition29 is satisfied and hence the reducedspacecraft dynamics are accessible, which is a necessary conditionfor STLC. Following Ref. 30 let Br(x) denote the smallest Lie al-gebra of vector fields containing/,g\,g2. Let B be any bracketin Br(x). Now denote 8°(B), 51 (#), 82(B) as the number of occur-rences of the vector fields/,gi,£2, respectively, in the bracket B.The degree of B is equal to the value of X^o ^' (^* ̂ e Sussmancondition for small time local controllability at any equilibrium isthat the so-called bad brackets, the brackets with 5° odd and 8l, 82

even, must be a linear combination of brackets of lower degree atthat equilibrium. From the proof of accessibilty given above it isclear that any bracket of degree greater than 4 can be expressed asa linear combination of lower order brackets at any equilibrium.Moreover, the degree of a bad bracket must necessarily be odd. Thebad bracket of degree 1 is /, which vanishes at any equilibrium.The bad brackets of degree 3 are [ g \ , [g\,f]] and [g2, [g2,/]] andboth are identically zero vector fields. Thus the sufficient conditionin Ref. 30 is satisfied at any equilibrium, and therefore the reducedspacecraft dynamics are STLC.

Theorem 2. The reduced dynamics of a spacecraft controlledby two momentum wheel actuators cannot be asymptotically stabi-lized to any equilibrium using a time-invariant continuous feedbackcontrol law, but the reduced dynamics can be asymptotically sta-bilized to any equilibrium using a piecewise continuous feedbackcontrol law.

Proof. Brockett's neccesary condition for the existence of atime-invariant continuous feedback control law that asymptoticallystabilizes any equilibrium of Eq. (30) is that the image of the map

(x, M I , M2) (33)

must contain a neighborhood of the origin.17-31'32 Note that the sys-tem defined by Eqs. (25-29) is a dynamic extension31-32 of thesystem defined by Eqs. (27-29) with o)\ , o)2 as its control inputs,which can be expressed in the form

(34)

where y = (0, 0, \/f)T and/i,/2 are defined appropriately. At anyequilibrium ye — (06>, 9e, i/^)7 ',

rank{/,(y,),/2(y,)} = 2

The number of inputs in Eq. (34) is 2, whereas the dimension ofthe state space is 3. Therefore from Refs. 17 and 34 the systemdoes not satisfy Brockett's necessary condition at any equilibrium.From Refs. 31 and 32, it is clear that the topological obstructionto stabilizability discovered by Brocket! is clearly preserved underdynamic extension, i.e., if Eqs. (27-29) do not satisfy Brockett'snecessary condition at (0^, 9e, VO7> then Eqs. (25-29) do not sat-isfy Brockett's necessary condition at (0, 0, </>e, 9e, V^)r- Thus thereduced spacecraft dynamics cannot be asymptotically stabilized toany equilibrium using a time-invariant continuous feedback controllaw. The second part of the theorem is a consequence of a result dueto small time local controllability in Ref. 33, which states that if asystem is real analytic and STLC at any equilibrium, then there ex-ists a piecewise continuous feedback controller that asymptoticallystabilizes the system to that equilibrium.

Note that in Theorem 2, by time-invariant feedback control lawwe mean any feedback control law that does not depend explicitlyon time. Since Eqs. (25-29) are STLC at any equilibrium, fromDefinition 1 it is clear that starting from any equilibrium an openneighborhood of the equilibrium can be reached by trajectories of

Page 4: Attitude Stabilization of a Rigid Spacecraft Using Two ... · of a rigid spacecraft and that arbitrary reorientation maneuvers of the spacecraft can be accomplished using smooth feedback.1"7

KRISHNAN, MCCLAMROCH, AND REYHANOGLU: ATTITUDE STABILIZATION 259

the system for any time T > 0. Since the system is real analytic,the argument can be reversed (see Refs. 30, 31, and 33). Thus forany T > 0 there exists an open neighborhood of any equilibriumstarting from which the equilibrium can be reached within time T.Moreover, Theorem 2 states that the equilibrium can be asymptoti-cally stabilized using piecewise continuous feedback. This is a localproperty. However, notice that Eqs. (25-29) have a large set of equi-librium points that are all connected. Typically any state of the formcoi = 0, 0)2 = 0, 0, 0, \/f are arbitrary is an equilibrium. Thus ifone knows how to steer any given state in M to some equilibrium,and if one knows how to steer between equilibrium points, then theasymptotic stabilization can be made global by patching togetherthe various piecewise continuous feedback control laws. In the nextsection two different feedback control strategies are developed thatasymptotically stabilize the reduced spacecraft dynamics from anyinitial state in M to any equilibrium attitude in M.

We conclude this section by summarizing the implications of theproperties stated above. Suppose the angular momentum vector H iszero. Then the spacecraft controlled by two momentum wheel actu-ators can be controlled to any equilibrium attitude, but the feedbackcontrol law must necessarily be discontinuous. Thus reorientationof the spacecraft can be achieved under the restriction H = 0; IfH ^ 0, reorientation of the spacecraft to an equilibrium attitudecannot be achieved.

IV. Feedback Stabilization AlgorithmsWe restrict our study to the class of discontinuous feedback con-

trollers in order to asymptotically stabilize the reduced spacecraftdynamics described by state Eqs. (25-29). An algorithm generatinga discontinuous feedback control that asymptotically stabilizes anyequilibrium can be constructed, as suggested by the controllabil-ity properties of the system. Without loss of generality, we assumethat the equilibrium to be stabilized is the origin. We present twodifferent discontinuous control strategies that stabilize the origin ofEqs. (25-29) in finite time.

A. Feedback Stabilization Based on Nonholonomic Control TheoryConsider a diffeomorphism defined by

y{ = cos 0/w(sec 0 -h tan 0) -h ̂ sin 0

y2 = o)2 sec 9 - y4y5

y3 = <t>y4 = a)i + 0)2 sin 0 tan 9

v5 = sin 0/n(sec 0 + tan 0) — T/T cos 0

If we now define the feedback relations

[~W l 1 _ f"~ s m0 s m^ 0 ~ V5 sin0 sin0)1L "2 J ~~ L cos ̂ ^5 cos ̂ J

K v\ \ /cos0ys sin0 sec2 9o£

J + (

(35)

(36)

(37)

(38)

(39)

—y\y\ + cos 0 ( sec 0 tan Qa>\ — y5y4 tan 9o)2) \ 1cos 0 (v4 tan Oa)2 + sin 0 sec2 Oaify ) \

then the reduced spacecraft dynamics (25)-(29) are described in thenew variables by the normal form equations

-(y\ =

y* = v2

ys = y*y\

(41)

(42)(43)

(44)

(45)

Notice that Eqs. (35-39) define a global diffeomorphism, and there-fore o)i=o)2 = (/) = 9 = \lf = 0 implies that yl = y2 = y3 = y4 =v5 = 0 and vice versa (see Appendix). Hence asymptotic stabiliza-tion of Eqs. (25-29) to the origin is equivalent to asymptotic stabi-lization of the normal-form equations (41^4-5) to the origin; hencewe consider asymptotic stabilization of the normal-form equations.The normal-form equations (41-45) are in a familiar form that hasbeen studied in Ref. 27 and therefore can be stabilized by the fol-lowing discontinuous control strategy:

1) Transfer the initial state of the normal-form equations (41-45)to the equilibrium state (0, 0, 0,0, y5

l), for some yj, in finite time.2) Next, traverse a closed path y in the (yi, y3) space in finite

time, where the path y is selected to satisfy

(46)

This transfers the state (0, 0, 0, 0, y5!) to the origin in finite time.

Here we consider a rectangular path y in the (yi, y3) space formedby line segments from (0, 0) to (y*, 0), from (y*, 0) to (y*, yj), from(y*> ^3) to (0> y3)» an(* fr°m (0, y3) to (0, 0). For such a path, theline integral in Eq. (46) can be explicitly evaluated as y*y% so thatEq. (46) becomes

(47)

and the parameters y* and yj specifying the particular rectangularpath are chosen to satisfy the above equation.

Throughout, assume k > 0, and define

X2\X2\ )

2k >0)° r |

2k <0}°r|{Xi =

X2\X2\Xl ' 2k

X2\X2\Xl 2k

3 and x2 = 0}

= 0 and ;c2 > 0

= 0 and x2 < 0

k if

-k if

0 if

The function G(x\, #2) is the time optimal control law for a doubleintegrator. We use the well-known property (see Ref. 35, pp. 507-514) that any initial state of the system

is transferred to the final state (Jci , 0) in a finite time.We now present a specific feedback control algorithm that stabi-

lizes the spacecraft to the origin in finite time; this feedback controlalgorithm implements the approach just described.

Maneuver L Apply

v2 = -G(y3,y4)

until (yi, y2, y3, y4, y5) = (0, 0, 0, 0, y^) where y^ is arbitrary; thengo to maneuver 2.

Maneuver 2. _ If y5[ > 0, choose y* = — yj = ^yj; else choose

i -y*,y2)

v2 = -G(y3,y4)

until (yi, y2, y3, y4, y5) = (y*, 0, 0, 0, y\)\ then go to maneuver 3.Maneuver 3. Apply

vi = -G(y{ -y*,y2)

until (yi, y2, y3, y4, y5) = (y*, 0, yj, 0, 0); then go to maneuver 4.

Page 5: Attitude Stabilization of a Rigid Spacecraft Using Two ... · of a rigid spacecraft and that arbitrary reorientation maneuvers of the spacecraft can be accomplished using smooth feedback.1"7

260 KRISHNAN, MCCLAMROCH, AND REYHANOGLU: ATTITUDE STABILIZATION

Maneuver 4. Apply

= -G(yi,y2)

until (yi, y2, ys, y4, ys) = (0, 0, yj, 0, 0); then go to maneuver 5.Maneuver 5. Apply

vi = -G(yi,y2)

v2 = -G(y3,y4)

until (yi, y2, ys, y4, ys) = (0, 0> 0, 0, 0); then go to maneuver 2.It can be verified that the execution of maneuver 1 transfers the

initial state of the normal-form equations to the equilibrium state(0, 0, 0, 0^ y5

!) for some y5* in finite time. Subsequent execution ofmaneuvers 2-5 then transfers the state (0, 0, 0, 0, yj) to the originin finite time. This control algorithm is nonclassical and involvesswitching between various feedback functions. Justification that itstabilizes the origin of the normal-form equations (41-45) in finitetime follows as a consequence of the construction procedure. Sincestabilization of the normal-form equations to the origin is equiva-lent to stabilization of the state equations (25-29) to the origin, weconclude that the control inputs u\ and u2 given by Eq. (40) with v\and v2 defined by the above control algorithm stabilize the reducedspacecraft dynamics described by Eqs. (25-29) to the equilibrium(a)\, 0)2, 0, 0, VO = (0, 0, 0, 0, 0) in finite time. A computer im-plementation of the feedback control strategy can be easily carriedout.

B. Feedback Stabilization Based on Rigid-BodyRotational Characteristics

We now present an alternate discontinuous feedback control strat-egy for stabilizing the origin of Eqs. (25-29) in finite time. Thisstrategy requires that the spacecraft undergo a sequence of specifiedmaneuvers and is based on the fact that rigid-body rotations do notcommute. The physical interpretation of the sequence of maneu-vers that transfers any initial state of Eqs. (25-29) to the origin is asfollows:

1) Transfer the initial state of Eqs. (25-29) to any equilibriumstate in finite time; i.e., bring the spacecraft to rest.

2) Transfer the resulting state to an equilibrium state where 0 = 0in finite time, i.e., so that the spacecraft is at rest with 0 = 0.

3) Transfer the resulting state to an equilibrium state where 0 =0, 9 = 0 in finite time, i.e., so that the spacecraft is at rest with0 = 0, 0 = 0.

4) Transfer the resulting state to an equilibrium state where 0 =|TT, 0 = 0 in finite time, i.e., so that the spacecraft is at rest with0= I7r,0 = 0.

5) Transfer the resulting state to the equilibrium state(0, 0, ±TT, 0, 0) in finite time.

6) Transfer the equilibrium state (0, 0, ^TT, 0, 0) to the equilibriumstate (0, 0, 0, 0, 0) in finite time.

We now present a feedback control algorithm that stabilizes thespacecraft to the origin in finite time; this feedback control algorithmimplements the approach just described.

Maneuver 1. Apply

u\ = —k sign o)\

HI — —k sign a>2

until (coi , co2) = (0, 0); then go to maneuver 2.Maneuver 2. Apply

Maneuver 3. Apply

M I =0

u2 = — G(0, 0)2)

until (a)\ , &>2, 0, 0) = (0, 0, 0, 0); then go to maneuver 4.Maneuver 4. Apply

= -G(0- 57T,

until (&>i, 0)2, 0, 0) = (0, 0, |TT, 0); then go to maneuver 5.Maneuver 5. Apply

=0

until (&>i, a>2, 0, 0, VO = (0, 0, ^TT, 0, 0); then go to maneuver 6.Maneuver 6. Apply

«2 =

until (&>i, &>2, 0) = (0, 0, 0); then go to maneuver 3.

until (co\ , 0)2, 0, 0, VO = (0, 0, 0, 0, 0, 0); then go to maneuver 1.It can be verified that the execution of maneuver 1 transfers the ini-

tial state of Eqs. (25-29) to the equilibrium state (0, 0, 01, 01, V1)for some 01, 01, T/^1 in finite time. Execution of maneuver 2 thentransfers the state (0, 0, 01, 01, V1) to the state (0, 0, 0, fl1,.^1);execution of maneuver 3 then transfers the state (0, 0, 0, 01, i/r1)to the state (0, 0, 0, 0, T/^1); execution of maneuver 4 then trans-fers the state (0, 0, 0, 0, V1) to the state (0, 0, ±n, 0, V1); execu-tion of maneuver 5 then transfers the state (0,0, |TT, 0, \/fl) tothe state (0, 0, |TT, 0, 0); finally, execution of maneuver 6 trans-fers the state (0, 0, \n, 0, 0) to the state (0, 0, 0, 0, 0). This strategyis discontinuous and nonclassical in nature. A computer implemen-tation of the feedback control strategy can be easily carried out.

C. CommentsWe have introduced two different control laws that transfer any

initial state of Eqs. (25-29) to the origin in finite time. Both controlstrategies are nonclassical and have been developed based on a care-ful study of the dynamics of the spacecraft system. Each of thesecontrol laws is in feedback form, since the control values dependon the current state; and each control law is discontinuous. The firstconstruction procedure makes use of the nonholonomic features ofthe reduced spacecraft dynamics, whereas the second constructionprocedure uses physical insight about rigid-body rotations. The firstcontrol law constructed makes use of both control actuators simul-taneously, whereas the second control law (after maneuver 1) usesonly a single actuator at a time. The two discontinuous feedback con-trol laws exhibited are illustrations of the class of control laws thatasymptotically stabilize Eqs. (25-29) to the origin. There are othermaneuver sequences, and corresponding feedback control laws, thatwill also achieve the desired attitude stabilization of the spacecraft.But each such strategy is necessarily discontinuous.

One of the advantages of the development in Sees. IV. A and IV.Bis that feedback control strategies are constructed that guarantee atti-tude stabilization in a finite time. The total time required to completethe spacecraft reorientation is the sum of the times required to com-plete the sequence of maneuvers described. It should be clear thatthe time required to complete each maneuver depends on the sin-gle positive parameter k in the corresponding control law. There isa trade-off between the required control levels, determined by theselection of k, and the resulting times to complete each of the ma-neuvers and hence the total time required to reorient the spacecraft.In particular, the time to reorient the spacecraft from a given initialstate to the origin can be expressed as a function of the value of theparameter k and of the initial state.

Page 6: Attitude Stabilization of a Rigid Spacecraft Using Two ... · of a rigid spacecraft and that arbitrary reorientation maneuvers of the spacecraft can be accomplished using smooth feedback.1"7

KRISHNAN, MCCLAMROCH, AND REYHANOGLU: ATTITUDE STABILIZATION 261

We have demonstrated, by construction, the closed-loop proper-ties for the special feedback control strategies presented. Our anal-ysis was based on an ideal model assumption. Further robustnessanalysis is required to determine effects of model uncertaintiesand external disturbances. Unfortunately, such robustness analysisis quite difficult since the closed-loop vector fields are necessarilydiscontinuous. Perhaps, feedback control strategies that stabilizethe spacecraft attitude, different from ones presented in this paper,would provide improved closed-loop robustness. These issues areto be studied in future research.

The Euler angle system used in this paper has a singularity when9 = ±^rr. Therefore the results of the feedback control strategiesare valid only in the region — n < ^ < T T , — |TT < 0 < \n, —n< (p < n. For the stabilization problem being considered in thispaper, it is not clear how we could develop a control strategy thatmay be global (i.e., free of the Euler angle singularity) by introduc-ing other representations such as quaternions for representing theorientation of the spacecraft. This is a subject of future research. Tothe best of our knowledge, there has been no previous work wherean explicit control law is presented for reorientation of a spacecraftwith just two momentum wheel actuators. Thus there are no previousresults for comparison on the problem considered in this paper.

V. SimulationWe illustrate the results of the paper using an example. Consider

a rigid spacecraft with no control torque about the third principalaxis and two control torques, generated by momentum wheel ac-tuators, are applied about the other two principal axes. Thereforethe vectors b\ and b2 are given by b\ — (1, 0, O)7, b2 = (0, 1, 0)r.For our simulation, we use the spacecraft parameters used in Ref. 2.The mass of the spacecraft, m0, is 500 kg, and the masses of themomentum wheels, m\ and m2, are each 5 kg. The center of massof the momentum wheels are located at a distance 0.2 m from thecenter of mass of the spacecraft, i.e., d\ — d2 = 0.2 m. The momentof inertia of the wheels about its axis of rotation is 0.5 kg- m2, i.e.,jl = j2 = 0.5. The inertial tensor of the spacecraft and the twomomentum wheels are given as

/o = diag(86.215, 85.07, 113.565) Kg • m2

/! = diag(0.5, 0.25, 0.25) Kg • m2

72 = diag(0.25, 0.5, 0.25) Kg • m2

Time in Seconds

Fig. 2 Euler angles.

4 6Time in Seconds

Radic

1.5

1

0.5

Radians 0Per

Second-0.5

Meters

4 6Time in Seconds

Fig. 4 Control torques.

6 8 10Time in Seconds

Fig. 5 Euler angles.

6 8 10Time in Seconds

12

Fig. 6 Angular velocities.

80604020

1 0-20-40-60-80100

(

-

--

-

-

i i 1 iUl — .-

-

-

-

) 2 4 6 8 10 12 1Time in Seconds

Fig. 3 Angular velocities.

Fig. 7 Control torques.

Using these parameters, the inertial matrix J can be calculated as

J = diag(86.7, 85.5, 114.5) Kg • m2

approximately. The complete dynamics of the spacecraft systemdefined by Eqs. (19-22) is not controllable, but we consider therestriction that the angular momentum vector H = 0. Consequently,we are interested in stabilizing the reduced spacecraft dynamicsdescribed by Eqs. (25-29) to the equilibrium (&> l 5 a)2, 0, 0, ̂ ) =(0, 0, 0, 0, 0). The spacecraft is initially at rest (i.e., co0, = 0% = 0)with an initial orientation given by the Euler angles 0 = n, 0° =0.257T, and ̂ ° = -0.5*.

First, a computer implementation of the feedback control algo-rithm specified in Sec. IV.A was used to stabilize the spacecraft tothe origin. The value of the gain k was chosen as 1. The time re-sponses of the Euler angles, angular velocities, and control torquesare shown in Figs. 2, 3, and 4, respectively. After a total maneuver

Page 7: Attitude Stabilization of a Rigid Spacecraft Using Two ... · of a rigid spacecraft and that arbitrary reorientation maneuvers of the spacecraft can be accomplished using smooth feedback.1"7

262 KRISHNAN, MCCLAMROCH, AND REYHANOGLU: ATTITUDE STABILIZATION

time of 11.77 s, o){ = o)2 = (/> = 0 = V = 0. Next, a com-puter implementation of the feedback control algorithm specifiedin Section IV.B was used to stabilize the spacecraft to the origin.The value of the gain k was chosen as 1. The time responses of theEuler angles, angular velocities, and control torques are shown inFigs. 5, 6, and 7, respectively. After a total maneuver time of 13 s,a)^ = o)2 = (/) = 9 = ty = 0.

VI. ConclusionThe attitude stabilization problem of a spacecraft using control

torques supplied by two momentum wheel actuators about axesspanning a two-dimensional plane orthogonal to a principal axishas been considered. The complete spacecraft dynamics are notcontrollable. However, the spacecraft dynamics are controllable un-der the restriction that the total angular momentum vector of thesystem is zero. The spacecraft dynamics under such a restrictioncannot be asymptotically stabilized using time-invariant continuousfeedback, but discontinuous feedback control strategies have beenconstructed that stabilize the spacecraft to any equilibrium attitudein finite time. The results of the paper show that it is possible toconstruct control laws based on a study of the particular spacecraftdynamics for reorienting a spacecraft using two momentum wheelactuators.

AppendixFrom Eqs. (35-39), it is clear that col=a)2 = <l> = 0 = 'fr = Q

implies that y\ = y2 = y$ = y4 = y5 = 0. Consider the inversionof Eqs. (35-39). From Eq. (37), we have

}>i~|y2J

0 = 3>3

From Eqs. (35) and (39) we have

[~cos0 sin0 1 f~(/nsec0 + tan#)~l|_ sin 0 — cos 0 J |_ V J

Inverting the above equation, we get

and

Therefore

Now

M(sec 9 + tan 6) = y\ cos y3 + ys sin y3

sec 9 + tan 9 — exp(yi cos y3 + ys sin y3)

sec 9 — tan 9 =1

sec# +tan#Therefore

sec 9 — tan 9 = exp(—yi cos y3 — y5 sin y3)

Thus we have

0 = tan-1{0.5[exp(yi cosy3 + y5 siny3)

- exp(-y! cosy3 - y5 siny3)]}

From Eqs. (36) and (38) we have

=y4-

sec#

sec#sin y3 tan 9

where

tan# = 0.5[exp(;yi cosys-i-ys sin<y3)-exp(-y1 cosy3-y5 sin^3)]

and

sec 9 = 0.5[expO>i cos v3 + y5 sin y3)+exp(-y! cos y3 -y5 sin y3)]

Now it is clear that yi = y2 = y3 = y4 = ys = 0 implies that co\ =o)2 = (f) = 9 = \l/ = 0. Moreover, the diffeomorphism is global inthe interval — n < (/) < n, — \n < 0 < \n, —n < ty < n, a>i e Rand 0)2 e R.

AcknowledgmentsThis work was partially supported by National Science Founda-

tion Grant MSS-9114630 and by NASA Grant NAG-1-1419.

References^adali, S. R., "Variable Structure Control of Spacecraft Large-Angle

Maneuvers," Journal of Guidance, Control, and Dynamics, Vol. 9, No. 2,1986, pp. 235-239.

2Vadali, S. R., and Junkins, J. L., "Optimal Open-Loop and Stable Feed-back Control of Rigid Spacecraft Attitude Maneuvers," Journal of the As-tronautical Sciences, Vol. 32, No. 2, 1984, pp. 105-122.

3Wen, J. T., and Kreutz-Delgado, K., "The Attitude Control Problem,"IEEE Transactions on Automatic Control, Vol. 36, No. 10, 1991, pp. 1148-1161.

4Wie, B., and Barba, P. M., "Quaternion Feedback for Spacecraft LargeAngle Maneuvers," Journal of Guidance, Control, and Dynamics, Vol. 8,No. 3, 1985, pp. 360-365.

5Meyer, G., "Design and Global Analysis of Spacecraft Attitude ControlSystems," NASA Tech. Rept. R-361, March 1971.

6Dwyer, T. W. A., Ill, "Exact Nonlinear Control of Large Angle RotationalManeuvers," IEEE Transactions on Automatic Control, Vol. 29, No. 9,1984,pp. 769-774.

7Dwyer, T. W. A., Ill, "Exact Nonlinear Control of Spacecraft SlewingManeuvers with Internal Momentum Transfers," Journal of Guidance, Con-trol, and Dynamics, Vol. 9, No. 2, 1986, pp. 240-247.

8Crouch, P. E., "Spacecraft Attitude Control and Stabilization: Applica-tions of Geometric Control Theory to Rigid Body Models," IEEE Transac-tions on Automatic Control, Vol. 29, No. 4, 1984, pp. 321-331.

9Byrnes, C. L, and Isidori, A., "On the Attitude Stabilization of RigidSpacecraft," Automatica, Vol. 27, No. 1, 1991, pp. 87-95.

10Krishnan, H., McClamroch, N. H., and Reyhanoglu, M., "On the Atti-tude Stabilization of a Rigid Spacecraft Using Two Control Torques," Pro-ceedings of the American Control Conference (Chicago, IL), 1992, pp. 1990-1995.

^Krishnan, H., Reyhanoglu, M., and McClamroch, N. H., "Attitude Sta-bilization of a Rigid Spacecraft Using Gas Jet Actuators Operating in aFailure Mode," Proceedings of the IEEE Conference on Decision and Con-trol (Tucson, AZ), Inst. of Electrical and Electronics Engineers, 1992, pp.1612-1617.

12Krishnan, H., Reyhanoglu, M., and McClamroch, N. H., "Attitude Sta-bilization of a Rigid Spacecraft Using Two Control Torques: A NonlinearControl Approach Based on the Spacecraft Attitude Dynamics," Automatica,Vol. 30, No. 6, 1994, pp. 1023-1027.

13Tsiotras, P., and Longuski, J. M., "On Attitude Stabilization of Sym-metric Spacecraft with Two Control Torques," Proceedings of the AmericanControl Conference (San Francisco, CA), 1993, pp. 46-50.

I4Aeyels, D., "Stabilization of a Class of Nonlinear Systems by a SmoothFeedback Control," Systems and Control Letters, No. 5, 1984, pp. 289-294.

15 Aeyels, D., "Stabilization by Smooth Feedback of the Angular Velocityof a Rigid Body," Systems and Control Letters, No. 5, 1985, pp. 59-63.

16Aeyels, D., and Szafranski, M., "Comments on the Stabilizability ofthe Angular Velocity of a Rigid Body," Systems and Control Letters, No. 10,1988, pp. 35-39.

17Brockett, R. W., "Asymptotic Stability and Feedback Stabilization,"Differential Geometric Control Theory, edited by R. W. Brockett, R. S.Millman, and H. J. Sussman, Birkhauser, Boston, 1983, pp. 181-191.

18Sontag, E. D., and Sussman, H. J., "Further Comments on the Stabi-lizability of the Angular Velocity of a Rigid Body," Systems and ControlLetters, No. 12, 1988, pp. 213-217.

19Bloch, A. M., Krishnaprasad, P. S., Marsden, J. E., and Sanchez deAlvarez, "Stabilization of Rigid Body Dynamics by Internal and ExternalTorques," Automatica, Vol. 28, No. 4, 1992, pp. 745-756.

20Bloch, A. M., and Marsden, J. E., "Stabilization of Rigid Body Dynam-ics by the Energy-Casimir Method," Systems and Control Letters, No. 14,1990, pp. 341-346.

21Zhao, R., and Posbergh, T. A., "Stabilization of a Rotating Rigid Bodyby the Energy-Momentum Method," Proceedings of the IEEE Conferenceon Decision and Control (Tucson, AZ), Inst. of Electrical and ElectronicsEngineers, 1992, pp. 1583-1588.

22Wan, C. J., and Bernstein, D. S., "A Family of Optimal Nonlinear Feed-back Controllers that Globally Stabilize Angular Velocity," Proceedings ofthe IEEE Conference on Decision and Control (Tucson, AZ), Inst. of Elec-trical and Electronics Engineers, 1992, pp. 1143-1148.

Page 8: Attitude Stabilization of a Rigid Spacecraft Using Two ... · of a rigid spacecraft and that arbitrary reorientation maneuvers of the spacecraft can be accomplished using smooth feedback.1"7

KRISHNAN, MCCLAMROCH, AND REYHANOGLU: ATTITUDE STABILIZATION 263

23Outbib, R., and Sallet, G., "Stabilizability of the Angular Velocity ofa Rigid Body Revisited," Systems and Control Letters, Vol. 18, 1992, pp.93-98.

24Marsden, J. E., et. al., "Symmetry, Stability, Geometric Phases, andMechanical Integrators (part II)," Nonlinear Science Today, Vol. 1.2, 1991,pp. 14-21.

25Krishnaprasad, P. S., "Lie-Poisson Structures, Dual-Spin Spacecraft andAsymptotic Stability," Nonlinear Analysis: Theory, Methods and Applica-tions, Vol. 7, 1984, pp. 1011-1035.

26Wang, L. S., and Krishnaprasad, P. S., "Gyroscopic Control and Stabi-lization," Journal of Nonlinear Science, Vol. 2, 1992, pp. 367-415.

27Bloch, A. M., Reyhanoglu, M., and McClamroch, N. H., "Control andStabilization of Nonholonomic Dynamic Systems," IEEE Transactions onAutomatic Control, Vol. 37, No. 11, 1992, pp. 1746-1757.

28 Greenwood, D., Principles of Dynamics, 2nd ed., Prentice-Hall, En-glewood Cliffs, NJ, 1988.

29Nijmeijer, H., and Van der Schaft, A. J., Nonlinear Dynamical ControlSystems, Springer-Verlag, New York, 1990.

30Sussman, H. J., "A General Theorem on Local Controllability,"SIAM Journal on Control and Optimization, Vol. 25, 1987, pp. 158-194.

31Sussman, H. J., "Local Controllability and Motion Planning for SomeClasses of Systems with Drift," Proceedings of the IEEE Conference onDecision and Control (Brighton, England, UK), Inst. of Electrical and Elec-tronics Engineers, 1991, pp. 1100-1114.

32Sontag, E. D., "Feedback stabilization of nonlinear systems," Ro-bust Control of Linear Systems and Nonlinear Control, edited by M. A.Kaasshoek, J. H. Van Schuppen, and A. C. M. Ran. Birkhauser, Boston,1990, pp. 61-81.

33Sussman, H. J., "Subanalytic Sets and Feedback Control," Journal ofDifferential Equations, Vol. 31, 1979, pp. 31-52.

34Pomet, J. B., "Explicit Design of Time-Varying Stabilizing ControlLaws for a Class of Controllable Systems Without Drift," Systems and Con-trol Letters, Vol. 18, 1992, pp. 147-158.

35Athans, M., and Falb, P. L., Optimal Control: An Introduction to theTheory and Its Applications, McGraw-Hill, New York, 1966.