Flexible-cost slam

The ability of a robot to track its position and its surroundings is critical in mobile robotics applications, such as autonomous transport, farming, search-and-rescue, and planetary exploration. As a foundational building block to such tasks, localization must remain reliable and unobtrusive. For example, it must not provide an unneeded level of precision, when the cost of doing so displaces higher-level tasks from a busy CPU. Nor should it produce noisy estimates on the cheap, when there are CPU cycles to spare. This thesis explores localization solutions that provide exactly the amount of accuracy needed to a given task. We begin with a real-world system used in the DARPA Learning Applied to Ground Robotics (LAGR) competition. Using a novel hybrid of wheel and visual odometry, we cut the cost of visual odometry from 100% of a CPU to 5%, clearing room for other critical visual processes, such as long-range terrain classification. We present our hybrid odometer in chapter 2. Next, we describe a novel SLAM algorithm that provides a means to choose the desired balance between cost and accuracy. At its fastest setting, our algorithm converges faster than previous stochastic SLAM solvers, while maintaining significantly better accuracy. At its most accurate, it provides the same solution as exact SLAM solvers. Its main feature, however, is the ability to flexibly choose any point between these two extremes of speed and precision, as circumstances demand. As a result, we are able to guarantee real-time performance at each timestep on city-scale maps with large loops. We present this solver in chapter 3, along with results from both commonly available datasets and Google Street View data. Taken as a whole, this thesis recognizes that precision and efficiency can be competing values, whose proper balance depends on the application and its fluctuating circumstances. It demonstrates how a localizer can and should fit its cost to the task at hand, rather than the other way around. In enabling this flexibility, we demonstrate a new direction for SLAM research, as well as provide a new convenience for end-users, who may wish to map the world without stopping it.

[1]  A. George Nested Dissection of a Regular Finite Element Mesh , 1973 .

[2]  Hans P. Moravec Obstacle avoidance and navigation in the real world by a seeing robot rover , 1980 .

[3]  Robert C. Bolles,et al.  Random sample consensus: a paradigm for model fitting with applications to image analysis and automated cartography , 1981, CACM.

[4]  Peter Cheeseman,et al.  On the Representation and Estimation of Spatial Uncertainty , 1986 .

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

[6]  Hilbert J. Kappen,et al.  On-line learning processes in artificial neural networks , 1993 .

[7]  K. Ikeuchi,et al.  Iterative Estimation of Rotation and Translation using the Quaternion , 1995 .

[8]  P. Heggernes,et al.  Finding Good Column Orderings for Sparse QR Factorization , 1996 .

[9]  J. van Leeuwen,et al.  Neural Networks: Tricks of the Trade , 2002, Lecture Notes in Computer Science.

[10]  Hugh F. Durrant-Whyte,et al.  A high integrity IMU/GPS navigation loop for autonomous land vehicle applications , 1999, IEEE Trans. Robotics Autom..

[11]  Alison K. Brown,et al.  Inertial Navigation Electro-Optical Aiding During GPS Dropouts , 2002 .

[12]  Sebastian Thrun,et al.  Robotic mapping: a survey , 2003 .

[13]  Hugh F. Durrant-Whyte,et al.  Simultaneous Localization and Mapping with Sparse Extended Information Filters , 2004, Int. J. Robotics Res..

[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]  J. Borenstein,et al.  Current-Based Slippage Detection and Odometry Correction for Mobile Robots and Planetary Rovers , 2006, IEEE Transactions on Robotics.

[16]  Frank Dellaert,et al.  Square Root SAM: Simultaneous Localization and Mapping via Square Root Information Smoothing , 2006, Int. J. Robotics Res..

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

[18]  Timothy A. Davis,et al.  Direct methods for sparse linear systems , 2006, Fundamentals of algorithms.

[19]  Larry Matthies,et al.  Two years of Visual Odometry on the Mars Exploration Rovers: Field Reports , 2007 .

