Исправил ошибку с зависанием контроллера, распаял все на макетной плате, испытал подключение по блютуз. Полет нормальный:).