DONE : EKF prediction, constant Velocity motion model