Self Collisoin with small changes on joint angles to get stable position
Merge pull request #174 from garaemon/stable-collision-check

Self Collisoin with small changes on joint angles to get stable position