Minor change to kalmanfilter