Closed alec-glisman closed 2 years ago
Updates: Found out the body kinematics were not being set correctly in rungeKutta4::accelerationUpdate()
.
Now I am getting NaN
showing up in rungeKutta4:udwadiaKalaba()
. This comes from calculation of M_eff_inv
as M_eff
is not full rank. Can I fix this by adding the intrinsic angular momentum and making the quaternion DoF full rank?
The
integrateSecondOrder()
function is not leading to locater point motion. Find out what is wrong.