С энкодером на высоких частотах в М02 тоже проблемы. Заявленных 100 кГц и в помине нет.
Во вложении простой пример для ШД. Только вряд ли у тебя ШД закрутится если ты на драйвер сразу подашь 12,5 кГц. Однако попробуй и напиши, что получилось. Вообще ШД надо разгонять по специальному алгоритму.