euclidean clustering for the set of 3d points(x,y,z)

Hi everyone, I'm trying to write matlab code for "euclidean clustering of point" as below pseudocode :

This code is shown in Pointcloud library website:

http://www.pointclouds.org/documentation/tutorials/cluster_extraction.php

Does anyone have this code in matlab? Thank so much,