Vision based navigation for micro helicopters

In this dissertation, we study the issues of vehicle state estimation and sensor self-calibration which arise while navigating a micro helicopter in large and initially unknown environments. While proper vehicle state estimation allows long-term navigation, sensor self-calibration renders the vehicle a power-onand-go system without the need of prior and offline calibration steps. Due to the inherent payload limitation of airborne vehicles like, and especially, a micro helicopter and the restricted availability of global localization information in indoor or urban environments, we focus on vision based methods in order to achieve our goals. Despite this focus on processing visual cues, we analyze a general and modular approach which allows the use of a variety of different sensor types. In vision based methods, the camera needs special attention. In contrast to other sensors, vision sensors typically yield vast information that needs complex strategies to permit use in real-time and on computationally constrained platforms. We show that our map-based visual odometry strategy derived from a state-of-the-art structure-from-motion framework is particularly suitable for locally stable, pose controlled flight. Issues concerning drifts and robustness are analyzed and discussed with respect to the original framework. A map-less strategy based on optical flow and inertial constraints is presented in order to mitigate other map-related issues such as map losses and initialization procedures. While in the map-based approach the camera acts as a real-time pose sensor, in the map-less approach it acts as a realtime body-velocity sensor capable of velocity-control the airborne vehicle. We show that both approaches can be combined in a unifying and complementary framework to mitigate each others weaknesses. In all cases, the algorithms are capable of running in real-time on a computationally constrained platform. For aerial vehicle navigation we study a statistical and modular sensorfusion strategy. We focus on the optimal state estimation of the vehicle to avoid additional, computationally heavy control approaches. In particular, we discuss the metric recovery of an arbitrarily scaled pose or body-velocity

[1]  Matthew Johnson-Roberson,et al.  Airborne smoothing and mapping using vision and inertial sensors , 2009, 2009 IEEE International Conference on Robotics and Automation.

[2]  Abraham Bachrach,et al.  Autonomous flight in unstructured and unknown indoor environments , 2009 .

[3]  Agostino Martinelli,et al.  Vision and IMU Data Fusion: Closed-Form Solutions for Attitude, Speed, Absolute Scale, and Bias Determination , 2012, IEEE Transactions on Robotics.

[4]  Vijay Kumar,et al.  Minimum snap trajectory generation and control for quadrotors , 2011, 2011 IEEE International Conference on Robotics and Automation.

[5]  Olivier Stasse,et al.  MonoSLAM: Real-Time Single Camera SLAM , 2007, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[6]  Paul Timothy Furgale,et al.  Visual teach and repeat for long‐range rover autonomy , 2010, J. Field Robotics.

[7]  Atsushi Konno,et al.  Design and simulation of a quad rotor tail-sitter unmanned aerial vehicle , 2010, 2010 IEEE/SICE International Symposium on System Integration.

[8]  Roland Siegwart,et al.  Closed-form solution for absolute scale velocity determination combining inertial measurements and a single feature correspondence , 2011, 2011 IEEE International Conference on Robotics and Automation.

[9]  Roland Siegwart,et al.  MAV navigation through indoor corridors using optical flow , 2010, 2010 IEEE International Conference on Robotics and Automation.

[10]  Ian D. Reid,et al.  Adaptive relative bundle adjustment , 2009, Robotics: Science and Systems.

[11]  Eric N. Johnson,et al.  Vision-Only Aircraft Flight Control Methods and Test Results , 2004 .

[12]  R. Chellappa,et al.  Bayesian structure from motion using inertial information , 2002, Proceedings. International Conference on Image Processing.

[13]  Vijay Kumar,et al.  The GRASP Multiple Micro-UAV Testbed , 2010, IEEE Robotics & Automation Magazine.

[14]  Peng Kemao,et al.  Design and Implementation of a Fully Autonomous Flight Control System for a UAV Helicopter , 2006, 2007 Chinese Control Conference.

[15]  Robert E. Mahony,et al.  Hovering flight and vertical landing control of a VTOL Unmanned Aerial Vehicle using optical flow , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[16]  Gustaf Hendeby,et al.  Using optical flow for filling the gaps in visual-inertial tracking , 2010, 2010 18th European Signal Processing Conference.

