AP_NavEKF : Fusion of motion compensated optical flow rates into main filter