EKF CTRV Update