[17]  Roland Siegwart,et al.  Versatile distributed pose estimation and sensor self-calibration for an autonomous MAV , 2012, 2012 IEEE International Conference on Robotics and Automation.

[18]  S. Park,et al.  RIC (robust internal-loop compensator) based flight control of a quad-rotor type UAV , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[19]  Carlo Tomasi,et al.  Good features to track , 1994, 1994 Proceedings of IEEE Conference on Computer Vision and Pattern Recognition.

[20]  Markus Vincze,et al.  Simultaneous Motion and Structure Estimation by Fusion of Inertial and Vision Data , 2007, Int. J. Robotics Res..

[21]  Robert E. Mahony,et al.  A nonlinear observer for 6 DOF pose estimation from inertial and bearing measurements , 2009, 2009 IEEE International Conference on Robotics and Automation.

[22]  Nicholas Roy,et al.  Autonomous Flight in Unknown Indoor Environments , 2009 .

[23]  Christopher Hunt,et al.  Notes on the OpenSURF Library , 2009 .

[24]  Matthew A. Garratt,et al.  Vision‐based terrain following for an unmanned rotorcraft , 2008, J. Field Robotics.

[25]  Roland Siegwart,et al.  3D surveillance coverage using maps extracted by a monocular SLAM algorithm , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[26]  Stergios I. Roumeliotis,et al.  1|A Kalman filter-based algorithm for IMU-camera calibration , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[27]  Roland Siegwart,et al.  Vision Based Position Control for MAVs Using One Single Circular Landmark , 2011, J. Intell. Robotic Syst..

[28]  Roland Siegwart,et al.  Fusion of IMU and Vision for Absolute Scale Estimation in Monocular SLAM , 2011, J. Intell. Robotic Syst..

[29]  Christopher G. Harris,et al.  A Combined Corner and Edge Detector , 1988, Alvey Vision Conference.

[30]  Sanjiv Singh,et al.  Optimal motion estimation from visual and inertial measurements , 2002, Sixth IEEE Workshop on Applications of Computer Vision, 2002. (WACV 2002). Proceedings..

[31]  Jian Chen,et al.  UAV Tracking with a Monocular Camera , 2006, Proceedings of the 45th IEEE Conference on Decision and Control.

[32]  Agostino Martinelli,et al.  Vision-aided inertial navigation: Closed-form determination of absolute scale, speed and attitude , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[33]  Roland Siegwart,et al.  Vision based MAV navigation in unknown and unstructured environments , 2010, 2010 IEEE International Conference on Robotics and Automation.

[34]  Dario Floreano,et al.  Vision-based control of near-obstacle flight , 2009, Auton. Robots.

[35]  Agostino Martinelli,et al.  State Estimation Based on the Concept of Continuous Symmetry and Observability Analysis: The Case of Calibration , 2011, IEEE Transactions on Robotics.

[36]  Raffaello D'Andrea,et al.  A simple learning strategy for high-speed quadrocopter multi-flips , 2010, 2010 IEEE International Conference on Robotics and Automation.

[37]  Roland Siegwart,et al.  Real-time metric state estimation for modular vision-inertial systems , 2011, 2011 IEEE International Conference on Robotics and Automation.

[38]  Michael Achtelik,et al.  Design of a flexible high performance quadcopter platform breaking the MAV endurance record with laser power beaming , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[39]  A. Parker On the origin of optics , 2011 .

[40]  Dario Floreano,et al.  Autonomous Flight at Low Altitude Using Light Sensors and Little Computational Power , 2010 .

[41]  Gaurav S. Sukhatme,et al.  Vision-based autonomous landing of an unmanned aerial vehicle , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[42]  A. Davison,et al.  1-Point RANSAC for EKF Filtering . Application to Real-Time Structure from Motion and Visual Odometry , 2010 .

[43]  Stergios I. Roumeliotis,et al.  Augmenting inertial navigation with image-based motion estimation , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[44]  Andrew J. Davison,et al.  DTAM: Dense tracking and mapping in real-time , 2011, 2011 International Conference on Computer Vision.

