AP_NavEKF: Added set_correct_centrigual method