fix self-collision checks when using multiple geoms per link
i think this properly fixes #87