15 |
|
|
16 |
|
VIEWPOINT myeye; /* target view position */ |
17 |
|
|
18 |
+ |
struct gclim { |
19 |
+ |
HOLO *hp; /* holodeck pointer */ |
20 |
+ |
GCOORD gc; /* grid cell */ |
21 |
+ |
FVECT egp; /* eye grid point */ |
22 |
+ |
double erg[2]; /* eye range in wall grid coords */ |
23 |
+ |
double gmin[2], gmax[2]; /* grid coordinate limits */ |
24 |
+ |
}; /* a grid coordinate range */ |
25 |
|
|
26 |
+ |
|
27 |
+ |
static |
28 |
+ |
initeyelim(gcl, hd, gc) /* initialize grid coordinate limits */ |
29 |
+ |
register struct gclim *gcl; |
30 |
+ |
int hd; |
31 |
+ |
GCOORD *gc; |
32 |
+ |
{ |
33 |
+ |
register FLOAT *v; |
34 |
+ |
register int i; |
35 |
+ |
|
36 |
+ |
gcl->hp = hdlist[hd]; |
37 |
+ |
copystruct(&gcl->gc, gc); |
38 |
+ |
hdgrid(gcl->egp, gcl->hp, myeye.vpt); |
39 |
+ |
for (i = 0; i < 2; i++) { |
40 |
+ |
v = gcl->hp->wg[((gcl->gc.w>>1)+i+1)%3]; |
41 |
+ |
gcl->erg[i] = myeye.rng * VLEN(v); |
42 |
+ |
gcl->gmin[i] = FHUGE; gcl->gmax[i] = -FHUGE; |
43 |
+ |
} |
44 |
+ |
} |
45 |
+ |
|
46 |
+ |
|
47 |
+ |
static |
48 |
+ |
groweyelim(gcl, gp) /* grow grid limits about eye point */ |
49 |
+ |
register struct gclim *gcl; |
50 |
+ |
FVECT gp; |
51 |
+ |
{ |
52 |
+ |
FVECT ab; |
53 |
+ |
double l2, d, mult, wg; |
54 |
+ |
register int i, g; |
55 |
+ |
|
56 |
+ |
VSUB(ab, gcl->egp, gp); |
57 |
+ |
l2 = DOT(ab,ab); |
58 |
+ |
if (l2 <= gcl->erg[0]*gcl->erg[1]) { |
59 |
+ |
gcl->gmin[0] = gcl->gmin[1] = -FHUGE; |
60 |
+ |
gcl->gmax[0] = gcl->gmax[1] = FHUGE; |
61 |
+ |
return; |
62 |
+ |
} |
63 |
+ |
mult = gp[g = gcl->gc.w>>1]; |
64 |
+ |
if (gcl->gc.w&1) |
65 |
+ |
mult -= gcl->hp->grid[g]; |
66 |
+ |
if (ab[g]*ab[g] > gcl->erg[0]*gcl->erg[1]) |
67 |
+ |
mult /= -ab[g]; |
68 |
+ |
else if (fabs(ab[hdwg0[gcl->gc.w]]) > fabs(ab[hdwg1[gcl->gc.w]])) |
69 |
+ |
mult = (gcl->gc.i[0] + .5 - gp[hdwg0[gcl->gc.w]]) / |
70 |
+ |
ab[hdwg0[gcl->gc.w]]; |
71 |
+ |
else |
72 |
+ |
mult = (gcl->gc.i[1] + .5 - gp[hdwg1[gcl->gc.w]]) / |
73 |
+ |
ab[hdwg1[gcl->gc.w]]; |
74 |
+ |
for (i = 0; i < 2; i++) { |
75 |
+ |
g = ((gcl->gc.w>>1)+i+1)%3; |
76 |
+ |
wg = gp[g] + mult*ab[g]; |
77 |
+ |
d = mult*gcl->erg[i]; |
78 |
+ |
if (d < 0.) d = -d; |
79 |
+ |
if (wg - d < gcl->gmin[i]) |
80 |
+ |
gcl->gmin[i] = wg - d; |
81 |
+ |
if (wg + d > gcl->gmax[i]) |
82 |
+ |
gcl->gmax[i] = wg + d; |
83 |
+ |
} |
84 |
+ |
} |
85 |
+ |
|
86 |
+ |
|
87 |
+ |
static int |
88 |
+ |
clipeyelim(rrng, gcl) /* clip eye limits to grid cell */ |
89 |
+ |
register short rrng[2][2]; |
90 |
+ |
register struct gclim *gcl; |
91 |
+ |
{ |
92 |
+ |
int incell = 1; |
93 |
+ |
register int i; |
94 |
+ |
|
95 |
+ |
for (i = 0; i < 2; i++) { |
96 |
+ |
if (gcl->gmin[i] < gcl->gc.i[i]) |
97 |
+ |
gcl->gmin[i] = gcl->gc.i[i]; |
98 |
+ |
if (gcl->gmax[i] > gcl->gc.i[i]+1) |
99 |
+ |
gcl->gmax[i] = gcl->gc.i[i]+1; |
100 |
+ |
if ((incell &= gcl->gmax[i] > gcl->gmin[i])) { |
101 |
+ |
rrng[i][0] = 256.*(gcl->gmin[i] - gcl->gc.i[i]) + |
102 |
+ |
(1.-FTINY); |
103 |
+ |
rrng[i][1] = 256.*(gcl->gmax[i] - gcl->gc.i[i]) + |
104 |
+ |
(1.-FTINY) - rrng[i][0]; |
105 |
+ |
incell &= rrng[i][1] > 0; |
106 |
+ |
} |
107 |
+ |
} |
108 |
+ |
return(incell); |
109 |
+ |
} |
110 |
+ |
|
111 |
+ |
|
112 |
|
packrays(rod, p) /* pack ray origins and directions */ |
113 |
|
register float *rod; |
114 |
|
register PACKET *p; |
115 |
|
{ |
116 |
< |
float packdc2[RPACKSIZ]; |
117 |
< |
int iterleft = 3*p->nr + 9; |
118 |
< |
BYTE rpos[2][2]; |
119 |
< |
FVECT ro, rd, rp1; |
116 |
> |
#define gp ro |
117 |
> |
#ifdef DEBUG |
118 |
> |
double dist2sum = 0.; |
119 |
> |
FVECT vt; |
120 |
> |
#endif |
121 |
> |
int nretries = p->nr + 2; |
122 |
> |
struct gclim eyelim; |
123 |
> |
short rrng0[2][2], rrng1[2][2]; |
124 |
> |
int useyelim; |
125 |
|
GCOORD gc[2]; |
126 |
< |
double d, dc2, md2, td2, dc2worst = FHUGE; |
127 |
< |
int i; |
128 |
< |
register int ii; |
126 |
> |
FVECT ro, rd; |
127 |
> |
double d; |
128 |
> |
register int i; |
129 |
|
|
130 |
|
if (!hdbcoord(gc, hdlist[p->hd], p->bi)) |
131 |
|
error(CONSISTENCY, "bad beam index in packrays"); |
132 |
< |
td2 = myeye.rng + FTINY; td2 *= td2; |
133 |
< |
for (i = 0, md2 = 0.; i < p->nr || (md2 > td2 && iterleft--); ) { |
134 |
< |
rpos[0][0] = frandom() * 256.; |
135 |
< |
rpos[0][1] = frandom() * 256.; |
136 |
< |
rpos[1][0] = frandom() * 256.; |
137 |
< |
rpos[1][1] = frandom() * 256.; |
138 |
< |
d = hdray(ro, rd, hdlist[p->hd], gc, rpos); |
139 |
< |
if (myeye.rng > FTINY) { /* check eyepoint */ |
140 |
< |
register int nexti; |
141 |
< |
|
142 |
< |
VSUM(rp1, ro, rd, d); |
143 |
< |
dc2 = dist2line(myeye.vpt, ro, rp1) / p->nr; |
144 |
< |
if (i == p->nr) { /* packet full */ |
145 |
< |
if (dc2 >= dc2worst) /* quick check */ |
146 |
< |
continue; |
147 |
< |
nexti = 0; /* find worst */ |
148 |
< |
for (ii = i; --ii; ) |
149 |
< |
if (packdc2[ii] > packdc2[nexti]) |
150 |
< |
nexti = ii; |
151 |
< |
if (dc2 >= (dc2worst = packdc2[nexti])) |
152 |
< |
continue; /* worse than worst */ |
153 |
< |
md2 -= dc2worst; |
154 |
< |
} else |
155 |
< |
nexti = i++; |
156 |
< |
md2 += packdc2[nexti] = dc2; /* new distance */ |
157 |
< |
ii = nexti; /* put it here */ |
158 |
< |
} else |
159 |
< |
ii = i++; |
132 |
> |
if ((useyelim = myeye.rng > FTINY)) { |
133 |
> |
initeyelim(&eyelim, p->hd, gc); |
134 |
> |
gp[gc[1].w>>1] = gc[1].w&1 ? |
135 |
> |
hdlist[p->hd]->grid[gc[1].w>>1] : 0; |
136 |
> |
gp[hdwg0[gc[1].w]] = gc[1].i[0]; |
137 |
> |
gp[hdwg1[gc[1].w]] = gc[1].i[1]; |
138 |
> |
groweyelim(&eyelim, gp); |
139 |
> |
gp[hdwg0[gc[1].w]]++; |
140 |
> |
gp[hdwg1[gc[1].w]]++; |
141 |
> |
groweyelim(&eyelim, gp); |
142 |
> |
useyelim &= clipeyelim(rrng0, &eyelim); |
143 |
> |
} |
144 |
> |
for (i = 0; i < p->nr; i++) { |
145 |
> |
retry: |
146 |
> |
if (useyelim) { |
147 |
> |
p->ra[i].r[0][0] = (int)(frandom()*rrng0[0][1]) |
148 |
> |
+ rrng0[0][0]; |
149 |
> |
p->ra[i].r[0][1] = (int)(frandom()*rrng0[1][1]) |
150 |
> |
+ rrng0[1][0]; |
151 |
> |
initeyelim(&eyelim, p->hd, gc+1); |
152 |
> |
gp[gc[0].w>>1] = gc[0].w&1 ? |
153 |
> |
hdlist[p->hd]->grid[gc[0].w>>1] : 0; |
154 |
> |
gp[hdwg0[gc[0].w]] = gc[0].i[0] + |
155 |
> |
(1./256.)*(p->ra[i].r[0][0]+.5); |
156 |
> |
gp[hdwg1[gc[0].w]] = gc[0].i[1] + |
157 |
> |
(1./256.)*(p->ra[i].r[0][1]+.5); |
158 |
> |
groweyelim(&eyelim, gp); |
159 |
> |
if (!clipeyelim(rrng1, &eyelim)) { |
160 |
> |
useyelim &= nretries-- > 0; |
161 |
> |
#ifdef DEBUG |
162 |
> |
if (!useyelim) |
163 |
> |
error(WARNING, "exceeded retry limit in packrays"); |
164 |
> |
#endif |
165 |
> |
goto retry; |
166 |
> |
} |
167 |
> |
p->ra[i].r[1][0] = (int)(frandom()*rrng1[0][1]) |
168 |
> |
+ rrng1[0][0]; |
169 |
> |
p->ra[i].r[1][1] = (int)(frandom()*rrng1[1][1]) |
170 |
> |
+ rrng1[1][0]; |
171 |
> |
} else { |
172 |
> |
p->ra[i].r[0][0] = frandom() * 256.; |
173 |
> |
p->ra[i].r[0][1] = frandom() * 256.; |
174 |
> |
p->ra[i].r[1][0] = frandom() * 256.; |
175 |
> |
p->ra[i].r[1][1] = frandom() * 256.; |
176 |
> |
} |
177 |
> |
d = hdray(ro, rd, hdlist[p->hd], gc, p->ra[i].r); |
178 |
> |
#ifdef DEBUG |
179 |
> |
VSUM(vt, ro, rd, d); |
180 |
> |
dist2sum += dist2line(myeye.vpt, ro, vt); |
181 |
> |
#endif |
182 |
|
if (p->offset != NULL) { |
183 |
|
if (!vdef(OBSTRUCTIONS)) |
184 |
|
d *= frandom(); /* random offset */ |
185 |
|
VSUM(ro, ro, rd, d); /* advance ray */ |
186 |
< |
p->offset[ii] = d; |
186 |
> |
p->offset[i] = d; |
187 |
|
} |
188 |
< |
p->ra[ii].r[0][0] = rpos[0][0]; |
189 |
< |
p->ra[ii].r[0][1] = rpos[0][1]; |
190 |
< |
p->ra[ii].r[1][0] = rpos[1][0]; |
191 |
< |
p->ra[ii].r[1][1] = rpos[1][1]; |
72 |
< |
VCOPY(rod+6*ii, ro); |
73 |
< |
VCOPY(rod+6*ii+3, rd); |
188 |
> |
VCOPY(rod, ro); |
189 |
> |
rod += 3; |
190 |
> |
VCOPY(rod, rd); |
191 |
> |
rod += 3; |
192 |
|
} |
193 |
|
#ifdef DEBUG |
194 |
< |
fprintf(stderr, "%f mean distance for target %f (%d iterations left)\n", |
77 |
< |
sqrt(md2), myeye.rng, iterleft); |
194 |
> |
fprintf(stderr, "RMS distance = %f\n", sqrt(dist2sum/p->nr)); |
195 |
|
#endif |
196 |
+ |
#undef gp |
197 |
|
} |
198 |
|
|
199 |
|
|