Skip to content
Snippets Groups Projects
Commit 5ce51254 authored by Timo Weberruß's avatar Timo Weberruß
Browse files

Remove debug prints

parent c022189f
No related branches found
No related tags found
2 merge requests!109Social layers,!55Draft: Implement human grouping
......@@ -27,15 +27,10 @@ namespace armarx::navigation::human
const double angleH1 = normOrientation(Eigen::Rotation2Dd(h1.pose.linear()).angle() / M_PI);
const double angleH2 = normOrientation(Eigen::Rotation2Dd(h2.pose.linear()).angle() / M_PI);
printf("line orientation = %.2f\n", lineOrientation);
printf("angle h1 = %.2f, angle h2 = %.2f\n", angleH1, angleH2);
// assuming the angles to be in the interval [0, 2pi]
const double deviationFirst = std::abs(normOrientation(angleH1 - lineOrientation));
const double deviationSecond = std::abs(normOrientation(angleH2 - (lineOrientation + 1)));
printf("deviation first = %.2f, second = %.2f\n", deviationFirst, deviationSecond);
// ranges from 0 (looking directly at each other) to 1 (back to back)
return (deviationFirst + deviationSecond) / 2;
}
......
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