Got the EKF state estimator to compile. No guarantee on running.