Думаю после несложной переделки программы можно сделать и ИК-сонар - расстояние измерять