13 |
|
#include "cone.h" |
14 |
|
|
15 |
|
|
16 |
< |
extern int |
16 |
> |
int |
17 |
|
o_cone( /* intersect ray with cone */ |
18 |
|
OBJREC *o, |
19 |
< |
register RAY *r |
19 |
> |
RAY *r |
20 |
|
) |
21 |
|
{ |
22 |
|
FVECT rox, rdx; |
23 |
|
double a, b, c; |
24 |
|
double root[2]; |
25 |
|
int nroots, rn; |
26 |
< |
register CONE *co; |
27 |
< |
register int i; |
26 |
> |
CONE *co; |
27 |
> |
int i; |
28 |
|
|
29 |
|
/* get cone structure */ |
30 |
|
co = getcone(o, 1); |
31 |
+ |
if (co == NULL) |
32 |
+ |
objerror(o, INTERNAL, "unexpected illegal"); |
33 |
|
|
34 |
|
/* |
35 |
|
* To intersect a ray with a cone, we transform the |
70 |
|
|
71 |
|
} else { /* OBJ_RING */ |
72 |
|
|
73 |
< |
if (rdx[2] <= FTINY && rdx[2] >= -FTINY) |
73 |
> |
if ((rdx[2] <= FTINY) & (rdx[2] >= -FTINY)) |
74 |
|
return(0); /* parallel */ |
75 |
|
root[0] = -rox[2]/rdx[2]; |
76 |
< |
if (root[0] <= FTINY || root[0] >= r->rot) |
77 |
< |
return(0); /* distance check */ |
76 |
> |
if (rayreject(o, r, root[0])) |
77 |
> |
return(0); /* have better */ |
78 |
|
b = root[0]*rdx[0] + rox[0]; |
79 |
|
c = root[0]*rdx[1] + rox[1]; |
80 |
|
a = b*b + c*c; |
82 |
|
return(0); /* outside radii */ |
83 |
|
r->ro = o; |
84 |
|
r->rot = root[0]; |
85 |
< |
for (i = 0; i < 3; i++) |
84 |
< |
r->rop[i] = r->rorg[i] + r->rdir[i]*r->rot; |
85 |
> |
VSUM(r->rop, r->rorg, r->rdir, r->rot); |
86 |
|
VCOPY(r->ron, co->ad); |
87 |
|
r->rod = -rdx[2]; |
88 |
|
r->rox = NULL; |
94 |
|
for (rn = 0; rn < nroots; rn++) { /* check real roots */ |
95 |
|
if (root[rn] <= FTINY) |
96 |
|
continue; /* too small */ |
97 |
< |
if (root[rn] >= r->rot) |
97 |
> |
if (root[rn] > r->rot + FTINY) |
98 |
|
break; /* too big */ |
99 |
|
/* check endpoints */ |
100 |
< |
for (i = 0; i < 3; i++) { |
101 |
< |
rox[i] = r->rorg[i] + root[rn]*r->rdir[i]; |
101 |
< |
rdx[i] = rox[i] - CO_P0(co)[i]; |
102 |
< |
} |
100 |
> |
VSUM(rox, r->rorg, r->rdir, root[rn]); |
101 |
> |
VSUB(rdx, rox, CO_P0(co)); |
102 |
|
b = DOT(rdx, co->ad); |
103 |
|
if (b < 0.0) |
104 |
|
continue; /* before p0 */ |
105 |
|
if (b > co->al) |
106 |
|
continue; /* after p1 */ |
107 |
+ |
if (rayreject(o, r, root[rn])) |
108 |
+ |
break; /* previous hit better */ |
109 |
|
r->ro = o; |
110 |
|
r->rot = root[rn]; |
111 |
|
VCOPY(r->rop, rox); |
127 |
|
if (o->otype == OBJ_CONE || o->otype == OBJ_CUP) |
128 |
|
for (i = 0; i < 3; i++) |
129 |
|
r->ron[i] = (co->al*r->ron[i] - c*co->ad[i]) |
130 |
< |
/co->sl; |
130 |
> |
/ co->sl; |
131 |
> |
a = DOT(r->ron, r->ron); |
132 |
> |
if (a > 1.+FTINY || a < 1.-FTINY) { |
133 |
> |
c = 1./(.5 + .5*a); /* avoid numerical error */ |
134 |
> |
r->ron[0] *= c; r->ron[1] *= c; r->ron[2] *= c; |
135 |
> |
} |
136 |
|
r->rod = -DOT(r->rdir, r->ron); |
137 |
|
r->pert[0] = r->pert[1] = r->pert[2] = 0.0; |
138 |
|
r->uv[0] = r->uv[1] = 0.0; |