observer based sliding mode attitude control: theoretical...

9
Modeling, Identification and Control, Vol. 32, No. 3, 2011, pp. 113–121, ISSN 1890–1328 Observer Based Sliding Mode Attitude Control: Theoretical and Experimental Results U. Jørgensen J.T. Gravdahl 1 Department of Engineering Cybernetics, Norwegian University of Science and Technology, N-7491 Trondheim, Norway. E-mail: [email protected]; [email protected] Abstract In this paper we present the design of a sliding mode controller for attitude control of spacecraft actuated by three orthogonal reaction wheels. The equilibrium of the closed loop system is proved to be asymptotically stable in the sense of Lyapunov. Due to cases where spacecraft do not have angular velocity measurements, an estimator for the generalized velocity is derived and asymptotic stability is proven for the observer. The approach is tested on an experimental platform with a sphere shaped Autonomous Underwater Vehicle SATellite: AUVSAT, developed at the Norwegian University of Science and Technology. Keywords: attitude control, observer design, nonlinear control, experiments 1. Introduction The contribution of this paper is the design of an out- put feedback nonlinear attitude control scheme and its verification on the sphere shaped underwater satellite, AUVSAT (Krogstad et al., 2008; Krogstad, 2010). Sev- eral control schemes have been proposed for attitude control of satellites, ranging from linear control in (Par- los and Sunkel, 1992), H 2 and H in (Won, 1999), to the nonlinear control based on vectorial backstepping in (Bondhus et al., 2005). The attitude of AUVSAT is actuated by means of reaction wheels. This is a popular and well proven at- titude control method and it has been implemented for both small (Zee et al., 2002) and large satellites (Kia et al., 1997). A solution with three orthogonally mounted reaction wheels can be seen in (Nudehi et al., 2008), whereas a redundant solution with four reaction wheels can be seen in (Jin et al., 2008). In addition, (Is- mail and Varatharajoo, 2010) present a comparison of several configurations based on three or four reaction wheel actuators. The method proposed for controlling the angular ve- locity of the AUVSAT is a sliding mode (SM) con- troller. The SM controller is a well known nonlinear controller that has been applied to many practical sys- tems (Ma and Boukas, 2009). It is considered to be very robust and thereby practical for systems affected by disturbances (Alfaro-Cid et al., 2005). The problem of controlling motion of rigid body sys- tems has been studied in great detail in the literature of aerospace, marine systems and robotics. However, most of these control techniques require knowledge of the actual angular velocity (Salcudean, 1991). Unfor- tunately, angular velocity measurement is often omit- ted due to cost or space restrictions and it is therefore important to estimate the angular velocity. Lizarralde and Wen (1996) and (Costic et al., 2000) present sim- ilar results for attitude stabilization control when an- gular velocity is not present using a velocity filter. An- other solution is to estimate the angular velocity using an extended Kalman filter (Sunde, 2005) or a nonlinear observer (Bondhus et al., 2005; Krogstad et al., 2005). The latter solution is used in this paper. The paper is completed with implementing the slid- ing mode controller and the observer in the submerged underwater satellite. The AUVSAT is equipped with a ballast system, making it naturally buoyant. The doi:10.4173/mic.2011.3.3 c 2011 Norwegian Society of Automatic Control

Upload: others

Post on 18-Jan-2021

5 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: Observer Based Sliding Mode Attitude Control: Theoretical ...folk.ntnu.no/tomgra/papers/Jorgensen_MIC_2011.pdf · eral control schemes have been proposed for attitude control of satellites,

Modeling, Identification and Control, Vol. 32, No. 3, 2011, pp. 113–121, ISSN 1890–1328

Observer Based Sliding Mode Attitude Control:Theoretical and Experimental Results

U. Jørgensen J.T. Gravdahl

1Department of Engineering Cybernetics, Norwegian University of Science and Technology, N-7491 Trondheim,Norway. E-mail: [email protected]; [email protected]

Abstract

In this paper we present the design of a sliding mode controller for attitude control of spacecraft actuated bythree orthogonal reaction wheels. The equilibrium of the closed loop system is proved to be asymptoticallystable in the sense of Lyapunov. Due to cases where spacecraft do not have angular velocity measurements,an estimator for the generalized velocity is derived and asymptotic stability is proven for the observer. Theapproach is tested on an experimental platform with a sphere shaped Autonomous Underwater VehicleSATellite: AUVSAT, developed at the Norwegian University of Science and Technology.

Keywords: attitude control, observer design, nonlinear control, experiments

1. Introduction

The contribution of this paper is the design of an out-put feedback nonlinear attitude control scheme and itsverification on the sphere shaped underwater satellite,AUVSAT (Krogstad et al., 2008; Krogstad, 2010). Sev-eral control schemes have been proposed for attitudecontrol of satellites, ranging from linear control in (Par-los and Sunkel, 1992), H2 and H∞ in (Won, 1999), tothe nonlinear control based on vectorial backsteppingin (Bondhus et al., 2005).

