diff --git a/GraspPlanning/GraspQuality/GraspQualityMeasureWrenchSpaceNotNormalized.cpp b/GraspPlanning/GraspQuality/GraspQualityMeasureWrenchSpaceNotNormalized.cpp index c9e9b30ea76b5636f41973f967a54572c49e6282..ddcf65c6dda4cc78555f83249300f5b6a0ea6caf 100644 --- a/GraspPlanning/GraspQuality/GraspQualityMeasureWrenchSpaceNotNormalized.cpp +++ b/GraspPlanning/GraspQuality/GraspQualityMeasureWrenchSpaceNotNormalized.cpp @@ -63,7 +63,9 @@ namespace GraspStudio if (contactPointsM.empty()) { if (verbose && printAll) + { printf("Contact points not set.\n"); + } return; } @@ -294,7 +296,7 @@ namespace GraspStudio nWrongFacets++; continue; } - fRes = std::max(fRes, -dist); + fRes = std::min(fRes, -dist); } if (nWrongFacets > 0)