AP_NavEKF : Add smoothing to optical flow fusion