Andday, Перенеси строчки 433-435 в setup.
Достаточно даже одной, с выбором нужного срабатывания.
Не уверен, но попробуй.
Разобрался почему, увидел задумку
Просто мне кажется, что функция инициализируется в каждом цикле, и из-за этого такой результат.
Или добавь ещё одну переменную, bool, и сделай типа триггера, одноразово.
Пробуй.