Changed G00 movement to constant speed