Дайте предварительно команду на замедление привода, тогда и будете успевать читать энкодер.