Ускоряем и улучшаем скетчи. Ещё одна библиотека.

[Wagan]

Не вдавался в детали, лишь просмотрел по диагонали, поэтому пока могу предложить лишь одно: при сравнении переменной типа long int с константой, константу лучше принудительно указать с суффиксом L. В Вашей функции time_delay есть место:
while (interval > 0L) {
У меня мало опыта с ардуиновским компилятором, поэтому мое предположение может быть ошибочным, но в "честном" Си лучше делать именно так, иначе переменную обрежут
Соответственно, если мое предположение верно, лучше это проверить везде.