Main Content

Navigation Toolbox

Design, simulate, and deploy algorithms for planning and navigation

Navigation Toolbox™ provides algorithms and analysis tools for designing motion planning and navigation systems. The toolbox contains customizable search and sampling-based path-planners. It also contains sensor models and algorithms for multi-sensor pose estimation. You can create 2D and 3D map representations using your own data or generate maps using the simultaneous localization and mapping (SLAM) algorithms included in the toolbox. Reference examples are provided for self-driving and robotics applications.

You can generate metrics for comparing path optimality, smoothness, and performance benchmarks. The SLAM map builder app lets you interactively visualize and debug map generation. You can test your algorithms by deploying them directly to hardware (with MATLAB® Coder™ or Simulink® Coder).

Get Started

Learn the basics of Navigation Toolbox

Sensor Models

Calibration and simulation for IMU, GPS, and range sensors

Localization and Pose Estimation

Inertial navigation, pose estimation, scan matching, Monte Carlo localization


2-D and 3-D occupancy maps, egocentric maps, raycasting


2-D and 3-D simultaneous localization and mapping

Motion Planning

Path metrics, RRT path planners, path following

Coordinate Transformations and Trajectories

Quaternions, rotation matrices, transformations, trajectory generation