Simultaneous localization and mapping

Simultaneous localization and mapping (SLAM) is a method by which a mobile robot builds a map of an unknown environment while determining its own position within it, resolving the interdependence between mapping and localization through probabilistic state estimation updated from sensor observations.

What Is Simultaneous Localization and Mapping?

Simultaneous localization and mapping (SLAM) is a computational method by which a mobile robot or autonomous agent constructs a map of an unknown environment while concurrently determining its own position within that map. Because neither the map nor the pose of the agent is known a priori, the two estimation problems are interdependent: accurate localization requires a map, and accurate mapping requires a reliable position estimate. SLAM addresses this circular dependency through probabilistic state estimation, maintaining a joint distribution over the map and the vehicle pose that is updated as new sensor observations arrive.

The problem was formalized in the mid-1980s and early 1990s through work in mobile robotics and stochastic estimation theory. The landmark tutorial by Durrant-Whyte and Bailey in IEEE Robotics and Automation Magazine established the probabilistic framework that unified the field and identified the fundamental consistency and convergence properties of SLAM solutions. Since then the field has expanded from indoor wheeled robots carrying laser rangefinders to aerial vehicles, underwater robots, and hand-held devices using cameras as the primary sensor.

Probabilistic State Estimation

The mathematical core of SLAM is a belief over the joint state of the vehicle pose and the map at each timestep, updated via Bayesian filtering as motion commands and sensor measurements arrive. Early SLAM implementations used the Extended Kalman Filter (EKF-SLAM), which represents this belief as a Gaussian distribution parameterized by a mean vector and covariance matrix covering all landmark positions and the vehicle pose simultaneously. The covariance matrix grows quadratically in the number of landmarks, making EKF-SLAM computationally expensive for large environments. Particle filter approaches, notably FastSLAM, factored the joint distribution using a Rao-Blackwellized representation that maintains a set of weighted particles over vehicle trajectories with each particle carrying its own independent landmark filters, reducing the cost of large map updates. Graph-based SLAM formulations, which represent the problem as a nonlinear least-squares optimization over a factor graph of pose nodes and sensor constraints, now dominate because they scale well and can incorporate constraints from multiple sensor modalities.

Map Representations

The choice of map representation determines what kinds of environments can be modeled and what planning and navigation algorithms can operate on the result. Landmark-based maps store a sparse set of point features, lines, or planar patches extracted from sensor data; they are compact and well-suited to EKF and particle filter backends. Occupancy grid maps discretize the environment into a regular 2D or 3D grid of cells, each assigned a probability of being occupied; they represent arbitrary geometry and support direct path planning but scale poorly with resolution and environment size. Dense 3D reconstruction methods such as surfel maps and truncated signed distance function (TSDF) volumes, popularized by systems like KinectFusion, generate photorealistic environment models suitable for inspection and augmented reality but require significant memory and compute. An active research area surveyed in IEEE Transactions on Robotics examines how agents can plan their motion to maximize information gain, reducing map uncertainty most efficiently for a given sensor budget.

Front-End Sensor Processing

The SLAM front end extracts the observations that feed the probabilistic back end. Lidar-based front ends compute scan matching, comparing successive point clouds to estimate relative motion and extract stable landmarks. Visual SLAM front ends detect and match keypoints across camera frames, often using descriptors such as ORB or SIFT, to produce relative pose estimates and 3D point clouds. Inertial measurement units (IMUs) provide high-rate motion cues that bridge gaps between slower lidar or camera updates and constrain the pose estimate during fast motion. The survey on active SLAM notes that sensor fusion across lidar, camera, and IMU is now standard in production-grade SLAM systems used in autonomous vehicles and unmanned aerial vehicles.

Applications

Simultaneous localization and mapping has applications in a wide range of fields, including:

  • Autonomous ground vehicle navigation in unstructured environments
  • Indoor robot navigation for warehousing and logistics automation
  • Unmanned aerial vehicle flight planning and inspection
  • Augmented reality headset tracking and spatial anchoring
  • Underwater vehicle mapping of seafloor and submerged infrastructure
Loading…