Just an observation. The shaft encoder is ready made or are you using an opto interrupter with a disc etc?
If the latter is the case be sure that it can detect pulses of 5.5KHz.
I think it is better to use directly the train pulse and feed a timer, TMR1 for example.
Better accuracy, less parts.
Ioannis




Bookmarks