Kalman filter successful, albeit a bit slow.