Added 1d kalmanfilter