given the position, velocity and torque values. Our code looks like the following:
Code: Select all
const ForceSet& fSet = model.getForceSet();
for (i = 0; i < numActuators; i++)
{
ScalarActuator* act = dynamic_cast<ScalarActuator*>(&fSet.get(i));
if (act)
act->setOverrideActuation(state, -jTorques[i]);
}
model.getMultibodySystem().realize(state, SimTK::Stage::Acceleration);
SimTK::Vector udot = model.getMatterSubsystem().getUDot(state);
for (i = 0; i < numActuators; i++)
xDot[i] = udot[i];
insensitive to the applied joint torques. Can someone let us know what is
wrong with the code?