I just noticed this problem. If we have custom functions that are functions of the control variable, not only do you need the first derivative when constructing the EOMs, but also the second derivative when constructing the index reduced control EOMs. The logic I initially built didn't take this into account and it's fairly broken.
I just noticed this problem. If we have custom functions that are functions of the control variable, not only do you need the first derivative when constructing the EOMs, but also the second derivative when constructing the index reduced control EOMs. The logic I initially built didn't take this into account and it's fairly broken.