Added self collides on robotiq model