Work on clustering

- Now usign DBScan to find clusters
- Adapted and enhanced an algorithm found in the web
- Missing some functionalities: bounding box, center of mass

- work on others things
- code now compiles fine with ros Hydro