Add the fully nonlinear EKF Demo.