diff --git a/include/hpp/fcl/narrowphase/gjk.h b/include/hpp/fcl/narrowphase/gjk.h index b7015560756cefcab850ff65fcad91eb39cd54b3..089043015bdafaf26728014d5b4241ec903f0464 100644 --- a/include/hpp/fcl/narrowphase/gjk.h +++ b/include/hpp/fcl/narrowphase/gjk.h @@ -125,7 +125,7 @@ struct GJK /// @brief weight FCL_REAL coefficient[4]; /// @brief size of simplex (number of vertices) - size_t rank; + short rank; Simplex() : rank(0) {} }; diff --git a/include/hpp/fcl/narrowphase/narrowphase.h b/include/hpp/fcl/narrowphase/narrowphase.h index 92536e30978a6130cd6e1a6b9fd76dffce6fa5bb..ffb28f2ab4ac21adffcdea280f9a0b93c313fb6c 100644 --- a/include/hpp/fcl/narrowphase/narrowphase.h +++ b/include/hpp/fcl/narrowphase/narrowphase.h @@ -128,7 +128,7 @@ namespace fcl details::EPA::Status epa_status = epa.evaluate(gjk, -guess); assert (epa_status != details::EPA::Failed); (void) epa_status; Vec3f w0 (Vec3f::Zero()); - for(size_t i = 0; i < epa.result.rank; ++i) + for(short i = 0; i < epa.result.rank; ++i) { w0 += epa.result.vertex[i]->w0 * epa.result.coefficient[i]; } @@ -217,7 +217,7 @@ namespace fcl if(epa_status != details::EPA::Failed) { Vec3f w0 (Vec3f::Zero()); - for(size_t i = 0; i < epa.result.rank; ++i) + for(short i = 0; i < epa.result.rank; ++i) { w0 += epa.result.vertex[i]->w0 * epa.result.coefficient[i]; } diff --git a/src/narrowphase/gjk.cpp b/src/narrowphase/gjk.cpp index 55198f97799fc1dbf2522699aebfb2cc3c980542..d1b4cade9087bdbd28703780cb5d41226b8dee91 100644 --- a/src/narrowphase/gjk.cpp +++ b/src/narrowphase/gjk.cpp @@ -312,7 +312,7 @@ bool GJK::getClosestPoints (const MinkowskiDiff& shape, Vec3f& w0, Vec3f& w1) co { w0.setZero(); w1.setZero(); - for(size_t i = 0; i < getSimplex()->rank; ++i) + for(short i = 0; i < getSimplex()->rank; ++i) { FCL_REAL p = getSimplex()->coefficient[i]; w0 += getSimplex()->vertex[i]->w0 * p; @@ -391,8 +391,8 @@ GJK::Status GJK::evaluate(const MinkowskiDiff& shape_, const Vec3f& guess) assert (fabs(d-project_res.sqr_distance) < 1e-10); Vec3f _ray(0,0,0); - size_t k = 0; - for(size_t i = 0; i < curr_simplex.rank; ++i) + short k = 0; + for(short i = 0; i < curr_simplex.rank; ++i) { if(project_res.encode & (1 << i)) { @@ -418,8 +418,8 @@ GJK::Status GJK::evaluate(const MinkowskiDiff& shape_, const Vec3f& guess) assert (fabs(d-project_res.sqr_distance) < 1e-10); Vec3f _ray(0,0,0); - size_t k = 0; - for(size_t i = 0; i < curr_simplex.rank; ++i) + short k = 0; + for(short i = 0; i < curr_simplex.rank; ++i) { if(project_res.encode & (1 << i)) { @@ -447,7 +447,7 @@ GJK::Status GJK::evaluate(const MinkowskiDiff& shape_, const Vec3f& guess) if (curr_simplex.rank > 3) { next_simplex.rank = 0; ray = Vec3f(0,0,0); - for(size_t i = 0; i < curr_simplex.rank; ++i) + for(short i = 0; i < curr_simplex.rank; ++i) { if(project_res.encode & (1 << i)) {