ставь ИК датчики с отражателями... на счет софта могу помочь..