Added true self collision to the collision checker. You can now add collision groups of type "voxels" to a robot model description. Any links in those groups are voxelized and added to the distance field.