Planning algorithms are impacting technical disciplines and industries around the world, including robotics, computer-aided design, manufacturing, computer graphics, aerospace applications, drug design, and protein folding. This coherent and comprehensive book unifies material from several sources, including robotics, control theory, artificial intelligence, and algorithms. The treatment is centered on robot motion planning but integrates material on planning in discrete spaces. A major part of the book is devoted to planning under uncertainty, including decision theory, Markov decision processes, and information spaces, which are the “configuration spaces” of all sensor-based planning problems. The last part of the book delves into planning under differential constraints that arise when automating the motions of virtually any mechanical system. Developed from courses taught by the author, the book is intended for students, engineers, and researchers in robotics, artificial intelligence, and control theory as well as computer graphics, algorithms, and computational biology.

Planning Algorithms: Introductory Material

The extended Kalman filter (EKF) is probably the most widely used estimation algorithm for nonlinear systems. However, more than 35 years of experience in the estimation community has shown that is difficult to implement, difficult to tune, and only reliable for systems that are almost linear on the time scale of the updates. Many of these difficulties arise from its use of linearization. To overcome this limitation, the unscented transformation (UT) was developed as a method to propagate mean and covariance information through nonlinear transformations. It is more accurate, easier to implement, and uses the same order of calculations as linearization. This paper reviews the motivation, development, use, and implications of the UT.

/pdf/unscented-filtering-and-nonlinear-estimation-44xbx5prtw.pdf

Unscented filtering and nonlinear estimation

We present a real-time algorithm which can recover the 3D trajectory of a monocular camera, moving rapidly through a previously unknown scene. Our system, which we dub MonoSLAM, is the first successful application of the SLAM methodology from mobile robotics to the "pure vision" domain of a single uncontrolled camera, achieving real time but drift-free performance inaccessible to structure from motion approaches. The core of the approach is the online creation of a sparse but persistent map of natural landmarks within a probabilistic framework. Our key novel contributions include an active approach to mapping and measurement, the use of a general motion model for smooth camera movement, and solutions for monocular feature initialization and feature orientation estimation. Together, these add up to an extremely efficient and robust algorithm which runs at 30 Hz with standard PC and camera hardware. This work extends the range of robotic systems in which SLAM can be usefully applied, but also opens up new areas. We present applications of MonoSLAM to real-time 3D localization and mapping for a high-performance full-size humanoid robot and live augmented reality with a hand-held camera

/pdf/monoslam-real-time-single-camera-slam-ydmj8dc1vj.pdf

MonoSLAM: Real-Time Single Camera SLAM

This paper describes the simultaneous localization and mapping (SLAM) problem and the essential methods for solving the SLAM problem and summarizes key implementations and demonstrations of the method. While there are still many practical issues to overcome, especially in more complex outdoor environments, the general SLAM method is now a well understood and established part of robotics. Another part of the tutorial summarized more recent works in addressing some of the remaining issues in SLAM, including computation, feature representation, and data association

/pdf/simultaneous-localization-and-mapping-part-i-22ofxwafhj.pdf

Simultaneous localization and mapping: part I

This paper describes a new approach for generalizing the Kalman filter to nonlinear systems. A set of samples are used to parametrize the mean and covariance of a (not necessarily Gaussian) probability distribution. The method yields a filter that is more accurate than an extended Kalman filter (EKF) and easier to implement than an EKF or a Gauss second-order filter. Its effectiveness is demonstrated using an example.

/pdf/a-new-method-for-the-nonlinear-transformation-of-means-and-17a2m82o66.pdf

A new method for the nonlinear transformation of means and covariances in filters and estimators

The simultaneous localization and map building (SLAM) problem asks if it is possible for an autonomous vehicle to start in an unknown location in an unknown environment and then to incrementally build a map of this environment while simultaneously using this map to compute absolute vehicle location. Starting from estimation-theoretic foundations of this problem, the paper proves that a solution to the SLAM problem is indeed possible. The underlying structure of the SLAM problem is first elucidated. A proof that the estimated map converges monotonically to a relative map with zero uncertainty is then developed. It is then shown that the absolute accuracy of the map and the vehicle location reach a lower bound defined only by the initial vehicle uncertainty. Together, these results show that it is possible for an autonomous vehicle to start in an unknown location in an unknown environment and, using relative observations only, incrementally build a perfect map of the world and to compute simultaneously a bounded estimate of vehicle location. The paper also describes a substantial implementation of the SLAM algorithm on a vehicle operating in an outdoor environment using millimeter-wave radar to provide relative map observations. This implementation is used to demonstrate how some key issues such as map management and data association can be handled in a practical environment. The results obtained are cross-compared with absolute locations of the map landmarks obtained by surveying. In conclusion, the paper discusses a number of key issues raised by the solution to the SLAM problem including suboptimal map-building algorithms and map management.

/pdf/a-solution-to-the-simultaneous-localization-and-map-building-2pp3i7uhdj.pdf

A solution to the simultaneous localization and map building (SLAM) problem

This paper discusses the use of a 77 GHz millimeter wave radar as a guidance sensor for autonomous land vehicle navigation. A test vehicle has been fitted with a radar and encoders that give steer angle and velocity. An extended Kalman filter optimally fuses the radar range and bearing measurements with vehicle control signals to give estimated position and variance as the vehicle moves around a test site. The effectiveness of this data fusion is compared with encoders alone and with a satellite positioning system. Consecutive scans have been combined to give a radar image of the surrounding environment. Data in this format are invaluable for future work on collision detection and map building navigation.

Autonomous land vehicle navigation using millimeter wave radar

Discusses the use of a 77 GHz millimetre wave radar as a guidance sensor for autonomous land vehicle navigation. An extended Kalman filter (EKF) maintains an estimate of map features in addition to vehicle state. This map augmented EKF is implemented with radar reflectors, designed for high visibility from all orientations. An improvement on this approach enables natural features to be identified, using the polarisation of returned radar signals. Those that are suitable as navigational markers are used to update estimates of vehicle and feature locations. This method requires no a priori knowledge of the environment and no target infrastructure.

S. Clark

Papers

A solution to the simultaneous localization and map building (SLAM) problem

Autonomous land vehicle navigation using millimeter wave radar

Simultaneous localisation and map building using millimetre wave radar to extract natural features