brigitte d’ andrÉa-novel mines paristech, psl-research...

1

Brigitte d’ ANDRÉA-NOVELMINES ParisTech, PSL-Research University, Centre de robotique, 60 Bd St Michel

75006 Paris

Sylvain THORELSAGEM, 100 avenue de Paris, 91344 Massy Cedex

� Systems not stabilizable by means of continuous state feedback laws (Brockett condition)

� Similarities concerning Controllability , Stabilizability, Flatness properties

� Two different approaches for trajectory tracking of nonsingular reference trajectories and for fixed point stabilization

2

3

4

Idem for the slider :

The Unicycle : the TL system is controllable if

5

The slider : the TL system is controllable if

STLC is satisfied for the two systems at each trajectory

The non controllability of the tangent linearized system at a fixed point does not necessarily imply that the original nonlinear system does not satisfy the STLC property. In fact, it can be shown that the LARC is satisfied for both systems, as well as the STLC property.

6

Let us consider a neighborhood of the origin of the unicycleIt cannot be in the image of the slider’s dynamics at the origin.

STLC is satisfied for the two systems at each trajectory

respectively

BUT

The same holds for the slider. Therefore, due to Brockett’s theorem, these twosystems cannot be stabilized at fixed equilibrium points by means of continuousstate feedback laws.

7

� Definition found in [18] and [19]:

8

[18] Jean lévine, Analysis and Control of Nonlinear Systems : A Flatness-based Approach, Springer 2009, pp 143.[19] M. Fliess, J. Levine, P. Martin, P. Rouchon, Flatness and defect of non-linear systems: introductory theory andexamples, Int. J. Control, vol. 61, 1327-1361, 1995.

The unicycle robot is flat with flat outputs Y1 = x and Y2 = y :

9

The system is dynamic feedback linearizable, the decoupling matrix beingsingular when the longitudinal velocity is zero.

The unicycle robot is flat with flat outputs Y1 = x and Y2 = y :

10

The system is dynamic feedback linearizable, the decoupling matrix beingsingular when the longitudinal velocity is zero.

11

Tracking non singular reference trajectoriesfor the unicycle robot using dynamicfeedback linearization

The slider is flat with flat outputs Y1 = x and Y2 = y :

12

The system is dynamic feedback linearizable, the decoupling matrix beingsingular when the longitudinal acceleration is zero.

13

� Autonomous Indoor exploration for wheeled mobile robots� SLAM

� Trajectory generation and tracking control laws

� 3D reconstruction

� Object recognition…

� Adapt these technologies to a hybrid terrestrial and aerial quadrotor prototype

14

� Slider dynamic behavior similar to hovercraft� Tilting thrust

� Hovercraft model proposed in [8]� Simplified model derived from an underactuated surface

vessel modeling

� Kinematic and dynamic equations

15

[8] I. Fantoni, R. Lozano, F. Mazenc, K. Y. Pettersen, Stabilization of a nonlinear underactuated hovercraft. Conference on Decision and Control (CDC), 1999

� Objective : trajectory tracking

and derivatives

16

� Cannot be asymptotically stabilized by continuous state feedbacks for point stabilization ([9], [10])

Underactuated

vehicles

Marine vehicles ([9], [10])

17

Surface vessel

hovercraft

[9] K. Y. Pettersen and O. Egeland, Exponential Stabilization of an Underactuated Surface Vessel. Conference on Decision and Control , 1996.[10] R. W. Brockett, Asymptotic stability and feedback stabilization, Diff. Geometric Control Theory, Ed . Brockett, Millmann, Sussmann, Birkhauser, Boston, pp 181-191, 1983.

� Trajectory tracking� Non linear control laws based on a Lyapunov analysis▪ Surface vessel/ Position tracking/ constraint : longitudinal

speed ≠ 0 ([11])

▪ Surface vessel/ Posture tracking/ Exciting reference trajectory ▪ Surface vessel/ Posture tracking/ Exciting reference trajectory ([12])

� Flatness [13]

▪ Hovercraft stabilization/ Constraint on the reference trajectory

� Sliding mode [14]

▪ Hovercraft stabilization

18

[11] J. M. Godhavn, Nonlinear Tracking of Underactuated Surface Vessel. Decision and Control conference, 1996.[12] Pettersen and Nijmeijer. Tracking control of an underactuated surface vessel. CDC, 1998[13] H. Sira-Ramirez and C. A. Ibanez, On the control of the Hovercraft System. Decision and control conference, 2000.[14] H. Sira-Ramirez, Dynamic second order sliding mode control of the hovercraft vessel. Control Systems technology, IEEE Transactions on, 2002.

� Point stabilization� Time-varying commands▪ Smooth feedback but slow convergence [11]

▪ Homogeneous continuous feedback, fast convergence, low robustness [9], [16] (Surface vessel stabilization)

� Discontinuous commands▪ Lyapunov based analysis ([8]) (Hovercraft Stabilization)

� Practical stabilization▪ Hovercraft Stabilization/ Position tracking/ C3 reference trajectory

([17])▪ Transverses functions [18]

19

[11] J.M. Coron, Brigitte d’Andréa-Novel, Smooth Stabilizing time-varying control laws for a class of nonlinear systems. Application to mobile robots. Proceedings of Nolcos Conference, Bordeaux, June 1992, pp. 649-654.[16] K. Y. Pettersen and T. I. Fossen, Underactuated Ship Stabilization using Integral Control : Experimental Results with Cybership I. IFAC NOLCOS, 1998.[17] A. P. Aguiar, L. Cremean and J. P. Hespanha, Position Tracking for a Nonlinear Underactuated Hovercraft : Controller Design and Experimental Results, Decision and Control conference, 2003.[18] P. Morin and C. Samson, Practical stabilization of driftless systems on Lie groups, INRIA, Tech. Rep. 4294, 2001.

� Model

� Commands

20

21

� Outputs x, y & are flat outputs:

22

� Control law:

� Stability and convergence are assured for the closed loop system with:

23

� Experimental platform� Motion Capture system

� Drone

� Identification process� Identification process� Aerodynamic forces and moments

� Friction effects (static and kinetic)

� Grey box identification

� Trajectory tracking results

24

• software MOTIVE

• Remote control

Streaming VRPN

Communication ZigBee

Infrared cameras s250e Optitrack

25

• Embedded computer

• Microcontroller MikroKopter

Serial port

Drone

26

� Trajectory tracking realized by the flatness control law� Reference trajectory constraints:

� Derivatives until the second order for the state and third order for the referencefor the reference

� Experimental conditions� Circular trajectory tracking with radius 1.1m

� Initial position :50cm from the reference trajectory

� Ground : parquet (tiles during identification process)

27

28

29

30

� The theorem applies for the unicycle robot with

31

32

33

� The theorem applies for the slider with

34

35

We can consider the error tracking system at an equilibrium point with

36

37

A change of coordinates

38

A Lyapunov function candidate :

Its time-derivative :

39

By duality, OK if :

For the complete system, the previous law u1 and the following yaw rate viewed as virtualInput (completed by backstepping technique) ensure the fixed point stabilization:

40

Proof : Lyapunov function candidate :

Time-derivative of the Lyapunov function :

LaSalle arguments :

41

On this invariant subset we can prove that e2 remains constant and that the yaw ratesatisfies the assumptions of proposition 3.1 if ω is sufficiently small.:

42

43

• A switch control strategy for unicycle and slider type robots.

44

• The time-varying control should be used for trajectory tracking but in a practical sense.

• How to extend these results in the context of finite-time stabilization ?