The attitude of AUVSAT is actuated by means ofreaction wheels. This is a popular and well proven at-titude control method and it has been implemented forboth small (Zee et al., 2002) and large satellites (Kiaet al., 1997). A solution with three orthogonallymounted reaction wheels can be seen in (Nudehi et al.,2008), whereas a redundant solution with four reactionwheels can be seen in (Jin et al., 2008). In addition, (Is-mail and Varatharajoo, 2010) present a comparison ofseveral configurations based on three or four reactionwheel actuators.

The method proposed for controlling the angular ve-locity of the AUVSAT is a sliding mode (SM) con-

troller. The SM controller is a well known nonlinearcontroller that has been applied to many practical sys-tems (Ma and Boukas, 2009). It is considered to bevery robust and thereby practical for systems affectedby disturbances (Alfaro-Cid et al., 2005).

The problem of controlling motion of rigid body sys-tems has been studied in great detail in the literatureof aerospace, marine systems and robotics. However,most of these control techniques require knowledge ofthe actual angular velocity (Salcudean, 1991). Unfor-tunately, angular velocity measurement is often omit-ted due to cost or space restrictions and it is thereforeimportant to estimate the angular velocity. Lizarraldeand Wen (1996) and (Costic et al., 2000) present sim-ilar results for attitude stabilization control when an-gular velocity is not present using a velocity filter. An-other solution is to estimate the angular velocity usingan extended Kalman filter (Sunde, 2005) or a nonlinearobserver (Bondhus et al., 2005; Krogstad et al., 2005).The latter solution is used in this paper.

The paper is completed with implementing the slid-ing mode controller and the observer in the submergedunderwater satellite. The AUVSAT is equipped witha ballast system, making it naturally buoyant. The

doi:10.4173/mic.2011.3.3 c© 2011 Norwegian Society of Automatic Control

Page 2: Observer Based Sliding Mode Attitude Control: Theoretical ...folk.ntnu.no/tomgra/papers/Jorgensen_MIC_2011.pdf · eral control schemes have been proposed for attitude control of satellites,

Modeling, Identification and Control

naturally buoyant system will make it possible to em-ulate a weightless state, similar to the conditions fora satellite in space. Short of launching a spacecraft,the AUVSAT should therefore provide an ideal vehi-cle for testing and demonstrating the proposed controlmethod.

2. Modeling

In this section, the model of a satellite actuated byreaction wheels will be derived.

2.1. Kinematics

The attitude kinematics will be described using Eu-ler parameters, due to the properties as a nonsingularand computational effective representation. The Eulerparameters may be defined from the angle-axis param-eters θ and k as

η , cos(1

2θ), ε , k sin(

1

2θ), (1)

and gathered in one attitude vector

q ,[η ε>

]>, (2)

which has unit length and is called a unit quaternion.According to (Egeland and Gravdahl, 2002), the ro-

tation matrix corresponding to the quaternion (2) isgiven by

R(η, ε) = I + 2ηS(ε) + 2S(ε)2, (3)

where I ∈ R3×3 is the identity matrix and S( · ) ∈ R3×3

is the skew-symmetric vector cross product operatordefined such that x1 × x2 = S(x1)x2, ∀ x1,x2 ∈ R3.Note that the quaternion representation has an inher-ent redundancy and the quaternions q and −q rep-resent the same physical orientation, but q is rotated2π relative to −q about an arbitrary axis (Kristiansenet al., 2009).

Let b be a coordinate frame attached to a rigidspacecraft and i an inertial reference frame. (Anillustration of the coordinate frames can be seen inFigure 1.) Then it can be seen that the kinematicdifferential equations can be expressed (Egeland andGravdahl, 2002), as

Rib = Ri

bS(ωbib), (4)

where ωbib is the angular velocity of the body frameb relative the inertial frame i decomposed in thebody frame, and Ri

b is the rotation matrix between theframes. For simplicity, Ri

b is denoted R throughout thepaper.

b

ix

iy

iz

bx

by

z

Figure 1: Illustration of the AUVSAT where the iner-tial i and body b coordinate frames areshown as well as the reaction wheel rates Ω.

Using (2)–(4) the kinematic differential equationscan then be expressed as

q =1

2E(q)ωbib, (5)

where E(q) =

[−ε>T(q)

]and T(q) = ηI + S(ε).

2.2. Dynamics

Assuming that the satellite is a rigid body with theorigin of the body frame placed coinciding with thecenter of gravity (CG), we may use Euler’s second ax-iom to express the momentum for the wheels and thecomplete system (Hall, 1995). The momentum of thewheels can be written as

