The code from my thesis. Included: Nonlinear estimation and tracking software in C++. EKF, Iterative Weighted Least Squares, Iterated EKF, and more. See documentation.