Сделал управление сервами через PWM timer1. Теперь всё очень стабильно