Second-order iterated smoothing algorithms for state estimation - View it on GitHub