Fix incorrect assert in collision term single time step weighted method

tesseract-robotics · Jun 1, 2024 · cf2b8c8 · cf2b8c8
1 parent 31386db
commit cf2b8c8
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/trajopt/src/collision_terms.cpp b/trajopt/src/collision_terms.cpp
@@ -799,7 +799,7 @@ void CollisionEvaluator::CalcDistExpressionsSingleTimeStepW(const DblVec& x,
 {
   ContactResultMapConstPtr dist_results = GetContactResultMapCached(x);
   CollisionsToDistanceExpressionsW(exprs, exprs_data, *dist_results, vars0_, x, false);
-  assert(dist_results->count() == exprs.size());
+  assert(dist_results->size() == exprs.size());
 
   for (auto& expr : exprs)
     expr = sco::cleanupAff(expr);