Зачем тебе писЯть ПО, когда все придумано до нас?
Теорию и схемы я тебе выложил, сделать тот датчик - вопрос выходного дня, чтоб понять работу..
Хотя.. можно и ПИК приколхозить с индикатором.. не суть..
Суть - сами датчики, хоть по фазе, хоть по сопротивлению.