[45]  Hauke Strasdat,et al.  Real-time monocular SLAM: Why filter? , 2010, 2010 IEEE International Conference on Robotics and Automation.

[46]  Ezio Malis,et al.  Improving vision-based control using efficient second-order minimization techniques , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[47]  Peter I. Corke,et al.  Two Seconds to Touchdown - Vision-Based Controlled Forced Landing , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[48]  Salah Sukkarieh,et al.  Inertial Aiding of Inverse Depth SLAM using a Monocular Camera , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[49]  Klaus Röbenack,et al.  The computation of Lie derivatives and Lie brackets based on automatic differentiation , 2004 .

[50]  Stergios I. Roumeliotis,et al.  Vision-Aided Inertial Navigation for Spacecraft Entry, Descent, and Landing , 2009, IEEE Transactions on Robotics.

[51]  Mac Schwager,et al.  A scalable information theoretic approach to distributed robot coordination , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[52]  Roland Siegwart,et al.  Design and Control of a Miniature Quadrotor , 2007 .

[53]  Roland Siegwart,et al.  Onboard IMU and monocular vision based control for MAVs in unknown in- and outdoor environments , 2011, 2011 IEEE International Conference on Robotics and Automation.

[54]  S. Shankar Sastry,et al.  An Invitation to 3-D Vision: From Images to Geometric Models , 2003 .

[55]  Kevin H. Knuth Bayesian Visual Odometry , 2011 .

[56]  Dario Floreano,et al.  Toward 30-gram Autonomous Indoor Aircraft: Vision-based Obstacle Avoidance and Altitude Control , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[57]  Kemao Peng,et al.  International Conference on Control and Automation ThB 2-4 Guangzhou , CHINA-May 30 to June 1 , 2007 Enhancement of GPS Signals for Automatic Control of a UAV Helicopter System , 2007 .

[58]  Jian Wang,et al.  Markerless, vision-assisted flight control of a quadrocopter , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[59]  T.H. Lee,et al.  Construction, modeling and control of a mini autonomous UAV helicopter , 2008, 2008 IEEE International Conference on Automation and Logistics.

[60]  Stephan D. Weiss,et al.  Calibration of time-of-flight range imaging cameras , 2008, 2008 15th IEEE International Conference on Image Processing.

[61]  Roland Siegwart,et al.  Intuitive 3D Maps for MAV Terrain Exploration and Obstacle Avoidance , 2011, J. Intell. Robotic Syst..

[62]  Stergios I. Roumeliotis,et al.  A Multi-State Constraint Kalman Filter for Vision-aided Inertial Navigation , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[63]  David W. Murray,et al.  Parallel Tracking and Mapping on a camera phone , 2009, 2009 8th IEEE International Symposium on Mixed and Augmented Reality.

[64]  Roland Siegwart,et al.  Real-time onboard visual-inertial state estimation and self-calibration of MAVs in unknown environments , 2012, 2012 IEEE International Conference on Robotics and Automation.

[65]  Roland Siegwart,et al.  Deterministic initialization of metric state estimation filters for loosely-coupled monocular vision-inertial systems , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[66]  Sanjiv Singh,et al.  Motion Estimation from Image and Inertial Measurements , 2004, Int. J. Robotics Res..

[67]  Salah Sukkarieh,et al.  Efficient integration of inertial observations into visual SLAM without initialization , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[68]  L. Luxon,et al.  Vertigo. Its Multisensory Syndromes , 2000, Journal of neurology, neurosurgery, and psychiatry.

[69]  S. Shankar Sastry,et al.  Autonomous Vision-based Landing and Terrain Mapping Using an MPC-controlled Unmanned Rotorcraft , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[70]  Andreas Zell,et al.  Automatic Take Off, Tracking and Landing of a Miniature UAV on a Moving Carrier Vehicle , 2011, J. Intell. Robotic Syst..

[71]  Eagle Jones,et al.  Large scale visual navigation and community map building , 2009 .

[72]  Dario Floreano,et al.  Fly-inspired visual steering of an ultralight indoor aircraft , 2006, IEEE Transactions on Robotics.

