Code : Add single state EKF for estimation of focal length scale factor