| 399 |
|
{ |
| 400 |
|
FVECT cent, c1, c2; |
| 401 |
|
double rad2, d; |
| 402 |
– |
register int i; |
| 402 |
|
/* move centers to common plane */ |
| 403 |
|
d = DOT(sp1->aim, dir); |
| 404 |
< |
for (i = 0; i < 3; i++) |
| 406 |
< |
c1[i] = sp1->aim[i] - d*dir[i]; |
| 404 |
> |
VSUM(c1, sp1->aim, dir, -d); |
| 405 |
|
d = DOT(sp2->aim, dir); |
| 406 |
< |
for (i = 0; i < 3; i++) |
| 409 |
< |
c2[i] = sp2->aim[i] - d*dir[i]; |
| 406 |
> |
VSUM(c2, sp2->aim, dir, -d); |
| 407 |
|
/* compute overlap */ |
| 408 |
|
rad2 = intercircle(cent, c1, c2, sp1->siz/PI, sp2->siz/PI); |
| 409 |
|
if (rad2 <= FTINY) |
| 439 |
|
{ |
| 440 |
|
FVECT onorm; |
| 441 |
|
double offs, d, dist; |
| 445 |
– |
register int i; |
| 442 |
|
|
| 443 |
|
offs = getplaneq(onorm, op); |
| 444 |
|
d = -DOT(onorm, sp->aim); |
| 447 |
|
dist = (DOT(pos, onorm) - offs)/d; |
| 448 |
|
if (dist < 0.) |
| 449 |
|
return(0.); |
| 450 |
< |
for (i = 0; i < 3; i++) |
| 455 |
< |
oc[i] = pos[i] + dist*sp->aim[i]; |
| 450 |
> |
VSUM(oc, pos, sp->aim, dist); |
| 451 |
|
return(sp->siz*dist*dist/PI/(d*d)); |
| 452 |
|
} |
| 453 |
|
|
| 461 |
|
{ |
| 462 |
|
FVECT onorm; |
| 463 |
|
double offs, d, dist; |
| 469 |
– |
register int i; |
| 464 |
|
|
| 465 |
|
offs = getplaneq(onorm, op); |
| 466 |
|
d = -DOT(onorm, dir); |
| 467 |
|
if (d >= -FTINY && d <= FTINY) |
| 468 |
|
return(0.); |
| 469 |
|
dist = (DOT(sp->aim, onorm) - offs)/d; |
| 470 |
< |
for (i = 0; i < 3; i++) |
| 477 |
< |
oc[i] = sp->aim[i] + dist*dir[i]; |
| 470 |
> |
VSUM(oc, sp->aim, dir, dist); |
| 471 |
|
return(sp->siz/PI/(d*d)); |
| 472 |
|
} |
| 473 |
|
|
| 480 |
|
{ |
| 481 |
|
double a2, d2, l; |
| 482 |
|
FVECT disp; |
| 490 |
– |
register int i; |
| 483 |
|
|
| 484 |
< |
for (i = 0; i < 3; i++) |
| 493 |
< |
disp[i] = c2[i] - c1[i]; |
| 484 |
> |
VSUB(disp, c2, c1); |
| 485 |
|
d2 = DOT(disp,disp); |
| 486 |
|
/* circle within overlap? */ |
| 487 |
|
if (r1s < r2s) { |
| 501 |
|
return(0.); |
| 502 |
|
/* overlap, compute center */ |
| 503 |
|
l = sqrt((r1s - a2)/d2); |
| 504 |
< |
for (i = 0; i < 3; i++) |
| 514 |
< |
cc[i] = c1[i] + l*disp[i]; |
| 504 |
> |
VSUM(cc, c1, disp, l); |
| 505 |
|
return(a2); |
| 506 |
|
} |