Ich nehme mal an du versuchst so etwas wie Trajektorienplanung für einzelne Beine ? Wenn du dort die Jakobi Matrix für eine Inverse Kinematik nutzt musst du auf Singularitäten bzw. Invertierbarkeit achten. Das wird bei der Implementierung häufig falsch gemacht.