Я может чего-то не понимаю, но какая связь между кнопкой (хрен знает куда подключенной), цикла (дважды запускаемого, но ни разу не останавливаемого) и сервоприводами???
А по сути проблема “пройэкта” решается в пару строк, но ТС-у это очевидно уже не нужно. Но на всякий случай подсказку дам: перенеси свой “цикл” в луп, и перед ним поставь циклический опрос кнопки, чтобы, пока она не нажата, дальше не пускало, и будет тебе щастье, зачöт у препода и накроют тебя прочие блага.
Онет, после ТАКОГО откровения и до кольца всевластия пол-шага осталось :)))
И кстате откровение может и не помочь:) ибо в зависимости от мощности серв и схемы подключения, в момент инициализации они могут ТАК взбрыкивать, что дурина будет ресетиться по проспдке питания.