Die TU Braunschweig hat da ein Sytem entwickelt, das man sich runterladen kann:
http://www.rob.cs.tu-bs.de/news/david/
http://www.david-laserscanner.com