| 243 |
|
{ |
| 244 |
|
FVECT vt; |
| 245 |
|
|
| 246 |
< |
vt[0] = wp[0] - hp->orig[0]; |
| 247 |
< |
vt[1] = wp[1] - hp->orig[1]; |
| 248 |
< |
vt[2] = wp[2] - hp->orig[2]; |
| 246 |
> |
VSUB(vt, wp, hp->orig); |
| 247 |
|
gp[0] = DOT(vt, hp->wg[0]); |
| 248 |
|
gp[1] = DOT(vt, hp->wg[1]); |
| 249 |
|
gp[2] = DOT(vt, hp->wg[2]); |
| 288 |
|
d0*cp[1][j] + d1*cp[2][j]; |
| 289 |
|
} |
| 290 |
|
VCOPY(ro, p[0]); /* assign ray origin and direction */ |
| 291 |
< |
rd[0] = p[1][0] - p[0][0]; |
| 294 |
< |
rd[1] = p[1][1] - p[0][1]; |
| 295 |
< |
rd[2] = p[1][2] - p[0][2]; |
| 291 |
> |
VSUB(rd, p[1], p[0]); |
| 292 |
|
return(normalize(rd)); /* return maximum inside distance */ |
| 293 |
|
} |
| 294 |
|
|
| 338 |
|
if (gc[0].w < 0 | gc[1].w < 0) /* paranoid check */ |
| 339 |
|
return(FHUGE); |
| 340 |
|
/* compute intersections */ |
| 341 |
< |
for (i = 0; i < 3; i++) { |
| 342 |
< |
p[0][i] = ro[i] + rd[i]*t0; |
| 347 |
< |
p[1][i] = ro[i] + rd[i]*t1; |
| 348 |
< |
} |
| 341 |
> |
VSUM(p[0], ro, rd, t0); |
| 342 |
> |
VSUM(p[1], ro, rd, t1); |
| 343 |
|
/* now, compute grid coordinates */ |
| 344 |
|
for (i = 0; i < 2; i++) { |
| 345 |
< |
vt[0] = p[i][0] - hp->orig[0]; |
| 352 |
< |
vt[1] = p[i][1] - hp->orig[1]; |
| 353 |
< |
vt[2] = p[i][2] - hp->orig[2]; |
| 345 |
> |
VSUB(vt, p[i], hp->orig); |
| 346 |
|
v = hp->wg[hdwg0[gc[i].w]]; |
| 347 |
|
d = DOT(vt, v); |
| 348 |
|
if (d < 0. || (gc[i].i[0] = d) >= hp->grid[hdwg0[gc[i].w]]) |