[73]  W. Wiltschko,et al.  Magnetic orientation in birds , 1996, The Journal of experimental biology.

[74]  Section De Microtechnique,et al.  design and control of quadrotors with application to autonomous flying , 2007 .

[75]  Gaurav S. Sukhatme,et al.  Combined optic-flow and stereo-based navigation of urban canyons for a UAV , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[76]  Andrew J. Davison,et al.  Mobile Robot Navigation Using Active Vision , 1998 .

[77]  Stefano Soatto,et al.  Visual-inertial navigation, mapping and localization: A scalable real-time causal approach , 2011, Int. J. Robotics Res..

[78]  Robert E. Mahony,et al.  Visual servo trajectory tracking for a four rotor VTOL aerial vehicle , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[79]  Sanjiv Singh,et al.  Online Motion Estimation from Image and Inertial Measurements , 2003 .

[80]  Markus Vincze,et al.  Fast Ego-motion Estimation with Multi-rate Fusion of Inertial and Vision , 2007, Int. J. Robotics Res..

[81]  F. Campbell,et al.  Saccadic omission: Why we do not see a grey-out during a saccadic eye movement , 1978, Vision Research.

[82]  Peter Corke,et al.  An Introduction to Inertial and Visual Sensing , 2007, Int. J. Robotics Res..

[83]  Roland Siegwart,et al.  Monocular‐SLAM–based navigation for autonomous micro helicopters in GPS‐denied environments , 2011, J. Field Robotics.

[84]  G. Klein,et al.  Parallel Tracking and Mapping for Small AR Workspaces , 2007, 2007 6th IEEE and ACM International Symposium on Mixed and Augmented Reality.

[85]  Andrew J. Davison,et al.  Real-time simultaneous localisation and mapping with a single camera , 2003, Proceedings Ninth IEEE International Conference on Computer Vision.

[86]  G LoweDavid,et al.  Distinctive Image Features from Scale-Invariant Keypoints , 2004 .

[87]  B. Breitmeyer,et al.  Temporal studies with flashed gratings: Inferences about human transient and sustained channels , 1977, Vision Research.

[88]  Christian Beder,et al.  Determining an Initial Image Pair for Fixing the Scale of a 3D Reconstruction from an Image Sequence , 2006, DAGM-Symposium.

[89]  Vijay Kumar,et al.  Cooperative Grasping and Transport Using Multiple Quadrotors , 2010, DARS.

[90]  N. Trawny,et al.  Indirect Kalman Filter for 3 D Attitude Estimation , 2005 .

[91]  Nicolas H. Franceschini,et al.  Visually guided micro-aerial vehicle: automatic take off, terrain following, landing and wind reaction , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[92]  Miguel A. Olivares-Méndez,et al.  Visual 3-D SLAM from UAVs , 2009, J. Intell. Robotic Syst..

[93]  Dario Floreano,et al.  A 10-gram vision-based flying robot , 2007, Adv. Robotics.

[94]  Roland Siegwart,et al.  Backstepping and Sliding-mode Techniques Applied to an Indoor Micro Quadrotor , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[95]  Gaurav S. Sukhatme,et al.  Visual-Inertial Sensor Fusion: Localization, Mapping and Sensor-to-Sensor Self-calibration , 2011, Int. J. Robotics Res..

[96]  G. Gerhart,et al.  Stereo vision and laser odometry for autonomous helicopters in GPS-denied indoor environments , 2009 .

[97]  Stergios I. Roumeliotis,et al.  Characterization and optimization of the accuracy of mobile robot localization , 2008 .

[98]  Dario Martin Schafroth,et al.  Aerodynamics, modeling and control of an autonomous micro helicopter , 2010 .

[99]  Peter I. Corke,et al.  Estimating Ego-Motion in Panoramic Image Sequences with Inertial Measurements , 2009, ISRR.

[100]  Dah-Jye Lee,et al.  Vision Aided Stabilization and the Development of a Quad-Rotor Micro UAV , 2007, 2007 International Symposium on Computational Intelligence in Robotics and Automation.

