извиняюсь, я на быстром счетчике это делал и обрабатывал в таймере 20мкс