Hw = Jwωbib + JwΩ, (6)

where Jw is the inertia matrix of the wheels and Ω =[Ω1 Ω2 Ω3

]>is the angular velocity of each reaction

wheel. The complete angular momentum of the vehicleis expressed as

H = Jωbib + JwΩ, (7)

where J is the total moment of inertia of the rigid bodyincluding the reaction wheels. Differentiating (6)–(7)with respect to time and using Euler’s second axiom,one may write the dynamic equation for the satelliteactuated by means of three orthogonal reaction wheelsas (Jin et al., 2008):

Jsωbib =− S(ωbib)H− τ bu + τ bex, (8a)

JwΩ =− Jwωbib + τ bu, (8b)

where Js = J−Jw is the inertia matrix for the systemwithout wheels, τ bex is the external torque applied tothe system and τ bu is the commanded torque to themotors and thereby the manipulative variable.

114

Page 3: Observer Based Sliding Mode Attitude Control: Theoretical ...folk.ntnu.no/tomgra/papers/Jorgensen_MIC_2011.pdf · eral control schemes have been proposed for attitude control of satellites,

Jørgensen and Gravdahl, “Observer Based Sliding Mode Attitude Control”

3. Control design

The control objective is to control the angular velocityof the satellite to a desired time-varying angular ve-locity reference ωiid(t), from now on written ωid(t) forshort. From (5) it can be seen that the correspondingtime-varying desired attitude qd(t) can be expressed as

qd =1

2E(qd(t))R

>(qd(t))ωid(t), (9)

where R(qd) is the rotation matrix from the desired tothe inertial frame.

3.1. Error dynamics

We may define the angular velocity error as

ωe , ω −R>(η, ε)ωid(t), (10)

where the desired angular velocity is given in the iner-tial frame and ω = ωbib. It is also assumed throughoutthe paper that angular velocities without superscriptare decomposed in the body frame.

The relative attitude error is defined using thequaternion product as

qe , q−1d ⊗ q =[ηe ε>e

]>, (11)

where qd and q are the desired and actual attitude,respectively. q−1d is called the complex conjugate of qd

and it can be seen that q−1d =[ηd −ε>d

]>. ⊗ denotes

the quaternion product, which is defined between the

two quaternions q1 =[η1 ε>1

]>and q2 =

[η2 ε>2

]>as

q1 ⊗ q2 =

[η1 −ε>1ε1 η1I + S(ε1)

] [η2ε2

]. (12)

It can be seen from (11)–(12) and the inherent redun-dancy of the quaternion parameterization that qe =[±1 0>

]>when the attitude of the satellite is aligned

with the desired attitude. 0 denotes the 3 × 1 zero-vector.

Using (8)–(11) it can be seen that the error dynamicsmay be written as

qe =1

2E(qe)ωe, (13a)

Jsωe = JsS(ωe)R>ωid − JsR

>ωid

− S(ω)H− τu + τ ex,(13b)

where the fact that R>ωid = −S(ωe)R>ωid has been

used.

3.2. Sliding mode controller

In this section a sliding mode controller will be pro-posed to control the angular velocity of the satellite.The SM controller is inspired by (Fossen, 2002; Wanget al., 2003), while modifications are carried out in or-der to adapt it to the sphere shaped satellite. Thederivation of the SM controller consists of two parts:making every trajectory converge to the sliding mani-fold (s = 0) and then making sure that the trajectoriesreach the desired equilibrium.

Let the sliding variable s ∈ R3×1 be defined as

s , ωe + Kεe, (14)

where K ∈ R3×3, K = K> > 0 is a tuning parameter.If (14) is differentiated with respect to time and pre-

multiplied with Js we get

Jss = JsS(ωe)R>ωid − JsR

>ωid − S(ω)H

− τu + τ ex + JsKεe,(15)

where (8a) and (10) have been used in addition to thefact that R>ωid = −S(ωe)R

>ωid.Choose the control variable τu to cancel all the non-

linear terms in (15) and include tuning parameters byadding the terms Dsgn(s) and Ps, where D, P ∈ R3×3

are positive definite. Note that εe can be calculatedfrom the relationship in (13a), avoiding time differen-tiation of εe. sgn(s) is the sign function defined in (16)performed on each element in s.

sgn(x) =

+1 if x ≥ 0,

−1 if x < 0.(16)

Proposition 1 The error dynamics (13), with thesliding mode controller given by

τu = JsS(ωe)R>ωid − JsR

>ωid − S(ω)H + τ ex

+ JsKεe + JsDsgn(s) + JsPs

(17)

have an asymptotically stable (AS) equilibrium in

(ωe,qe) = (0,1q) where 1q =[±1 0>

]>.

