Я бы грешил все же на помехи по управлению (с переменников), проще всего их было бы отфильтровать программно, как тут уже писали, ну а проверить "помехуют" ли сами сервоприводы можно осцылом посмотреть что там на управляющем входе, если сигнал постоянный без всплесков то виноваты сами сервы, если дергается из за входного сигнала то виноват контроллер
зы: Еще можно от переменников снимать "цифру" , установив непосредственно на переменники АЦП (например Mcp3201), а на контролере через SPI обрабатывать уже "цифру".