Continuous-time Gaussian process motion planning via probabilistic inference
Square Root SAM: Simultaneous Localization and Mapping via Square Root Information Smoothing