Planar simplification and texturing of dense point cloud maps