Анафема! Во первых быстро, во вторых, я использовал код, который тисячи или десятки тысяч людей протестили.
Блажен, кто верует.
Да есть вопрос о том, сколько времени отбирает обмен с индикатором по I2C и есть ли шанс зависнуть?
Пока лично не просмотришь библиотеку - знать ответа не будешь. ИМХО.