| 19 |
|
|
| 20 |
|
#include "face.h" |
| 21 |
|
|
| 22 |
< |
#define SRCINC 8 /* realloc increment for array */ |
| 22 |
> |
#define SRCINC 32 /* realloc increment for array */ |
| 23 |
|
|
| 24 |
|
SRCREC *source = NULL; /* our list of sources */ |
| 25 |
|
int nsources = 0; /* the number of sources */ |
| 101 |
|
src->so = so; |
| 102 |
|
/* get the face */ |
| 103 |
|
f = getface(so); |
| 104 |
+ |
if (f->area == 0.0) |
| 105 |
+ |
objerror(so, USER, "zero source area"); |
| 106 |
|
/* find the center */ |
| 107 |
|
for (j = 0; j < 3; j++) { |
| 108 |
|
src->sloc[j] = 0.0; |
| 111 |
|
src->sloc[j] /= (double)f->nv; |
| 112 |
|
} |
| 113 |
|
if (!inface(src->sloc, f)) |
| 114 |
< |
objerror(so, USER, "cannot hit center for source"); |
| 114 |
> |
objerror(so, USER, "cannot hit source center"); |
| 115 |
|
src->sflags |= SFLAT; |
| 116 |
|
VCOPY(src->snorm, f->norm); |
| 117 |
|
src->ss2 = f->area; |
| 145 |
|
src->so = so; |
| 146 |
|
if (so->oargs.nfargs != 4) |
| 147 |
|
objerror(so, USER, "bad arguments"); |
| 148 |
< |
src->sflags |= SDISTANT; |
| 148 |
> |
src->sflags |= (SDISTANT|SCIR); |
| 149 |
|
VCOPY(src->sloc, so->oargs.farg); |
| 150 |
|
if (normalize(src->sloc) == 0.0) |
| 151 |
|
objerror(so, USER, "zero direction"); |
| 173 |
|
if (so->oargs.nfargs != 4) |
| 174 |
|
objerror(so, USER, "bad # arguments"); |
| 175 |
|
if (so->oargs.farg[3] <= FTINY) |
| 176 |
< |
objerror(so, USER, "illegal radius"); |
| 176 |
> |
objerror(so, USER, "illegal source radius"); |
| 177 |
> |
src->sflags |= SCIR; |
| 178 |
|
VCOPY(src->sloc, so->oargs.farg); |
| 179 |
|
src->srad = so->oargs.farg[3]; |
| 180 |
|
src->ss2 = PI * src->srad * src->srad; |
| 181 |
|
for (i = 0; i < 3; i++) |
| 182 |
|
src->ss[SU][i] = src->ss[SV][i] = src->ss[SW][i] = 0.0; |
| 183 |
|
for (i = 0; i < 3; i++) |
| 184 |
< |
src->ss[i][i] = .7236 * so->oargs.farg[3]; |
| 184 |
> |
src->ss[i][i] = 0.7236 * so->oargs.farg[3]; |
| 185 |
|
} |
| 186 |
|
|
| 187 |
|
|
| 196 |
|
src->so = so; |
| 197 |
|
/* get the ring */ |
| 198 |
|
co = getcone(so, 0); |
| 199 |
+ |
if (CO_R1(co) <= FTINY) |
| 200 |
+ |
objerror(so, USER, "illegal source radius"); |
| 201 |
|
VCOPY(src->sloc, CO_P0(co)); |
| 202 |
|
if (CO_R0(co) > 0.0) |
| 203 |
< |
objerror(so, USER, "cannot hit center for source"); |
| 204 |
< |
src->sflags |= SFLAT; |
| 203 |
> |
objerror(so, USER, "cannot hit source center"); |
| 204 |
> |
src->sflags |= (SFLAT|SCIR); |
| 205 |
|
VCOPY(src->snorm, co->ad); |
| 206 |
|
src->srad = CO_R1(co); |
| 207 |
|
src->ss2 = PI * src->srad * src->srad; |
| 221 |
|
src->so = so; |
| 222 |
|
/* get the cylinder */ |
| 223 |
|
co = getcone(so, 0); |
| 224 |
+ |
if (CO_R0(co) <= FTINY) |
| 225 |
+ |
objerror(so, USER, "illegal source radius"); |
| 226 |
|
if (CO_R0(co) > .2*co->al) /* heuristic constraint */ |
| 227 |
|
objerror(so, WARNING, "source aspect too small"); |
| 228 |
|
src->sflags |= SCYL; |
| 256 |
|
return(ns); |
| 257 |
|
if ((ns = (SPOT *)malloc(sizeof(SPOT))) == NULL) |
| 258 |
|
return(NULL); |
| 259 |
+ |
if (m->oargs.farg[3] <= FTINY) |
| 260 |
+ |
objerror(m, USER, "zero angle"); |
| 261 |
|
ns->siz = 2.0*PI * (1.0 - cos(PI/180.0/2.0 * m->oargs.farg[3])); |
| 262 |
|
VCOPY(ns->aim, m->oargs.farg+4); |
| 263 |
|
if ((ns->flen = normalize(ns->aim)) == 0.0) |
| 399 |
|
{ |
| 400 |
|
FVECT cent, c1, c2; |
| 401 |
|
double rad2, d; |
| 393 |
– |
register int i; |
| 402 |
|
/* move centers to common plane */ |
| 403 |
|
d = DOT(sp1->aim, dir); |
| 404 |
< |
for (i = 0; i < 3; i++) |
| 397 |
< |
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++) |
| 400 |
< |
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; |
| 436 |
– |
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++) |
| 446 |
< |
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; |
| 460 |
– |
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++) |
| 468 |
< |
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; |
| 481 |
– |
register int i; |
| 483 |
|
|
| 484 |
< |
for (i = 0; i < 3; i++) |
| 484 |
< |
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++) |
| 505 |
< |
cc[i] = c1[i] + l*disp[i]; |
| 504 |
> |
VSUM(cc, c1, disp, l); |
| 505 |
|
return(a2); |
| 506 |
|
} |
