STEAP: simultaneous trajectory estimation and planning
Gaussian Process Motion planning