An optimization-based multi-sensor state estimator - View it on GitHub