diff --git a/VirtualRobot/IK/CompositeDiffIK/CompositeDiffIK.cpp b/VirtualRobot/IK/CompositeDiffIK/CompositeDiffIK.cpp index 455f4cb804bb6995750b48d2634353e7af83529b..70a41bfbc7707cf74781d2587e57348e0ac187a1 100644 --- a/VirtualRobot/IK/CompositeDiffIK/CompositeDiffIK.cpp +++ b/VirtualRobot/IK/CompositeDiffIK/CompositeDiffIK.cpp @@ -240,14 +240,10 @@ void CompositeDiffIK::step(CompositeDiffIK::Parameters& params, SolveState& s, i jv = jv + nsv; } - std::cout << "Before: " << jv << std::endl; - jv = jv * params.stepSize; jv = LimitInfNormTo(jv, params.maxJointAngleStep, params.maxJointAngleStepIgnore); jv = jv.cwiseProduct(s.jointRegularization); - std::cout << "After: " << jv << std::endl; - Eigen::VectorXf newJointValues = s.jointValues + jv; rns->setJointValues(newJointValues);