Fix small typo/bug in gjk implementation.

PiperOrigin-RevId: 645378191
Change-Id: Icdba53b30c934ac3059bb6f7b6d1081d71823131
This commit is contained in:
Kyle Bayes
2024-06-21 07:03:20 -07:00
committed by Copybara-Service
parent 1e8454820d
commit 14fe527ea2
+1 -1
View File
@@ -309,7 +309,7 @@ static void S2D(mjtNum lambda[3], const mjtNum simplex[9]) {
p_o_2D[0] = p_o[1];
p_o_2D[1] = p_o[2];
} else if (index == 1) {
s1_2D[0] = s1[9];
s1_2D[0] = s1[0];
s1_2D[1] = s1[2];
s2_2D[0] = s2[0];