1. на большинстве прошивок время фильтрации должно быть установлено -1.
2. не считайте время измерения циклами контроллера, применение модуля Ton поднимет вам точность, а еще лучше читайте аппаратные часы
3. используйте встроенный аппаратный счетчик