d360ea1ce6
1. Correct stopping criteria for GJK. 2. Store witness points from EPA in mjCCDObj, 3. Get dir directly from EPA instead of computing dir from witness points. PiperOrigin-RevId: 666791852 Change-Id: I6a168f635b57c17692d31da6f6076b48c32ff2e3