Все получилось, опрос пошел, увеличили время цикла контроллера до 20мс, спасибо за подсказку, выручили.