We have open sourced our library for fast and robust Velodyne data segmentation. You can find the code on GitHub
For more details on the approach see: I. Bogoslavskyi and C. Stachniss: “Fast Range Image-Based Segmentation of Sparse 3D Laser Scans for Online Operation”, IROS, 2016 on our publication page.