Increased shape padding to avoid self collsions when the arm is moving (probably the pointcloud should be filtered to avoid lag)
enabled debug
deleted because not needed