In the mobile robotics community significant research efforts are lately focusing on
acquiring and processing information about the 3D nature of the environments found
in real world scenarios. Overcoming the limitations imposed by the 2D models is of
utmost importance regarding safe navigation but also to provide further knowledge to
be used in other robotic tasks. Fast and robust algorithms are required
for applicability to navigation.
To gather the 3D data, we use a laser scanner, employing a nodding data acquisition system mounted on both real (Nemo) and simulated robots. Our segmentation algorithm comes up from the integration of computer vision techniques, allowing for a fast separation of points corresponding to different, not necessarily planar, surfaces. The subsequent extraction of geometrical features out of each region’s points is done by means of least-squares fitting. A Maximum Incremental Probability algorithm formulated upon the Extended Kalman Filter provides 6D localization and produces a map of planar patches with a convex-hull based representation.







