Wenn man den Boden sehen kann, dann kann man ja den Abstand zum Boden bestimmen. Mit einem Abstandssensor (Sharp PSD oder Ultraschall).
Eine Wand an der Seite wäre das einfachste für die seitliche Richtung.

Fertige Module gibt es dafür, wenn die Geanuigkeit reicht.
Manfred