сенсор, сенсорная кнопка Опции

[day177]

понадобилась сенсорная кнопка. Схема Эльм Чана
А вот с алгоритмом не могу разобраться.
Пока прикинул вот такой
1. Запустить устройство.
2. "Лапка" МК как выход, на выходе 0.
3. Небольшая задержка чтобы все параметры устаканились.
4. Подать на выход 1.
5. Небольшая задержка.
6. "Лапку" сделать входом без подтяжки.
7. Запустить таймер и ждать когда на входе появится 1.
8. Когда на входе появилась 1, запомнить значение таймера - это будет константа "свободного" сенсора.
9. Выполняем шаги 4-7 в режиме ожидания, и сравниваем значение константы со значением счетчика.
10. Когда значение счетчика превысит значение константы считать что произошло касание.

На сколько данный алгоритм верен?

Эскизы прикрепленных изображений