AP_NavEKF : add smoothing for magnetometer corrections