Als erstes würde mir da ein Sharp-IR oder einen Ultraschallsensor einfallen.
Ob dir genau genug sind, weiß ich nicht.

LG Fabian