AP_NavEKF: Fix bug in optical flow fusion smoothing