Plane : changed useage of ahrs.set_correct_centrifugal
AP_NavEKF : fixed bug in pos and vel reset when in static mode