Remark 1 It is not possible to claim any global sta-bility for the closed-loop system due to the well knownissue related to a dual equilibria obtained through theuse of quaternions for attitude representation. How-

ever, the two quaternions, 1q =[±1 0>

]>, corre-

sponds to the same physical orientation, and it is there-fore important to make a choice of which equilibriumpoint to stabilize, depending on the given initial con-dition (Kristiansen et al., 2009). An effective choicein order to minimize the path length, is by choosing

115

Page 4: Observer Based Sliding Mode Attitude Control: Theoretical ...folk.ntnu.no/tomgra/papers/Jorgensen_MIC_2011.pdf · eral control schemes have been proposed for attitude control of satellites,

Modeling, Identification and Control

1q =[1 0>

]>if ηe(0) ≥ 0 or 1q =

[−1 0>

]>oth-

erwise. Alternative approaches to this problem can beto chose the positive equilibrium while restricting ini-tial values as done in (Caccavale and Villani, 1999) orusing hybrid feedback as in (Mayhew et al., 2009).

Remark 2 Note that the external torque τ ex is as-sumed known.

Proof: Consider the radially unbounded Lyapunovfunction candidate:

V1 =1

2s>s > 0, ∀ s 6= 0, (18)

and differentiating it with respect to time along thetrajectory we get

V1 = −s>Ps− s>Dsgn(s) < 0, ∀ s 6= 0. (19)

According to (Shevitz and Paden, 1994), this provesthat the non-smooth s-system is AS, thus every trajec-tory will converge to the sliding manifold. In fact, onecan guaranty finite time convergence (Perruquetti andBarbot, 2002), since

∂V1∂t≤ −ϑ

√V1, (20)

where ϑ =√

2λmin(D) > 0 and λmin(D) is the smallesteigenvalue of D. From (20), we get

2√V1 ≤ V1(s(0))− ϑt. (21)

This shows that the system will converge to the slidingmanifold with the finite convergence time Tc, upperbounded according to

Tc ≤V1(s(0))

ϑ. (22)

Given that we are in sliding mode, s = 0, we maywrite

ωe = −Kεe. (23)

We then introduce the second Lyapunov function can-didate:

V2 = 2(1− ηe), (24)

which is a positive definite function since −1 ≤ ηe ≤1 ∀ t.

Remark 3 Notice that the Lyapunov function mayalso be seen as a function of εe since η2e + ε>e εe ≡ 1.We will however look at the Lyapunov function as afunction of ηe since the calculations will be somewhatsimpler.

The time derivative of V2 along the solution thenbecomes

V2 = −2ηe = ε>e ωe = −ε>e Kεe (25a)

≤ −λmin(K)ε>e εe = −1

2λmin(K)

[ε>e εe + ε>e εe

](25b)

= −1

2λmin(K)

(1− η2e

)− 1

2λmin(K)ε>e εe (25c)

< 0 ∀ qe 6=[±1 0

]>, (25d)

where λmin(K) > 0 is the smallest eigenvalue of Kand (13a) and (23) have been used, in addition to theunit-length property of qe.

Since V2 is positive definite, and V2 is negative def-inite, thus, ηe → ±1 as times goes to infinity andεe → 0. The error attitude qe will thereby convergeto 1q as stated in Proposition 1. Further, it is seenthat ωe will converge to 0 since ωe = −Kεe in slid-ing mode, and when εe → 0 so will ωe. We can thenconclude that the equilibrium of the system, with thegiven controller, is asymptotically stable.

4. Observer design

Assuming that only attitude of the vehicle and speedof the wheels are available for measurements, an ob-server is needed to estimate the angular velocity of thesatellite. This can be done in different ways, includingan extended Kalman filter and a nonlinear observer.In this paper the latter alternative is used and theobserver scheme is inspired by (Bondhus et al., 2005;Krogstad, 2010).

4.1. Observer dynamic equations

As the calculations are less involved in the inertialframe, we express the momentum dynamics as

Σ :

Hi = Ri

bτbex,

q = 12E(q)

[(RibJ)−1

Hi − J−1JwΩ]

︸ ︷︷ ︸ω

. (26)

We then define the observer system Σ as the copy ofthe dynamics with correction terms g1(q) and g2(q)as:

Σ :

˙Hi = Ri

b

[τ bex + g1

]˙q = 1

2E(q)[(

RibJ)−1

Hi − J−1JwΩ + g2

](27)

where Hi and q are the estimated momentum and at-titude, respectively. The correction terms g1(q) andg2(q) are to be determined later.

116

Page 5: Observer Based Sliding Mode Attitude Control: Theoretical ...folk.ntnu.no/tomgra/papers/Jorgensen_MIC_2011.pdf · eral control schemes have been proposed for attitude control of satellites,

