Не забывайте, это ARDUINO IDE, а не плоноценный компилятор.
Тут нужно искать не почему не работает, а как заставить работать.
Упрощайте код, разделяйте задачи, не вставляйте все в одну функцию.
У вас - если не подключено - подключаем.
если подключено - выполняем код.
Зачем так? Зачем второй if...