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

add -1, 0, 1 degrees to the target limbs and check self-collision to avoid edge-case