Jørgensen and Gravdahl, “Observer Based Sliding Mode Attitude Control”

4.2. Error definition

The error variables between the real and estimated val-ues for attitude, momentum and angular velocity, re-spectively, are defined as:

q , q−1 ⊗ q, (28a)

Hi , Hi −Hi, (28b)

ωbib , ωbib − ωbib. (28c)

The error between the estimated system Σ and thereal system Σ is denoted Σ and can be derived by dif-ferentiating (28) with respect to time, resulting in

Σ :

˙Hi = Ri

bg1(q),

˙q = 12E(q)

[(RibJ)−1

Hi + g2(q)].

(29)

Notice that ωbib =(RibJ)−1

Hi, as can be seen us-ing (26)– (28).

Proposition 2 The observer Σ, defined in (27), with

g1(q) = −kpsgn(η)J−1ε, (30a)

g2(q) = −kvsgn(η)ε, (30b)

and kp kv > 0, will converge asymptotically towardsthe actual system Σ, seen in (26). This results in anasymptotic stable equilibrium (ω, q) = (0,1q) for theclosed-loop observer.

Proof: To prove Proposition 2, we utilize (She-vitz and Paden, 1994, Th. 3.1). This theorem provesthat ordinary smooth Lyapunov stability theory canbe used for a class of non-smooth Lipschitz continuousLyapunov functions and absolutely continuous statetrajectories. In addition we apply Matrosov’s theorem,which states four assumptions that must be met to con-clude with asymptotic stability. (Matrosovs’s theoremcan be seen in Appendix A.)

Define the state-vector x ∈ R7 such that

x> ,

[(Hi)>

ε> 1− |η|]. (31)

Satisfying Assumption 1: Consider the non-smoothLyapunov function

Vo =1

2

(Hi)>

Hi + 2kp(1− |η|). (32)

Notice that Remark 3 still apply, but η and ε corre-spond to ηe and εe, respectively. The time derivativeof Vo along trajectories then becomes:

Vo =(Hi)>

Ribg1(q) + kpsgn(η)ε>

[ωbib + g2(q)

](33a)

= −kvkp (sgn(η))2ε>ε = −kvkpε>ε (33b)

≤ 0 ∀ εe 6= 0. (33c)

It is assumed that J is symmetric, meaning J> = J,which is generally the case for satellites. Clearly, Vois negative semidefinite, and one can thereby concludethat the equlilibrium of the observer is uniformly stable(US) and hence the system is bounded. Further, Vo ispositive definite and decrescent and thereby satisfyingAssumption 1.

Satisfying Assumption 2: Choose the non-positivecontinuous time-independent function

U(x) , −kpkv ε>ε⇒ Vo(x, t) ≤ U(x) ≤ 0

which satisfies Assumption 2.Satisfying Assumption 3: Since the origin is US, then

Hi, ε, and η are bounded functions of time. We cantherefore construct the auxiliary function W (x, t) asshown in (34). We choose

W (x, t) , −η(Hi)>

Jε, (34)

and thereby satisfying Assumption 3 of the Matrosov’stheorem.

Satisfying Assumption 4: The derivative W then be-comes

W = − ˙η(Hi)>

Jε− η(

˙Hi)>

Jε− η(Hi)>

J ˙ε, (35)

and on the set N = x | U(x) = 0 = x | ε = 0 itcan easily be seen that

W (x, t) = −η(Hi)>

J ˙ε. (36)

Inserting for ˙ε, and using (28b), (30b) and the unit-property, you get the following calculations:

W (x, t) = −1

2η(Hi)>

J (ηI + S(ε)) [ω + g2(q)]

= −1

2η2(Hi)>

= −1

2

(1− ε>ε

)(Hi)>

J(RibJ)−1

Hi

= −1

2

(Hi)>

RbiH

i

< 0.

Therefore, the derivative W is definitely non-zero onthe set N, and Assumption 4 is also satisfied.

Remark 4 This holds as long as η differs from zero.However, (Krogstad, 2010) states that if the US prop-erty of Assumption 1 is used in addition to the fact thatη = 0 is an unstable equilibrium point, it can be seenthat the conditions are met by requiring η 6= 0 initially.

117

Page 6: Observer Based Sliding Mode Attitude Control: Theoretical ...folk.ntnu.no/tomgra/papers/Jorgensen_MIC_2011.pdf · eral control schemes have been proposed for attitude control of satellites,

Modeling, Identification and Control

Finally, all the assumptions of Matrosov’s theoremare satisfied, and we may conclude that the error-dynamics in (26) have an asymptotic stable equilibriumin (ω, q) = (0,1q) for the closed-loop observer.

