Wrote the predict, correct functions for kalman. Yet untested because no constructor
Kalman filter written.