Add self collision check option for adjacent body nodes
Remove debug code
Merge pull request #173 from dartsim/self_collision_check_option

Add self collision check option for adjacent body nodes