Code for Optimal State Estimation:


John Weatherwax