Remark 5 In Sec. 3 it is proven that the system withthe SM controller is asymptotically stable. This sec-tion on the other hand, shows that the proposed ob-server will converge asymptotically to the real angularvelocity. However, this is not sufficient for conclud-ing asymptotic stability for the combined observer-and-controller system. Nevertheless, asymptotic stability ofthe system and observer separately is a good indicationof overall system stability and experiments presented inthe upcoming section strengthen this statement.

5. Experiments

This section contains simulations and results from theexperiments with AUVSAT. The sphere shaped satel-lite is equipped with small-size and low-cost IMU sen-sor for attitude and angular velocity measurements,and a PC/104 embedded computer board with 0.5 GHzPentium processor, running QNX Neutrino OS. In ad-dition to the satellite, a host computer is provided for agraphical communication interface, and Ethernet LANis used between the host and the QNX target. The hostis running Matlab Real-time workshop in combinationwith Simulink which enables a rapid implementation ofcontrol laws, in addition to graphically represent mea-surements and control signals in real-time. Pictures ofAUVSAT are shown in Figure 2.

The first part of this section presents the results ofthe sliding mode controller. To avoid noisy signals tothe controller, the measurements of the angular veloc-ity is filtered with a standard first order filter. In thesecond part we implement the nonlinear observer. Theestimated angular velocity from this observer is usedby the same sliding mode controller.

The control objective is to track an angular veloc-ity reference signal ωid(t) given in the inertial coor-dinate frame. The reference signal is stated in (37b)and is a sequence of a square signal with a period of50 s, and time-varying sinusoidal reference signal. Inthis way one can truly validate the performance of thecontroller. The experiment was sampled at 50 Hz forabout 400 s with the gains shown in Table 1 and theparameters used for the satellite in Table 2. The plotsfrom the case without observer can be seen in Figure 4,whereas the results with angular velocity estimationcan be seen in Figure 5. Note that the desired trajec-tory signal is filtered by a second-order filter inside the“Reference”-block in Figure 3 and qd(t) is calculated

using (9).

ωid,3(t) =

−0.2square

(150 , t

)20 s ≤ t ≤ 145 s

−0.3 sin(2π30 (t+ 5)

)175 s ≤ t ≤ 280 s

−0.4 sin(2π30 (t+ 5)

)280 s ≤ t ≤ 370 s

0 Else

(37a)

ωid(t) =[0 0 ωid,3(t)

]>(37b)

Table 1: SM controller and observer gains.

Parameter Value

Control gains: K 2.0 · 10−3 · ID 1.0 · 10−3 · IP∗ 1.2 · I

Observer gains: kp 17.0

kv 12.0

* When the observer is used: P = 0.5 · I 1/sm

Table 2: AUVSAT parameters.

Param. Value

Inertia matrix J

J11 J12 J13

J12 J22 J23

J13 J23 J33

kgm2

(J11 J22 J33

) (0.78 0.85 0.95

)(J12 J13 J23

) (0.00 0.01 0.00

)Wheel inertia matrix Jw 0.0142 · I kgm2

Max wheel torque 0.358 Nm

Max wheel speed 419 rad/s

Satellite mass 42.1 kg

Satellite diameter 42.8 cm

6. Discussion

6.1. Experiments without observer

Figure 4 shows the behavior of the system with thesliding mode controller. It can be seen that the systemtracks the desired angular velocity quite well. Thereare almost no uncontrolled oscillations, as we have ωavailable for feedback. However, small adjustments canbe made to make the performance even better.

118

Page 7: Observer Based Sliding Mode Attitude Control: Theoretical ...folk.ntnu.no/tomgra/papers/Jorgensen_MIC_2011.pdf · eral control schemes have been proposed for attitude control of satellites,

Jørgensen and Gravdahl, “Observer Based Sliding Mode Attitude Control”

6.2. Experiments with observer

Figure 5(a) shows the comparison between the esti-mated and the real angular velocity measurements.Plot number three shows the estimation of the angularvelocity about the z-axis. It can be seen that the ob-server works satisfactorily when the sinusoidal signalis tracked. However, the observer seems to have diffi-culties with estimation of the maximum and minimumangular velocity of the sinusoidal signal. When thesystem is tracking the constant reference signal, sta-tionary deviation, oscillations and drift can be seen. Itthereby looks like the observer performs satisfactorilywhen there is enough excitation in the system. Someimprovement may be achieved by finding better gains,but other observer strategies might also be consideredas an alternative, e.g. extended Kalman filter.

In Figure 5(b) the reference angular velocity is com-pared with a filtered angular velocity measurement.(The filtered signal is selected as the comparison tofacilitate the readability.) The behavior of the systemis acceptable when the system is tracking the sinusoidalreference signal. However, the performance is clearlynot as good as without the observer.

We can also see that the low performance of theobserver in connection with the square signal still ispresent.

7. Conclusion

