added kalman filter
added simple test model for linear kalman filter