AP_NavEKF : EKF optical flow fusion preliminary changes