Я придумал алгоритм как на логике сделать, но на телефоне нарисовать не смогу. В обшем смысл такой что сигнал от датчика идет сначпла на одновибратор и потом имеет стандартную длительность положительного импульса независимо от частоты импульсов. Затем через и-не смешивается с генератором. На выходе получаем пачки импульсов которые считает счетчик делитель. Все.
Регулировкой частоты которая идет на и-не регулируем больше-меньше частоту на выходе в зависимости от импульсов от датчика
Ну и счетчик делитель коэфициент подобрать, 8-16 хз, мож 1024. Чем больше коэфициент и больше частота генератора тем точнее вычитание-прибавление