[101]  Roland Siegwart,et al.  Collaborative stereo , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[102]  Markus Vincze,et al.  Fusion of Vision and Inertial Data for Motion and Structure Estimation , 2004, J. Field Robotics.

[103]  Rogelio Lozano,et al.  Stabilization of a mini-rotorcraft having four rotors , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[104]  Robert E. Mahony,et al.  A terrain-following control approach for a VTOL Unmanned Aerial Vehicle using average optical flow , 2010, Auton. Robots.

[105]  Jonathan P. How,et al.  Indoor Multi-Vehicle Flight Testbed for Fault Detection, Isolation, and Recovery , 2006 .

[106]  R. Siegwart,et al.  Observability Properties and Optimal Trajectories for On-line Odometry Self-Calibration , 2006, Proceedings of the 45th IEEE Conference on Decision and Control.

[107]  Jonathan P. How,et al.  Vision-based guidance and control of a hovering vehicle in unknown, GPS-denied environments , 2009, 2009 IEEE International Conference on Robotics and Automation.

[108]  Peter I. Corke An inertial and visual sensing system for a small autonomous helicopter , 2004 .

[109]  A. Krener,et al.  Nonlinear controllability and observability , 1977 .

[110]  Eric W. Frew,et al.  Relative position estimation for AUVs by fusing bearing and inertial rate sensor measurements , 2002, OCEANS '02 MTS/IEEE.

[111]  Eric Johnson,et al.  Augmenting UAV autonomy , 2006, IEEE Robotics & Automation Magazine.

[112]  Roland Siegwart,et al.  Delay and Dropout Tolerant State Estimation for MAVs , 2010, ISER.

[113]  Vijay Kumar,et al.  Trajectory generation and control for precise aggressive maneuvers with quadrotors , 2012, Int. J. Robotics Res..

[114]  Salah Sukkarieh,et al.  Removing scale biases and ambiguity from 6DoF monocular SLAM using inertial , 2008, 2008 IEEE International Conference on Robotics and Automation.

[115]  A. Tsourdos,et al.  Robust nonlinear filtering for INS/GPS UAV localization , 2008, 2008 16th Mediterranean Conference on Control and Automation.

[116]  Robert E. Mahony,et al.  Control of a quadrotor helicopter using visual feedback , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[117]  Roland Siegwart,et al.  Optimal surveillance coverage for teams of micro aerial vehicles in GPS-denied environments using onboard vision , 2012, Auton. Robots.

[118]  J. Simmons,et al.  Acoustic imaging in bat sonar: Echolocation signals and the evolution of echolocation , 1980, Journal of comparative physiology.

[119]  Stephan D. Weiss,et al.  Real-time understanding of 3D video on an embedded system , 2009, 2009 17th European Signal Processing Conference.

[120]  Tom Drummond,et al.  Machine Learning for High-Speed Corner Detection , 2006, ECCV.

[121]  Robert E. Mahony,et al.  Robust Nonlinear Fusion of Inertial and Visual Data for position, velocity and attitude estimation of UAV , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[122]  Peter S. Maybeck,et al.  Stochastic Models, Estimation And Control , 2012 .

[123]  Markus Vincze,et al.  Multi-rate fusion with vision and inertial sensors , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[124]  Jean-Christophe Zufferey,et al.  Bio-inspired vision-based flying robots , 2005 .

[125]  Jürgen Sturm,et al.  An appearance-based visual compass for mobile robots , 2009, Robotics Auton. Syst..

[126]  Rami Abousleiman,et al.  MICRORAPTOR: A LOW-COST AUTONOMOUS QUADROTOR SYSTEM , 2009 .

[127]  B. Bethke,et al.  Real-time indoor autonomous vehicle test environment , 2008, IEEE Control Systems.

[128]  Roland Siegwart,et al.  Robust embedded egomotion estimation , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[129]  Maxime Lhuillier,et al.  Error propagations for local bundle adjustment , 2009, 2009 IEEE Conference on Computer Vision and Pattern Recognition.

[130]  Vijay Kumar,et al.  Cooperative manipulation and transportation with aerial robots , 2009, Auton. Robots.