Closed-form solution for absolute scale velocity estimation using visual and inertial data with a sliding least-squares estimation

In this paper a method for the on-line absolute-scale velocity estimation of a system composed of a single camera and of an inertial measurement unit is presented. The proposed formulation makes use of spherical image measurements acquired from at least three camera positions and inertial measurements to estimate the system velocity by solving also the absolute scale problem. A new multi-rate formulation based on a sliding least-squares estimation formulation is proposed, which is capable of providing the velocity estimation also in cases of constant and zero velocity. The effectiveness of the proposed approach is shown through extensive simulations.

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

[2]  Kenzo Nonami,et al.  Optic flow-based vision system for autonomous 3D localization and control of small aerial vehicles , 2009, Robotics Auton. Syst..

[3]  Roland Siegwart,et al.  A Toolbox for Easily Calibrating Omnidirectional Cameras , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[5]  Vincenzo Lippiello,et al.  Exploiting redundancy in Cartesian impedance control of UAVs equipped with a robotic arm , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[6]  Rogelio Lozano,et al.  Robust adaptive identification of slowly time-varying parameters with bounded disturbances , 1997 .

[7]  Takeo Kanade,et al.  A visual odometer for autonomous helicopter flight , 1999, Robotics Auton. Syst..

[8]  Aníbal Ollero,et al.  Vision-Based Odometry and SLAM for Medium and High Altitude Flying UAVs , 2009, J. Intell. Robotic Syst..

[9]  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.

[10]  Tom Drummond,et al.  Scalable Monocular SLAM , 2006, 2006 IEEE Computer Society Conference on Computer Vision and Pattern Recognition (CVPR'06).

[11]  T. Kanade,et al.  Real-time and 3D vision for autonomous small and micro air vehicles , 2004, 2004 43rd IEEE Conference on Decision and Control (CDC) (IEEE Cat. No.04CH37601).

[12]  Bernhard P. Wrobel,et al.  Multiple View Geometry in Computer Vision , 2001 .

[13]  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.

[14]  James R. Bergen,et al.  Visual odometry , 2004, Proceedings of the 2004 IEEE Computer Society Conference on Computer Vision and Pattern Recognition, 2004. CVPR 2004..

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

[16]  Takeo Kanade,et al.  An Iterative Image Registration Technique with an Application to Stereo Vision , 1981, IJCAI.

[17]  Larry H. Matthies,et al.  Vision Guided Landing of an Autonomous Helicopter in Hazardous Terrain , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[18]  S. Stramigioli,et al.  Aerial Service Robots: An overview of the AIRobots activity , 2012, 2012 2nd International Conference on Applied Robotics for the Power Industry (CARPI).

[19]  Vincenzo Lippiello,et al.  MAV indoor navigation based on a closed-form solution for absolute scale velocity estimation using Optical Flow and inertial data , 2011, IEEE Conference on Decision and Control and European Control Conference.

[20]  Vincenzo Lippiello,et al.  Wall inspection control of a VTOL unmanned aerial vehicle based on a stereo optical flow , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[21]  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.

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

[23]  Dominik Aufderheide,et al.  A visual-inertial approach for camera egomotion estimation and simultaneous recovery of scene structure , 2010, 2010 IEEE International Conference on Virtual Environments, Human-Computer Interfaces and Measurement Systems.

[24]  Vincenzo Lippiello,et al.  Cartesian Impedance Control of a UAV with a Robotic Arm , 2012, SyRoCo.

[25]  P. Chiacchio,et al.  Aerial service robotics: The AIRobots perspective , 2012, 2012 2nd International Conference on Applied Robotics for the Power Industry (CARPI).

[26]  J.-Y. Bouguet,et al.  Pyramidal implementation of the lucas kanade feature tracker , 1999 .

[27]  Salah Sukkarieh,et al.  Real-time implementation of airborne inertial-SLAM , 2007, Robotics Auton. Syst..

[28]  R. Lozano,et al.  Robust adaptive identification of slowly time-varying parameters with bounded disturbances , 1997, 1997 European Control Conference (ECC).