Plane detection in point cloud