Added evaluation mode into MODE_SWITCH and KalmanFastTrack