1
A general optical flow based terrainfollowing strategy for a VTOL UAV using multiple views
Bruno Hérissé
Sophie Oustrières
Tarek Hamel
Robert Mahony
François-Xavier Russotto
CEA LIST Fontenay-Aux-Roses, France
[email protected]
CEA LIST Fontenay-Aux-Roses, France
I3S - CNRS Nice-Sophia Antipolis, France
[email protected]
Dep. of Eng., Australian Nat. Univ. ACT, 0200, Australia
[email protected]
CEA LIST Fontenay-Aux-Roses, France
[email protected]
2
Introduction •
Purpose : Design of a controller for a VTOL UAV using inertial data, barometric altimeter and visual optical flow measurments.
IMU
Barometric altimeter
(Inertial Measurments Unit)
Camera (OF Measurments)
3
State Model of the quadrotor UAV T
• •
•
•
The system is nonlinear and under actuated. Definition of the used reference frames. I : Inertial frame attached to the earth B : body-fixed frame attached to the vehicle at the center of mass. Vehicle state: ξ : position of the center of mass in I v : speed of the center of mass in I R : orientation matrix from B to I Ω : rotational velocity in B Inputs: T : Global thrust in B Γ : Control torque in B
Γ
Translational dynamics
Rotational Dynamics Already controlled
High gain controller
4
Average optical Flow •
Average optical flow is computed from the integral of all observed optical flow around a specified direction
•
The forward optical flow Impossible d’afficher l’image.
•
T Γ
The normal optical flow T Γ
5
Terrain following with 1 aperture (ICRA'09)
•
The control law
ensures the asymptotic convergence of
•
The UAV does not collide the obstacle
to
6
Robustness ?
•
The forward velocity
may vary with time
•
The optical flow is noisy
•
The surface may be sloped
•
The target surface may be non-planar
7
Terrain following: sloped target
8
Computation of the OF in any directions
9
Corner avoidance ?
10
Controller for terrain following
UAV dynamics
Average optical flow in any directions + "derotation"
State:
11
Corner avoidance !
12
Improvement for terrain following !
13
Disturbed dynamics
14
Attractor
15
Experimental setup
Camera: - Focus: 2.1mm
Drone: - Embeded attitude control -running at 166Hz
Numerical transmission: - Attitude - IMU data - 70 ms required
Textured terrain
Analogical transmission: - 2.4GHz - Image Frequency 20Hz
Ground station: - OF Processing - 15Hz
16
Experiments
17
Conclusion •
Possible extensions 3-D Corner avoidance Wall following (cameras looking forward and sideways) Corridor following (2 cameras looking on the left side and the right side)
•
The approach is robust but… We need velocity measurements for the forward velocity regulation (particularly for indoor applications) We need textured terrains (indoor?)
•
Future work Full 3-D motion Outdoor experiments Full embedded system (image processing) with more efficient cameras (mouse sensors, VLSI)