add unit test for infinite recursion in collision detection
fix overlapping robots
Merge pull request #14 from bsuh/master

Add unit test for infinite recursion in collision detection.