AP_NavEKF: Added pitch and roll inertial sensor to body trim adjustment