Update TEST4EKF