[20]  Wolfram Burgard,et al.  A Tree Parameterization for Efficiently Computing Maximum Likelihood Maps using Gradient Descent , 2007, Robotics: Science and Systems.

[21]  K. Konolige Rough Terrain Visual Odometry , 2007 .

[22]  Matthew R. Walter,et al.  Exactly Sparse Extended Information Filters for Feature-based SLAM , 2007, Int. J. Robotics Res..

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

[24]  Karsten Berns,et al.  Real-Time Visual Self-Localisation in Dynamic Environments , 2007, AMS.

[25]  Karl Iagnemma,et al.  Model-Based Wheel Slip Detection for Outdoor Mobile Robots , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[26]  Clark N. Taylor,et al.  Improving MAV pose estimation using visual information , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[27]  Karl Iagnemma,et al.  Classification-Based Wheel Slip Detection and Detector Fusion for Outdoor Mobile Robots , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[28]  Michael Veth,et al.  Two-Dimensional Stochastic Projections for Tight Integration of Optical and Inertial Sensors for Navigation , 2007 .

[29]  Ian D. Reid,et al.  Simultaneous Localisation and Mapping in Dynamic Environments (SLAMIDE) with Reversible Data Associa , 2007, Robotics: Science and Systems.

[30]  Andrew Howard,et al.  Real-time stereo visual odometry for autonomous ground vehicles , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[31]  Edwin Olson,et al.  Robust and efficient robotic mapping , 2008 .

[32]  J. Reid,et al.  An approximate minimum degree algorithm for matrices with dense rows , 2008 .

[33]  Wolfram Burgard,et al.  Simultaneous Localisation and Mapping in Dynamic Environments (SLAMIDE) with Reversible Data Association , 2008 .

[34]  David W. Murray,et al.  Improving the Agility of Keyframe-Based SLAM , 2008, ECCV.

[35]  Christoph Hertzberg,et al.  A Framework for Sparse, Non-Linear Least Squares Problems on Manifolds-Ein Rahmen für dünnbesetzte, nichtlineare quadratische Ausgleichsrechnung auf Mannigfaltigkeiten , 2008 .

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

[37]  Yann LeCun,et al.  A multirange architecture for collision-free off-road robot navigation , 2009 .

[38]  Yann LeCun,et al.  Learning long‐range vision for autonomous off‐road driving , 2009, J. Field Robotics.

[39]  Frank Dellaert,et al.  Flow separation for fast and robust stereo odometry , 2009, 2009 IEEE International Conference on Robotics and Automation.

[40]  Wolfram Burgard,et al.  Efficient Sparse Pose Adjustment for 2D mapping , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[41]  Yann LeCun,et al.  Hybrid hessians for flexible optimization of pose graphs , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[42]  Cyrill Stachniss,et al.  Hierarchical optimization on manifolds for online 2D and 3D mapping , 2010, 2010 IEEE International Conference on Robotics and Automation.

[43]  Frank Dellaert,et al.  The Bayes Tree: An Algorithmic Foundation for Probabilistic Robot Mapping , 2010, WAFR.

[44]  Frank Dellaert,et al.  Subgraph-preconditioned conjugate gradients for large scale SLAM , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[45]  Albert S. Huang,et al.  Visual Odometry and Mapping for Autonomous Flight Using an RGB-D Camera , 2011, ISRR.

[46]  Roland Siegwart,et al.  Robust Real-Time Visual Odometry with a Single Camera and an IMU , 2011, BMVC.

[47]  Davide Scaramuzza,et al.  Exploiting motion priors in visual odometry for vehicle-mounted cameras with non-holonomic constraints , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[48]  Timothy A. Davis,et al.  Algorithm 915, SuiteSparseQR: Multifrontal multithreaded rank-revealing sparse QR factorization , 2011, TOMS.

[49]  Grgoire Montavon,et al.  Neural Networks: Tricks of the Trade , 2012, Lecture Notes in Computer Science.

[50]  Klaus-Robert Müller,et al.  Efficient BackProp , 2012, Neural Networks: Tricks of the Trade.