Velocity and position update