06.02.2013 Views

Underwater Robots - Gianluca Antonelli.pdf

Underwater Robots - Gianluca Antonelli.pdf

Underwater Robots - Gianluca Antonelli.pdf

SHOW MORE
SHOW LESS

You also want an ePaper? Increase the reach of your titles

YUMPU automatically turns print PDFs into web optimized ePapers that Google loves.

7.6 Sliding Mode Control 153<br />

u = B † [ K D s + ˆg + ˆ M ˙y +( Ĉ + ˆ D ) y + K S sign(s )] (7.15)<br />

in lieu of (7.10). Starting from the function in(7.12) and plugging (7.15)<br />

in (7.13) gives<br />

˙V = − s T ( D + K D ) s + s T [ � M ˙y +( � C + � D ) y + ˜g − K S sign(s )]<br />

that, in view of positive definiteness of K D and D ,leads to negative definiteness<br />

of ˙ V if<br />

�<br />

�<br />

λ min( K S ) ≥ � � M ˙y +( � C + � �<br />

�<br />

D ) y + ˜g � . (7.16)<br />

It is worth noting that condition (7.16) is weaker than condition (7.14) in<br />

that the matrix K S must overcome the sole model parameters mismatching.<br />

Stability ofthe sliding manifold. It was demonstrated that the discussed<br />

control law guarantees convergence of s to the sliding manifold s = 0 .Inthe<br />

following it will be demonstrated that, once the sliding manifold has been<br />

reached, the error vectors ˜η 1 , ˜ε , ˜q converge asymptotically to the origin, i.e.,<br />

that regulation of the system variables totheir desired values is achieved.<br />

By taking Λ =blockdiag { Λ p , Λ o , Λ q } where Λ p ∈ IR 3 × 3 , Λ o ∈ IR 3 × 3 ,<br />

Λ q ∈ IR n × n ,from (7.11) it is possible to notice that the stability analysis can<br />

be decoupled in 3parts as follows.<br />

Vehicle position error dynamics. The vehicle position error dynamics on<br />

the sliding manifold is described bythe equation<br />

− ν 1 + Λ p R B I ˜η 1 = 0 .<br />

Notice that the rotation matrix R B I is afunction ofthe vehicle orientation.<br />

By considering<br />

V = 1<br />

2 ˜η T 1 ˜η 1<br />

as Lyapunov function candidate and observing that ˙η 1 = R I B ν 1 ,itiseasily<br />

obtained<br />

˙V = − ˜η T 1 R I B Λ p R B I ˜η 1 ,<br />

that is negative definite for Λ p > O .Hence, ˜η 1 converges asymptotically to<br />

the origin.<br />

Vehicle orientation error dynamics. The vehicle orientation error dynamics<br />

on the sliding manifold is described bythe equation<br />

− ν 2 + Λ o ˜ε = 0 ⇒ ν 2 = Λ o ˜ε . (7.17)<br />

Further, by taking into account the quaternion propagation and (7.17), it<br />

can be recognized that<br />

˙˜η = 1<br />

2 ˜ε T ν 2 = 1<br />

2 ˜ε T Λ o ˜ε . (7.18)

Hooray! Your file is uploaded and ready to be published.

Saved successfully!

Ooh no, something went wrong!