Test system setup for Kalman Filter