Added an Unscented Kalman Filter implementation