Finished simple kalman filter to have error and gain graphs.