add kinematic equations and transition matrix for kalman