AP_NavEKF : Optimisation of optical flow Kalman gain calculation