Как вариант, ещё можно попробовать использовать встроенный компаратор AVR-ки.