STEAP: simultaneous trajectory estimation and planning
Approximately optimal continuous-time motion planning and control via Probabilistic Inference