In this paper the topic of controlling the attitudeof a spherical spacecraft actuated by three orthogo-nally reaction wheels has been studied. Using meth-ods from nonlinear system theory a robust nonlinearsliding mode controller has been designed and imple-mented on the AUVSAT to control the attitude. Whenangular velocity measurements are not present in thespacecraft, a nonlinear observer is derived to estimatethe velocity.

The various systems were tested in a lab setup wherethe AUVSAT is submerged in water and thereby em-ulating a gravity free environment. Experiments werecarried out to evaluate the performance of the con-troller, observer, and the overall system. In each ex-periment the system is set to track a sequence of asquare-shaped signal, in addition to a sinusoidal time-varying angular velocity reference signal. The resultsshow that the sliding mode controller works satisfac-torily throughout the experiment, whereas the perfor-mance of the overall system with observer and con-troller is lower when tracking the squared referencesignal. Nevertheless, all aspects considered; the per-formance of the complete system is satisfactory.

(a)

(b)

Figure 2: AUVSAT. (a) shows when the top sphereis detached to expose the inner constructionand (b) shows the submerged satellite duringexperiments.

Reference

Attitudecontroller

Underwatersatellite

Filter

id

d

id

uτ iibω

ωω

Ωq

q

,bf ibω

(a)

Reference

Attitudecontroller

Underwatersatellite

Observerˆ b

id

d

id

uτiibω

ibω

ωω

Ωq

q

(b)

Figure 3: Block diagram of system where (a) filters theangular velocity measurement, whereas (b)estimates the angular velocity.

119

Page 8: Observer Based Sliding Mode Attitude Control: Theoretical ...folk.ntnu.no/tomgra/papers/Jorgensen_MIC_2011.pdf · eral control schemes have been proposed for attitude control of satellites,

Modeling, Identification and Control

Figure 4: Experiments without observer. Comparingthe angular velocity against the desired gen-eralized velocity.

(a)

(b)

Figure 5: Experiments with observer. (a) shows mea-sured and estimated velocity about x, y and zaxis. (b) compares the reference against thefiltered angular velocity about the z-axis.

Acknowledgments

The AUVSAT-vehicles were designed and constructedby Dr. Thomas Krogstad as part of his PhD-thesiswork. The authors would like to thank the anonymousreviewers for their thorough work and valuable com-ments that contributed to improving the quality of thispaper.

The work of the first author is supported in partby the Research Council of Norway under project199567/I40 “Arctic DP”. Also, the Norwegian Uni-versity of Science and Technology and the Norwe-gian Space Centre are acknowledged for the fundingof AUVSAT.

References

Alfaro-Cid, E., McGookin, E. W., Murray-Smith,D. J., and Fossen, T. I. Genetic algorithms optimiza-tion of decoupled sliding mode controllers: simulatedand real results. Cont. Eng. Prac., 2005. 13(6):739– 748. doi:10.1016/j.conengprac.2004.07.004.

Bondhus, A. K., Pettersen, K. Y., and Gravdahl,J. T. Leader/follower synchronization of satel-lite attitude without angular velocity measure-ments. In Proc. CDC-ECC. pages 7270–7277, 2005.doi:10.1109/CDC.2005.1583334.

Caccavale, F. and Villani, L. Output feedback con-trol for attitude tracking. Systems & Control Let-ters, 1999. 38(2):91 – 98. doi:10.1016/S0167-6911(99)00050-X.

Costic, B. T., Dawson, D. M., De Queiroz, M. S., andKapila, V. A quaternion-based adaptive attitudetracking controller without velocity measurements.In Proc. CDC, volume 3. pages 2424–2429, 2000.doi:10.1109/CDC.2000.914164.

Egeland, O. and Gravdahl, J. T. Modeling and Simu-lation for Automatic Control. Marine Cyb., 2002.

Fossen, T. I. Marine Control Systems, Guidance, Nav-igation, and Control of Ships, Rigs and UnderwaterVehicles. Marine Cybernetics, 2002.

Hahn, W. Stability of Motion. Springer-Verlag, 1967.

Hall, C. D. Spinup dynamics of gyrostats. J. Guid-ance, Control, and Dynamics, 1995. 18(5):1177–1183. doi:10.2514/3.21522.

Ismail, Z. and Varatharajoo, R. A study of reactionwheel configurations for a 3-axis satellite attitudecontrol. Advances in Space Research, 2010. 45(6):750– 759. doi:10.1016/j.asr.2009.11.004.

120

Page 9: Observer Based Sliding Mode Attitude Control: Theoretical ...folk.ntnu.no/tomgra/papers/Jorgensen_MIC_2011.pdf · eral control schemes have been proposed for attitude control of satellites,

Jørgensen and Gravdahl, “Observer Based Sliding Mode Attitude Control”

