A Team / IMU Kalman Filter