source: node_modules/robust-predicates/umd/orient3d.js@ a762898

Last change on this file since a762898 was e4c61dd, checked in by istevanoska <ilinastevanoska@…>, 6 months ago

Prototype 1.1

  • Property mode set to 100644
File size: 17.3 KB
Line 
1(function (global, factory) {
2typeof exports === 'object' && typeof module !== 'undefined' ? factory(exports) :
3typeof define === 'function' && define.amd ? define(['exports'], factory) :
4(global = typeof globalThis !== 'undefined' ? globalThis : global || self, factory(global.predicates = {}));
5})(this, (function (exports) { 'use strict';
6
7const epsilon = 1.1102230246251565e-16;
8const splitter = 134217729;
9const resulterrbound = (3 + 8 * epsilon) * epsilon;
10
11// fast_expansion_sum_zeroelim routine from oritinal code
12function sum(elen, e, flen, f, h) {
13 let Q, Qnew, hh, bvirt;
14 let enow = e[0];
15 let fnow = f[0];
16 let eindex = 0;
17 let findex = 0;
18 if ((fnow > enow) === (fnow > -enow)) {
19 Q = enow;
20 enow = e[++eindex];
21 } else {
22 Q = fnow;
23 fnow = f[++findex];
24 }
25 let hindex = 0;
26 if (eindex < elen && findex < flen) {
27 if ((fnow > enow) === (fnow > -enow)) {
28 Qnew = enow + Q;
29 hh = Q - (Qnew - enow);
30 enow = e[++eindex];
31 } else {
32 Qnew = fnow + Q;
33 hh = Q - (Qnew - fnow);
34 fnow = f[++findex];
35 }
36 Q = Qnew;
37 if (hh !== 0) {
38 h[hindex++] = hh;
39 }
40 while (eindex < elen && findex < flen) {
41 if ((fnow > enow) === (fnow > -enow)) {
42 Qnew = Q + enow;
43 bvirt = Qnew - Q;
44 hh = Q - (Qnew - bvirt) + (enow - bvirt);
45 enow = e[++eindex];
46 } else {
47 Qnew = Q + fnow;
48 bvirt = Qnew - Q;
49 hh = Q - (Qnew - bvirt) + (fnow - bvirt);
50 fnow = f[++findex];
51 }
52 Q = Qnew;
53 if (hh !== 0) {
54 h[hindex++] = hh;
55 }
56 }
57 }
58 while (eindex < elen) {
59 Qnew = Q + enow;
60 bvirt = Qnew - Q;
61 hh = Q - (Qnew - bvirt) + (enow - bvirt);
62 enow = e[++eindex];
63 Q = Qnew;
64 if (hh !== 0) {
65 h[hindex++] = hh;
66 }
67 }
68 while (findex < flen) {
69 Qnew = Q + fnow;
70 bvirt = Qnew - Q;
71 hh = Q - (Qnew - bvirt) + (fnow - bvirt);
72 fnow = f[++findex];
73 Q = Qnew;
74 if (hh !== 0) {
75 h[hindex++] = hh;
76 }
77 }
78 if (Q !== 0 || hindex === 0) {
79 h[hindex++] = Q;
80 }
81 return hindex;
82}
83
84// scale_expansion_zeroelim routine from oritinal code
85function scale(elen, e, b, h) {
86 let Q, sum, hh, product1, product0;
87 let bvirt, c, ahi, alo, bhi, blo;
88
89 c = splitter * b;
90 bhi = c - (c - b);
91 blo = b - bhi;
92 let enow = e[0];
93 Q = enow * b;
94 c = splitter * enow;
95 ahi = c - (c - enow);
96 alo = enow - ahi;
97 hh = alo * blo - (Q - ahi * bhi - alo * bhi - ahi * blo);
98 let hindex = 0;
99 if (hh !== 0) {
100 h[hindex++] = hh;
101 }
102 for (let i = 1; i < elen; i++) {
103 enow = e[i];
104 product1 = enow * b;
105 c = splitter * enow;
106 ahi = c - (c - enow);
107 alo = enow - ahi;
108 product0 = alo * blo - (product1 - ahi * bhi - alo * bhi - ahi * blo);
109 sum = Q + product0;
110 bvirt = sum - Q;
111 hh = Q - (sum - bvirt) + (product0 - bvirt);
112 if (hh !== 0) {
113 h[hindex++] = hh;
114 }
115 Q = product1 + sum;
116 hh = sum - (Q - product1);
117 if (hh !== 0) {
118 h[hindex++] = hh;
119 }
120 }
121 if (Q !== 0 || hindex === 0) {
122 h[hindex++] = Q;
123 }
124 return hindex;
125}
126
127function estimate(elen, e) {
128 let Q = e[0];
129 for (let i = 1; i < elen; i++) Q += e[i];
130 return Q;
131}
132
133function vec(n) {
134 return new Float64Array(n);
135}
136
137const o3derrboundA = (7 + 56 * epsilon) * epsilon;
138const o3derrboundB = (3 + 28 * epsilon) * epsilon;
139const o3derrboundC = (26 + 288 * epsilon) * epsilon * epsilon;
140
141const bc = vec(4);
142const ca = vec(4);
143const ab = vec(4);
144const at_b = vec(4);
145const at_c = vec(4);
146const bt_c = vec(4);
147const bt_a = vec(4);
148const ct_a = vec(4);
149const ct_b = vec(4);
150const bct = vec(8);
151const cat = vec(8);
152const abt = vec(8);
153const u = vec(4);
154
155const _8 = vec(8);
156const _8b = vec(8);
157const _16 = vec(8);
158const _12 = vec(12);
159
160let fin = vec(192);
161let fin2 = vec(192);
162
163function finadd(finlen, alen, a) {
164 finlen = sum(finlen, fin, alen, a, fin2);
165 const tmp = fin; fin = fin2; fin2 = tmp;
166 return finlen;
167}
168
169function tailinit(xtail, ytail, ax, ay, bx, by, a, b) {
170 let bvirt, c, ahi, alo, bhi, blo, _i, _j, _0, s1, s0, t1, t0, u3, negate;
171 if (xtail === 0) {
172 if (ytail === 0) {
173 a[0] = 0;
174 b[0] = 0;
175 return 1;
176 } else {
177 negate = -ytail;
178 s1 = negate * ax;
179 c = splitter * negate;
180 ahi = c - (c - negate);
181 alo = negate - ahi;
182 c = splitter * ax;
183 bhi = c - (c - ax);
184 blo = ax - bhi;
185 a[0] = alo * blo - (s1 - ahi * bhi - alo * bhi - ahi * blo);
186 a[1] = s1;
187 s1 = ytail * bx;
188 c = splitter * ytail;
189 ahi = c - (c - ytail);
190 alo = ytail - ahi;
191 c = splitter * bx;
192 bhi = c - (c - bx);
193 blo = bx - bhi;
194 b[0] = alo * blo - (s1 - ahi * bhi - alo * bhi - ahi * blo);
195 b[1] = s1;
196 return 2;
197 }
198 } else {
199 if (ytail === 0) {
200 s1 = xtail * ay;
201 c = splitter * xtail;
202 ahi = c - (c - xtail);
203 alo = xtail - ahi;
204 c = splitter * ay;
205 bhi = c - (c - ay);
206 blo = ay - bhi;
207 a[0] = alo * blo - (s1 - ahi * bhi - alo * bhi - ahi * blo);
208 a[1] = s1;
209 negate = -xtail;
210 s1 = negate * by;
211 c = splitter * negate;
212 ahi = c - (c - negate);
213 alo = negate - ahi;
214 c = splitter * by;
215 bhi = c - (c - by);
216 blo = by - bhi;
217 b[0] = alo * blo - (s1 - ahi * bhi - alo * bhi - ahi * blo);
218 b[1] = s1;
219 return 2;
220 } else {
221 s1 = xtail * ay;
222 c = splitter * xtail;
223 ahi = c - (c - xtail);
224 alo = xtail - ahi;
225 c = splitter * ay;
226 bhi = c - (c - ay);
227 blo = ay - bhi;
228 s0 = alo * blo - (s1 - ahi * bhi - alo * bhi - ahi * blo);
229 t1 = ytail * ax;
230 c = splitter * ytail;
231 ahi = c - (c - ytail);
232 alo = ytail - ahi;
233 c = splitter * ax;
234 bhi = c - (c - ax);
235 blo = ax - bhi;
236 t0 = alo * blo - (t1 - ahi * bhi - alo * bhi - ahi * blo);
237 _i = s0 - t0;
238 bvirt = s0 - _i;
239 a[0] = s0 - (_i + bvirt) + (bvirt - t0);
240 _j = s1 + _i;
241 bvirt = _j - s1;
242 _0 = s1 - (_j - bvirt) + (_i - bvirt);
243 _i = _0 - t1;
244 bvirt = _0 - _i;
245 a[1] = _0 - (_i + bvirt) + (bvirt - t1);
246 u3 = _j + _i;
247 bvirt = u3 - _j;
248 a[2] = _j - (u3 - bvirt) + (_i - bvirt);
249 a[3] = u3;
250 s1 = ytail * bx;
251 c = splitter * ytail;
252 ahi = c - (c - ytail);
253 alo = ytail - ahi;
254 c = splitter * bx;
255 bhi = c - (c - bx);
256 blo = bx - bhi;
257 s0 = alo * blo - (s1 - ahi * bhi - alo * bhi - ahi * blo);
258 t1 = xtail * by;
259 c = splitter * xtail;
260 ahi = c - (c - xtail);
261 alo = xtail - ahi;
262 c = splitter * by;
263 bhi = c - (c - by);
264 blo = by - bhi;
265 t0 = alo * blo - (t1 - ahi * bhi - alo * bhi - ahi * blo);
266 _i = s0 - t0;
267 bvirt = s0 - _i;
268 b[0] = s0 - (_i + bvirt) + (bvirt - t0);
269 _j = s1 + _i;
270 bvirt = _j - s1;
271 _0 = s1 - (_j - bvirt) + (_i - bvirt);
272 _i = _0 - t1;
273 bvirt = _0 - _i;
274 b[1] = _0 - (_i + bvirt) + (bvirt - t1);
275 u3 = _j + _i;
276 bvirt = u3 - _j;
277 b[2] = _j - (u3 - bvirt) + (_i - bvirt);
278 b[3] = u3;
279 return 4;
280 }
281 }
282}
283
284function tailadd(finlen, a, b, k, z) {
285 let bvirt, c, ahi, alo, bhi, blo, _i, _j, _k, _0, s1, s0, u3;
286 s1 = a * b;
287 c = splitter * a;
288 ahi = c - (c - a);
289 alo = a - ahi;
290 c = splitter * b;
291 bhi = c - (c - b);
292 blo = b - bhi;
293 s0 = alo * blo - (s1 - ahi * bhi - alo * bhi - ahi * blo);
294 c = splitter * k;
295 bhi = c - (c - k);
296 blo = k - bhi;
297 _i = s0 * k;
298 c = splitter * s0;
299 ahi = c - (c - s0);
300 alo = s0 - ahi;
301 u[0] = alo * blo - (_i - ahi * bhi - alo * bhi - ahi * blo);
302 _j = s1 * k;
303 c = splitter * s1;
304 ahi = c - (c - s1);
305 alo = s1 - ahi;
306 _0 = alo * blo - (_j - ahi * bhi - alo * bhi - ahi * blo);
307 _k = _i + _0;
308 bvirt = _k - _i;
309 u[1] = _i - (_k - bvirt) + (_0 - bvirt);
310 u3 = _j + _k;
311 u[2] = _k - (u3 - _j);
312 u[3] = u3;
313 finlen = finadd(finlen, 4, u);
314 if (z !== 0) {
315 c = splitter * z;
316 bhi = c - (c - z);
317 blo = z - bhi;
318 _i = s0 * z;
319 c = splitter * s0;
320 ahi = c - (c - s0);
321 alo = s0 - ahi;
322 u[0] = alo * blo - (_i - ahi * bhi - alo * bhi - ahi * blo);
323 _j = s1 * z;
324 c = splitter * s1;
325 ahi = c - (c - s1);
326 alo = s1 - ahi;
327 _0 = alo * blo - (_j - ahi * bhi - alo * bhi - ahi * blo);
328 _k = _i + _0;
329 bvirt = _k - _i;
330 u[1] = _i - (_k - bvirt) + (_0 - bvirt);
331 u3 = _j + _k;
332 u[2] = _k - (u3 - _j);
333 u[3] = u3;
334 finlen = finadd(finlen, 4, u);
335 }
336 return finlen;
337}
338
339function orient3dadapt(ax, ay, az, bx, by, bz, cx, cy, cz, dx, dy, dz, permanent) {
340 let finlen;
341 let adxtail, bdxtail, cdxtail;
342 let adytail, bdytail, cdytail;
343 let adztail, bdztail, cdztail;
344 let bvirt, c, ahi, alo, bhi, blo, _i, _j, _0, s1, s0, t1, t0, u3;
345
346 const adx = ax - dx;
347 const bdx = bx - dx;
348 const cdx = cx - dx;
349 const ady = ay - dy;
350 const bdy = by - dy;
351 const cdy = cy - dy;
352 const adz = az - dz;
353 const bdz = bz - dz;
354 const cdz = cz - dz;
355
356 s1 = bdx * cdy;
357 c = splitter * bdx;
358 ahi = c - (c - bdx);
359 alo = bdx - ahi;
360 c = splitter * cdy;
361 bhi = c - (c - cdy);
362 blo = cdy - bhi;
363 s0 = alo * blo - (s1 - ahi * bhi - alo * bhi - ahi * blo);
364 t1 = cdx * bdy;
365 c = splitter * cdx;
366 ahi = c - (c - cdx);
367 alo = cdx - ahi;
368 c = splitter * bdy;
369 bhi = c - (c - bdy);
370 blo = bdy - bhi;
371 t0 = alo * blo - (t1 - ahi * bhi - alo * bhi - ahi * blo);
372 _i = s0 - t0;
373 bvirt = s0 - _i;
374 bc[0] = s0 - (_i + bvirt) + (bvirt - t0);
375 _j = s1 + _i;
376 bvirt = _j - s1;
377 _0 = s1 - (_j - bvirt) + (_i - bvirt);
378 _i = _0 - t1;
379 bvirt = _0 - _i;
380 bc[1] = _0 - (_i + bvirt) + (bvirt - t1);
381 u3 = _j + _i;
382 bvirt = u3 - _j;
383 bc[2] = _j - (u3 - bvirt) + (_i - bvirt);
384 bc[3] = u3;
385 s1 = cdx * ady;
386 c = splitter * cdx;
387 ahi = c - (c - cdx);
388 alo = cdx - ahi;
389 c = splitter * ady;
390 bhi = c - (c - ady);
391 blo = ady - bhi;
392 s0 = alo * blo - (s1 - ahi * bhi - alo * bhi - ahi * blo);
393 t1 = adx * cdy;
394 c = splitter * adx;
395 ahi = c - (c - adx);
396 alo = adx - ahi;
397 c = splitter * cdy;
398 bhi = c - (c - cdy);
399 blo = cdy - bhi;
400 t0 = alo * blo - (t1 - ahi * bhi - alo * bhi - ahi * blo);
401 _i = s0 - t0;
402 bvirt = s0 - _i;
403 ca[0] = s0 - (_i + bvirt) + (bvirt - t0);
404 _j = s1 + _i;
405 bvirt = _j - s1;
406 _0 = s1 - (_j - bvirt) + (_i - bvirt);
407 _i = _0 - t1;
408 bvirt = _0 - _i;
409 ca[1] = _0 - (_i + bvirt) + (bvirt - t1);
410 u3 = _j + _i;
411 bvirt = u3 - _j;
412 ca[2] = _j - (u3 - bvirt) + (_i - bvirt);
413 ca[3] = u3;
414 s1 = adx * bdy;
415 c = splitter * adx;
416 ahi = c - (c - adx);
417 alo = adx - ahi;
418 c = splitter * bdy;
419 bhi = c - (c - bdy);
420 blo = bdy - bhi;
421 s0 = alo * blo - (s1 - ahi * bhi - alo * bhi - ahi * blo);
422 t1 = bdx * ady;
423 c = splitter * bdx;
424 ahi = c - (c - bdx);
425 alo = bdx - ahi;
426 c = splitter * ady;
427 bhi = c - (c - ady);
428 blo = ady - bhi;
429 t0 = alo * blo - (t1 - ahi * bhi - alo * bhi - ahi * blo);
430 _i = s0 - t0;
431 bvirt = s0 - _i;
432 ab[0] = s0 - (_i + bvirt) + (bvirt - t0);
433 _j = s1 + _i;
434 bvirt = _j - s1;
435 _0 = s1 - (_j - bvirt) + (_i - bvirt);
436 _i = _0 - t1;
437 bvirt = _0 - _i;
438 ab[1] = _0 - (_i + bvirt) + (bvirt - t1);
439 u3 = _j + _i;
440 bvirt = u3 - _j;
441 ab[2] = _j - (u3 - bvirt) + (_i - bvirt);
442 ab[3] = u3;
443
444 finlen = sum(
445 sum(
446 scale(4, bc, adz, _8), _8,
447 scale(4, ca, bdz, _8b), _8b, _16), _16,
448 scale(4, ab, cdz, _8), _8, fin);
449
450 let det = estimate(finlen, fin);
451 let errbound = o3derrboundB * permanent;
452 if (det >= errbound || -det >= errbound) {
453 return det;
454 }
455
456 bvirt = ax - adx;
457 adxtail = ax - (adx + bvirt) + (bvirt - dx);
458 bvirt = bx - bdx;
459 bdxtail = bx - (bdx + bvirt) + (bvirt - dx);
460 bvirt = cx - cdx;
461 cdxtail = cx - (cdx + bvirt) + (bvirt - dx);
462 bvirt = ay - ady;
463 adytail = ay - (ady + bvirt) + (bvirt - dy);
464 bvirt = by - bdy;
465 bdytail = by - (bdy + bvirt) + (bvirt - dy);
466 bvirt = cy - cdy;
467 cdytail = cy - (cdy + bvirt) + (bvirt - dy);
468 bvirt = az - adz;
469 adztail = az - (adz + bvirt) + (bvirt - dz);
470 bvirt = bz - bdz;
471 bdztail = bz - (bdz + bvirt) + (bvirt - dz);
472 bvirt = cz - cdz;
473 cdztail = cz - (cdz + bvirt) + (bvirt - dz);
474
475 if (adxtail === 0 && bdxtail === 0 && cdxtail === 0 &&
476 adytail === 0 && bdytail === 0 && cdytail === 0 &&
477 adztail === 0 && bdztail === 0 && cdztail === 0) {
478 return det;
479 }
480
481 errbound = o3derrboundC * permanent + resulterrbound * Math.abs(det);
482 det +=
483 adz * (bdx * cdytail + cdy * bdxtail - (bdy * cdxtail + cdx * bdytail)) + adztail * (bdx * cdy - bdy * cdx) +
484 bdz * (cdx * adytail + ady * cdxtail - (cdy * adxtail + adx * cdytail)) + bdztail * (cdx * ady - cdy * adx) +
485 cdz * (adx * bdytail + bdy * adxtail - (ady * bdxtail + bdx * adytail)) + cdztail * (adx * bdy - ady * bdx);
486 if (det >= errbound || -det >= errbound) {
487 return det;
488 }
489
490 const at_len = tailinit(adxtail, adytail, bdx, bdy, cdx, cdy, at_b, at_c);
491 const bt_len = tailinit(bdxtail, bdytail, cdx, cdy, adx, ady, bt_c, bt_a);
492 const ct_len = tailinit(cdxtail, cdytail, adx, ady, bdx, bdy, ct_a, ct_b);
493
494 const bctlen = sum(bt_len, bt_c, ct_len, ct_b, bct);
495 finlen = finadd(finlen, scale(bctlen, bct, adz, _16), _16);
496
497 const catlen = sum(ct_len, ct_a, at_len, at_c, cat);
498 finlen = finadd(finlen, scale(catlen, cat, bdz, _16), _16);
499
500 const abtlen = sum(at_len, at_b, bt_len, bt_a, abt);
501 finlen = finadd(finlen, scale(abtlen, abt, cdz, _16), _16);
502
503 if (adztail !== 0) {
504 finlen = finadd(finlen, scale(4, bc, adztail, _12), _12);
505 finlen = finadd(finlen, scale(bctlen, bct, adztail, _16), _16);
506 }
507 if (bdztail !== 0) {
508 finlen = finadd(finlen, scale(4, ca, bdztail, _12), _12);
509 finlen = finadd(finlen, scale(catlen, cat, bdztail, _16), _16);
510 }
511 if (cdztail !== 0) {
512 finlen = finadd(finlen, scale(4, ab, cdztail, _12), _12);
513 finlen = finadd(finlen, scale(abtlen, abt, cdztail, _16), _16);
514 }
515
516 if (adxtail !== 0) {
517 if (bdytail !== 0) {
518 finlen = tailadd(finlen, adxtail, bdytail, cdz, cdztail);
519 }
520 if (cdytail !== 0) {
521 finlen = tailadd(finlen, -adxtail, cdytail, bdz, bdztail);
522 }
523 }
524 if (bdxtail !== 0) {
525 if (cdytail !== 0) {
526 finlen = tailadd(finlen, bdxtail, cdytail, adz, adztail);
527 }
528 if (adytail !== 0) {
529 finlen = tailadd(finlen, -bdxtail, adytail, cdz, cdztail);
530 }
531 }
532 if (cdxtail !== 0) {
533 if (adytail !== 0) {
534 finlen = tailadd(finlen, cdxtail, adytail, bdz, bdztail);
535 }
536 if (bdytail !== 0) {
537 finlen = tailadd(finlen, -cdxtail, bdytail, adz, adztail);
538 }
539 }
540
541 return fin[finlen - 1];
542}
543
544function orient3d(ax, ay, az, bx, by, bz, cx, cy, cz, dx, dy, dz) {
545 const adx = ax - dx;
546 const bdx = bx - dx;
547 const cdx = cx - dx;
548 const ady = ay - dy;
549 const bdy = by - dy;
550 const cdy = cy - dy;
551 const adz = az - dz;
552 const bdz = bz - dz;
553 const cdz = cz - dz;
554
555 const bdxcdy = bdx * cdy;
556 const cdxbdy = cdx * bdy;
557
558 const cdxady = cdx * ady;
559 const adxcdy = adx * cdy;
560
561 const adxbdy = adx * bdy;
562 const bdxady = bdx * ady;
563
564 const det =
565 adz * (bdxcdy - cdxbdy) +
566 bdz * (cdxady - adxcdy) +
567 cdz * (adxbdy - bdxady);
568
569 const permanent =
570 (Math.abs(bdxcdy) + Math.abs(cdxbdy)) * Math.abs(adz) +
571 (Math.abs(cdxady) + Math.abs(adxcdy)) * Math.abs(bdz) +
572 (Math.abs(adxbdy) + Math.abs(bdxady)) * Math.abs(cdz);
573
574 const errbound = o3derrboundA * permanent;
575 if (det > errbound || -det > errbound) {
576 return det;
577 }
578
579 return orient3dadapt(ax, ay, az, bx, by, bz, cx, cy, cz, dx, dy, dz, permanent);
580}
581
582function orient3dfast(ax, ay, az, bx, by, bz, cx, cy, cz, dx, dy, dz) {
583 const adx = ax - dx;
584 const bdx = bx - dx;
585 const cdx = cx - dx;
586 const ady = ay - dy;
587 const bdy = by - dy;
588 const cdy = cy - dy;
589 const adz = az - dz;
590 const bdz = bz - dz;
591 const cdz = cz - dz;
592
593 return adx * (bdy * cdz - bdz * cdy) +
594 bdx * (cdy * adz - cdz * ady) +
595 cdx * (ady * bdz - adz * bdy);
596}
597
598exports.orient3d = orient3d;
599exports.orient3dfast = orient3dfast;
600
601}));
Note: See TracBrowser for help on using the repository browser.