diff --git a/src/algorithm/geometry.hxx b/src/algorithm/geometry.hxx index 09156129c734c44a71bad13cc1369c4774df9b01..dc0f6260896a2b8a4d2aa3728d6afdb4326d6a3a 100644 --- a/src/algorithm/geometry.hxx +++ b/src/algorithm/geometry.hxx @@ -68,6 +68,7 @@ namespace se3 const PairIndex & co1 = pair.first; assert(co1<collisionObjects.size()); const PairIndex & co2 = pair.second; assert(co2<collisionObjects.size()); + collisionResult.clear(); fcl::collide (&geomData.collisionObjects[co1],&geomData.collisionObjects[co2], geomData.collisionRequest, collisionResult);