Fixed bug in KalmanFilterer
Fixed bug in KalmanFilterer