Jin, J., Ko, S., and Ryoo, C.-K. Fault toler-ant control for satellites with four reaction wheels.Cont. Eng. Prac., 2008. 16(10):1250 – 1258.doi:10.1016/j.conengprac.2008.02.001.

Kia, T., Bayard, D. S., and Tolivar, F. A precisionpointing control system for the space infrared tele-scope facility (SIRTF). Technical Report AAS 97-067, American Astronautical Society, 1997.

Kristiansen, R., Lorıa, A., Chaillet, A., andNicklasson, P. J. Spacecraft relative rota-tion tracking without angular velocity measure-ments. Automatica, 2009. 45(3):750–756.doi:10.1016/j.automatica.2008.10.012.

Krogstad, T. R. Attitude synchronization in space-craft formations. Theoretical and experimental re-sults. Ph.D. thesis, NTNU, 2010.

Krogstad, T. R., Gravdahl, J. T., Børhaug, E., andPettersen, K. Y. AUVSAT: An experimental plat-form for spacecraft formation flying. In Proc. 59thIntl. Astronautical Cong., Glasgow. 2008.

Krogstad, T. R., Gravdahl, J. T., and Kristiansen, R.Coordinated control of satellites: The attitude case.In Proc. 56th Intl. Astron. Cong., Fukuoka. 2005.

Lizarralde, F. and Wen, J. T. Attitude control withoutangular velocity measurement: a passivity approach.IEEE Trans. on Automatic Control, 1996. 41(3):468–472. doi:10.1109/9.486654.

Ma, S. and Boukas, E.-K. A singular system approachto robust sliding mode control for uncertain markovjump systems. Automatica, 2009. 45(11):2708 –2713. doi:10.1016/j.automatica.2009.07.027.

Mayhew, C., Sanfelice, R., and Teel, A. Ro-bust global asymptotic attitude stabilization ofa rigid body by quaternion-based hybrid feed-back. In Proc. CDC/CCC. pages 2522 –2527, 2009.doi:10.1109/CDC.2009.5400431.

Nudehi, S. S., Farooq, U., Alasty, A., and Issa, J.Satellite attitude control using three reaction wheels.In Proc. American Control Conf. pages 4850–4855,2008. doi:10.1109/ACC.2008.4587262.

Parlos, A. G. and Sunkel, J. W. Adaptive at-titude control and momentum management forlarge-angle spacecraft maneuvers. J. Guidance,Control, and Dynamics, 1992. 15(4):1018–1028.doi:10.2514/3.20937.

Perruquetti, W. and Barbot, J. P. Sliding Mode Con-trol in Engineering. Marcel Dekker, Inc., 2002.doi:10.1201/9780203910856.

Salcudean, S. A globally convergent angular veloc-ity observer for rigid body motion. IEEE Trans.on Automatic Control, 1991. 36(12):1493–1497.doi:10.1109/9.106169.

Shevitz, D. and Paden, B. Lyapunov stabil-ity theory of nonsmooth systems. IEEE Trans.on Automatic Control, 1994. 39(9):1910–1914.doi:10.1109/9.317122.

Sunde, B. O. Sensor modelling and attitude determi-nation for micro-satellite. Master’s thesis, NTNU,2005.

Wang, B., Gong, K., Yang, D., and Li, J. Fine attitudecontrol by reaction wheels using variable-structurecontroller. Acta Astronautica, 2003. 52(8):613–618.doi:10.1016/S0094-5765(02)00133-9.

Won, C.-H. Comparative study of various con-trol methods for attitude control of a leo satellite.Aerospace Science and Technology, 1999. 3(5):323 –333. doi:10.1016/S1270-9638(00)86968-0.

Zee, R. E., Matthews, J., and Grocott, S. C. O. TheMOST microsatellite mission: All systems go forlaunch. In Proc. 12th CASI Conf. on Aeron. 2002.

A. Matrosov’s Theorem

Theorem 1 (Matrosov’s Theorem (Hahn, 1967))Consider the system

x = f(x, t), f : Rn × R→ Rn, (38)

where f is bounded. Let two functions V (x, t) andW (x, t) be given which are continuous on the domainD and satisfy the following assumptions:

Assumption 1 V (x, t) is positive definite and decres-cent.

Assumption 2 The derivative V can be bounded fromabove by a non-positive continuous t-independent func-tion U(x) such that

V (x, t) ≤ U(x) ≤ 0. (39)

Assumption 3 The function W (x, t) is bounded.

Assumption 4 The derivative W is “definitely non-zero” on the set

N = x | U(x) = 0 . (40)

Then the equilibrium of Equation (38) is uniformlyasymptotically stable (UAS) on D.

Remark 6 Notice that W in Assumption 3 can be neg-ative as long as it is bounded.

121