Skip to content
Snippets Groups Projects
Commit 4ef57283 authored by Armar6's avatar Armar6
Browse files

added target valid check in impedance controller

parent b027dbf7
No related branches found
No related tags found
No related merge requests found
......@@ -192,7 +192,12 @@ void NJointTaskSpaceImpedanceController::rtRun(const IceUtil::Time& sensorValues
debugDataInfo.getWriteBuffer().desired_torques[jointNames[i]] = jointDesiredTorques(i);
targets.at(i)->torque = desiredTorque;
if (!targets.at(i)->isValid())
{
targets.at(i)->torque = 0;
}
}
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment