Might be off topic, but can we map 3-d space to detect obstacles like how a roomba maps 2-d space and avoids obstacles ? (like this http://www.technologyreview.com/sites/default/files/images/i...)

I mean, is that a solved problem ?