nonlinear attitude and position control of a micro ...aeromav.free.fr/mav07/session/plenary/session...

16
Nonlinear Attitude and Position Control of a Micro Quadrotor using Sliding Mode and Backstepping Techniques Patrick Adigbli (1) , Ch. Grand (2) , J-B. Mouret (2) , S. Doncieux (2) (1) Technical University of München - Germany (2) Institute of Intelligent Systems and Robotics University Paris 6 - France

Upload: vanhuong

Post on 08-Oct-2018

230 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: Nonlinear Attitude and Position Control of a Micro ...aeromav.free.fr/MAV07/session/plenary/SESSION 6/MAV07-PLEN 6-3... · Nonlinear Attitude and Position Control of a Micro Quadrotor

Nonlinear Attitude and Position Control of a Micro Quadrotor using

Sliding Mode and Backstepping Techniques

Patrick Adigbli(1), Ch. Grand(2), J-B. Mouret (2), S. Doncieux (2)

(1) Technical University of München - Germany

(2) Institute of Intelligent Systems and RoboticsUniversity Paris 6 - France

Page 2: Nonlinear Attitude and Position Control of a Micro ...aeromav.free.fr/MAV07/session/plenary/SESSION 6/MAV07-PLEN 6-3... · Nonlinear Attitude and Position Control of a Micro Quadrotor

21/09/07 - EMAV2007 - European Micro Air Vehicle Conference and Flight Competition

micro Quadri-rotor UAV

Objectives

➡ Compare different control strategies for the stabilization of a micro quadri-rotor UAV

➡ Design and implement the most suitable control law

Outline

1. System modeling

2. Attitude controller

3. Position controller

4. Experimental results

5. Conclusion

Topics of this presentation

2

Page 3: Nonlinear Attitude and Position Control of a Micro ...aeromav.free.fr/MAV07/session/plenary/SESSION 6/MAV07-PLEN 6-3... · Nonlinear Attitude and Position Control of a Micro Quadrotor

21/09/07 - EMAV2007 - European Micro Air Vehicle Conference and Flight Competition

System modeling

• Configuration vectors

• Velocity decoupling matrix

3

Page 4: Nonlinear Attitude and Position Control of a Micro ...aeromav.free.fr/MAV07/session/plenary/SESSION 6/MAV07-PLEN 6-3... · Nonlinear Attitude and Position Control of a Micro Quadrotor

21/09/07 - EMAV2007 - European Micro Air Vehicle Conference and Flight Competition

System modeling

• Forces distribution:

• Actuation model:

4

Page 5: Nonlinear Attitude and Position Control of a Micro ...aeromav.free.fr/MAV07/session/plenary/SESSION 6/MAV07-PLEN 6-3... · Nonlinear Attitude and Position Control of a Micro Quadrotor

21/09/07 - EMAV2007 - European Micro Air Vehicle Conference and Flight Competition

System modeling

• Dynamic equations (Euler-Lagrange):

• Analytical model (with small angles simplification):

• Model abstraction:

5

Page 6: Nonlinear Attitude and Position Control of a Micro ...aeromav.free.fr/MAV07/session/plenary/SESSION 6/MAV07-PLEN 6-3... · Nonlinear Attitude and Position Control of a Micro Quadrotor

21/09/07 - EMAV2007 - European Micro Air Vehicle Conference and Flight Competition

Control strategies

• Two sub-controllers:

- Attitude stabilization

- Position stabilization

• Different control strategies for Attitude Stabilization

- Quaternion based linear feedback controller [Tayebi2006]

- Non-linear backstepping controller [Bouabdallah2005]

- Non-linear sliding-mode controller

• Backstepping controller for Position Stabilization

6

Page 7: Nonlinear Attitude and Position Control of a Micro ...aeromav.free.fr/MAV07/session/plenary/SESSION 6/MAV07-PLEN 6-3... · Nonlinear Attitude and Position Control of a Micro Quadrotor

21/09/07 - EMAV2007 - European Micro Air Vehicle Conference and Flight Competition

Control strategies

7

Cascaded controlarchitecture

Attitude controlarchitecture

