Knowing where you are and how to get there.
Optimization-based multi-sensor state estimator.
Factor graphs for SLAM and sensor fusion.
