A Classification-Based Algorithm for Building 3D Maps of Environmental Objects