Получается практически аппаратный частотомер, нужно только переполнения таймера аккуратно обработать.