По первым результатам вроде все получается, посмотреть можно здесь.
Для меня главный вопрос, не будет ли тормозить теперь градусник. Да, вот еще. Пришлось временно отключить бипер, команда tone() использует тот же таймер что и мой частотомер. Придется использовать бипер с внутренним генератором, думаю это не проблема.