added custom KalmanFilter stuff