function [x_aposteriori,P_aposteriori]=positionKalmanFilter1D_dT(dT,x_aposteriori_k,P_aposteriori_k,u,z,gps_update,Q,R,thresh,decay) %dynamics A = [1 dT -0.5*dT*dT; 0 1 -dT; 0 0 1]; B = [0.5*dT*dT; dT; 0]; C = [1 0 0]; %prediction x_apriori=A*x_aposteriori_k+B*u; P_apriori=A*P_aposteriori_k*A'+Q; if abs(u)