Extraction of Geometrical Features in 3D Environments for Service Robotics Applications