UKF debugged