AP_NavEKF: removed repeated intialisation