Imporving segmentation and PCLTools. Visualization added.