test: Adding test package for Kalman filter.