Page 8: Nonlinear Attitude and Position Control of a Micro ...aeromav.free.fr/MAV07/session/plenary/SESSION 6/MAV07-PLEN 6-3... · Nonlinear Attitude and Position Control of a Micro Quadrotor

21/09/07 - EMAV2007 - European Micro Air Vehicle Conference and Flight Competition

Attitude control: Linear feedback controller

• Quaternion based controller

- Reduced quaternion vector:

- Linear feedback law:

➡Controller globally asymptotically stable [Tayebi2005]

8

Page 9: Nonlinear Attitude and Position Control of a Micro ...aeromav.free.fr/MAV07/session/plenary/SESSION 6/MAV07-PLEN 6-3... · Nonlinear Attitude and Position Control of a Micro Quadrotor

21/09/07 - EMAV2007 - European Micro Air Vehicle Conference and Flight Competition

Attitude control: Backstepping controller

Define non-linear control lawbased on Lyapunov fonctions

State vector:

Transform dynamic state vector:

Choose Lyapunov candidate function:

Control law :

9

Page 10: Nonlinear Attitude and Position Control of a Micro ...aeromav.free.fr/MAV07/session/plenary/SESSION 6/MAV07-PLEN 6-3... · Nonlinear Attitude and Position Control of a Micro Quadrotor

21/09/07 - EMAV2007 - European Micro Air Vehicle Conference and Flight Competition

Attitude control: Sliding mode controller

State vector:

System dynamic model:

Switching or sliding manifold:

Sliding-mode control law:

➡Proof of control law stability (Lyapunov approach): see paper

10

Page 11: Nonlinear Attitude and Position Control of a Micro ...aeromav.free.fr/MAV07/session/plenary/SESSION 6/MAV07-PLEN 6-3... · Nonlinear Attitude and Position Control of a Micro Quadrotor

21/09/07 - EMAV2007 - European Micro Air Vehicle Conference and Flight Competition

Attitude control: analysis and comparison

11

Page 12: Nonlinear Attitude and Position Control of a Micro ...aeromav.free.fr/MAV07/session/plenary/SESSION 6/MAV07-PLEN 6-3... · Nonlinear Attitude and Position Control of a Micro Quadrotor

21/09/07 - EMAV2007 - European Micro Air Vehicle Conference and Flight Competition

Attitude control: analysis and comparison

12

Page 13: Nonlinear Attitude and Position Control of a Micro ...aeromav.free.fr/MAV07/session/plenary/SESSION 6/MAV07-PLEN 6-3... · Nonlinear Attitude and Position Control of a Micro Quadrotor

21/09/07 - EMAV2007 - European Micro Air Vehicle Conference and Flight Competition

Position control: Backstepping controller

13

Dynamic model based position controller:

Using same approach based on Lyapunov function:

Page 14: Nonlinear Attitude and Position Control of a Micro ...aeromav.free.fr/MAV07/session/plenary/SESSION 6/MAV07-PLEN 6-3... · Nonlinear Attitude and Position Control of a Micro Quadrotor

21/09/07 - EMAV2007 - European Micro Air Vehicle Conference and Flight Competition

Position control: Backstepping controller

• Simulation results

14

Page 15: Nonlinear Attitude and Position Control of a Micro ...aeromav.free.fr/MAV07/session/plenary/SESSION 6/MAV07-PLEN 6-3... · Nonlinear Attitude and Position Control of a Micro Quadrotor

21/09/07 - EMAV2007 - European Micro Air Vehicle Conference and Flight Competition

First experiments: attitude stabilization

15

Page 16: Nonlinear Attitude and Position Control of a Micro ...aeromav.free.fr/MAV07/session/plenary/SESSION 6/MAV07-PLEN 6-3... · Nonlinear Attitude and Position Control of a Micro Quadrotor

21/09/07 - EMAV2007 - European Micro Air Vehicle Conference and Flight Competition

Conclusions

• Developed a simplified dynamic model for a quadri-rotor

• Analyzed different control strategies for the attitude control

- Linear feedback law, backstepping, sliding-mode controller

• Proposed a backstepping controller for position stabilization

• Evaluated and tuned the controller using numerical simulations

• First test on a real prototype of quadri-rotor UAV

16