Feature-rich path planning for robust navigation of MAVs with Mono-SLAM

We present a path planning method for MAVs with vision-only MonoSLAM that generates safe paths to a goal according to the information richness of the environment. The planner runs on top of monocular SLAM and uses the available information about structure of the environment and features visibility to find trajectories that maintain visual contact with feature-rich areas. The MAV continuously re-plans as it explores and updates the feature-points in the map. In real-world experiments we show that our system is able to avoid paths that lead into visually-poor sections of the environment by considering the distribution of visual features. If the same system ignores the availability of visually-informative regions in the planning, it is unable to estimate its state accurately and fails to reach its goal.

[1]  Nicholas Roy,et al.  Planning in information space for a quadrotor helicopter in a GPS-denied environment , 2008, 2008 IEEE International Conference on Robotics and Automation.

[2]  Atsushi Yamashita,et al.  Path and viewpoint planning of mobile robots with multiple observation strategies , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

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

[4]  Yoshiaki Shirai,et al.  On-line viewpoint and motion planning for efficient visual navigation under uncertainty , 1999, Robotics Auton. Syst..

[5]  James J. Little,et al.  Dynamic visibility checking for vision-based motion planning , 2008, 2008 IEEE International Conference on Robotics and Automation.

[6]  Daniel Cremers,et al.  Camera-based navigation of a low-cost quadrocopter , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[7]  Nicholas Roy,et al.  Rapidly-exploring Random Belief Trees for motion planning under uncertainty , 2011, 2011 IEEE International Conference on Robotics and Automation.

[8]  Alexander Zelinsky,et al.  Biologically-inspired visual landmark learning and navigation for mobile robots , 1999, Proceedings 1999 IEEE/RSJ International Conference on Intelligent Robots and Systems. Human and Environment Friendly Robots with High Intelligence and Emotional Quotients (Cat. No.99CH36289).

[9]  Ryan M. Eustice,et al.  Combined visually and geometrically informative link hypothesis for pose-graph visual SLAM using bag-of-words , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[10]  Emilio Frazzoli,et al.  Sampling-based algorithms for optimal motion planning , 2011, Int. J. Robotics Res..

[11]  J. How,et al.  Information-rich Path Planning with General Constraints using Rapidly-exploring Random Trees , 2010 .

[12]  Marc Pollefeys,et al.  Vision-based autonomous mapping and exploration using a quadrotor MAV , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[14]  Wolfram Burgard,et al.  Coastal navigation-mobile robot navigation with uncertainty in dynamic environments , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[15]  In-Joong Ha,et al.  Novel Position-Based Visual Servoing Approach to Robust Global Stability Under Field-of-View Constraint , 2012, IEEE Transactions on Industrial Electronics.

[16]  Antonio Bicchi,et al.  Visual Appearance Mapping for Optimal Vision Based Servoing , 2008, ISER.

[17]  Ryan M. Eustice,et al.  Perception-driven navigation: Active visual SLAM for robotic area coverage , 2013, 2013 IEEE International Conference on Robotics and Automation.

[18]  Simone Frintrop,et al.  Active gaze control for attentional visual SLAM , 2008, 2008 IEEE International Conference on Robotics and Automation.

[19]  Juan Andrade-Cetto,et al.  Path planning in belief space with pose SLAM , 2011, 2011 IEEE International Conference on Robotics and Automation.

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

[21]  Jean-Philippe Pons,et al.  Efficient Multi-View Reconstruction of Large-Scale Scenes using Interest Points, Delaunay Triangulation and Graph Cuts , 2007, 2007 IEEE 11th International Conference on Computer Vision.