AP_NavEKF : Add focallength scale factor estimator