Merging of all parts, working distanceCalc in rviz
- Including Industrial_core and motoman
- Problem with cluster growing fixed