Kalman bug fix + renaming of gaussian