robot CheckSelfCollision supports specifying different collision checker
fix self distance checking
added string parameters to link/joint infos