AP_NavEKF : increased useage of helper functions