Kalman filter Rough C