AP_NavEKF : Added states to support dual IMU