Да, проблема из за нехватки напряжения. Отключил сервопривод и все стало норм) Всем кто помогал огромное Спасибо!