grey/BOSL2
1
0
Fork 0
mirror of https://github.com/BelfrySCAD/BOSL2.git synced 2024-12-29 00:09:41 +00:00
Code Issues Projects Releases Packages Wiki Activity Actions

Tweaks to deal with some coner case

Browse source
This commit is contained in:
RonaldoCMP 2021-06-25 16:32:28 +01:00
parent 83f7ec499e
commit fee433f654
1 changed files with 4 additions and 5 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

9
geometry.scad
View file

@ -2423,9 +2423,7 @@ function _GJK_distance(points1, points2, eps=EPSILON, lbd, d, simplex=[]) =
lbd = max(lbd, d*v/nrd), // distance lower bound
close = (nrd-lbd <= eps*nrd)
)
// v already in the simplex is a degenerence due to numerical errors
// and may produce a non-stopping loop
close || [for(nv=norm(v), s=simplex) if(norm(s-v)<=eps*nv) 1]!=[] ? d :
close ? d :
let( newsplx = _closest_simplex(concat(simplex,[v]),eps) )
_GJK_distance(points1, points2, eps, lbd, newsplx[0], newsplx[1]);
@ -2480,9 +2478,10 @@ function convex_collision(points1, points2, eps=EPSILON) =
// http://www.dtecta.com/papers/jgt98convex.pdf
function _GJK_collide(points1, points2, d, simplex, eps=EPSILON) =
norm(d) < eps ? true : // does collide
let( v = _support_diff(points1,points2,-d) )
v*d > eps ? false : // no collision
let( v = _support_diff(points1,points2,-d) )
v*d > eps*eps ? false : // no collision
let( newsplx = _closest_simplex(concat(simplex,[v]),eps) )
norm(v-newsplx[0])<eps ? norm(v)<eps :
_GJK_collide(points1, points2, newsplx[0], newsplx[1], eps);