| 13 |
|
#include "random.h" |
| 14 |
|
|
| 15 |
|
|
| 16 |
+ |
VIEWPOINT myeye; /* target view position */ |
| 17 |
+ |
|
| 18 |
+ |
|
| 19 |
|
packrays(rod, p) /* pack ray origins and directions */ |
| 20 |
< |
float *rod; |
| 20 |
> |
register float *rod; |
| 21 |
|
register PACKET *p; |
| 22 |
|
{ |
| 23 |
< |
static int nmh = 0; |
| 24 |
< |
static int *mhtab; |
| 25 |
< |
FVECT ro, rd; |
| 26 |
< |
register BEAM *bp; |
| 23 |
> |
short packord[RPACKSIZ]; |
| 24 |
> |
float packdc[RPACKSIZ]; |
| 25 |
> |
int iterleft = 3*p->nr; |
| 26 |
> |
BYTE rpos[2][2]; |
| 27 |
> |
FVECT ro, rd, rp1; |
| 28 |
|
GCOORD gc[2]; |
| 29 |
< |
int ila[4], offset; |
| 30 |
< |
double d, sl[4]; |
| 31 |
< |
register int i, j, k; |
| 29 |
> |
double d, dc, meandist; |
| 30 |
> |
int i; |
| 31 |
> |
register int ii; |
| 32 |
|
|
| 33 |
|
if (!hdbcoord(gc, hdlist[p->hd], p->bi)) |
| 34 |
|
error(CONSISTENCY, "bad beam index in packrays"); |
| 35 |
< |
/* uniqueness hash */ |
| 36 |
< |
if ((bp = hdgetbeam(hdlist[p->hd], p->bi)) != NULL) { |
| 37 |
< |
if (2*bp->nrm > nmh) { |
| 38 |
< |
if (nmh) free((char *)mhtab); |
| 39 |
< |
nmh = 2*bp->nrm + 1; |
| 40 |
< |
mhtab = (int *)malloc(nmh*sizeof(int)); |
| 41 |
< |
if (mhtab == NULL) |
| 42 |
< |
error(SYSTEM, "out of memory in packrays"); |
| 43 |
< |
} |
| 44 |
< |
for (k = nmh; k--; ) |
| 45 |
< |
mhtab[k] = -1; |
| 46 |
< |
for (i = bp->nrm; i--; ) { |
| 47 |
< |
ila[0] = hdbray(bp)[i].r[0][0]; |
| 48 |
< |
ila[1] = hdbray(bp)[i].r[0][1]; |
| 49 |
< |
ila[2] = hdbray(bp)[i].r[1][0]; |
| 50 |
< |
ila[3] = hdbray(bp)[i].r[1][1]; |
| 51 |
< |
for (k = ilhash(ila,4); mhtab[k%nmh] >= 0; k++) |
| 52 |
< |
; |
| 53 |
< |
mhtab[k%nmh] = i; |
| 54 |
< |
} |
| 55 |
< |
} |
| 56 |
< |
/* init each ray */ |
| 57 |
< |
ila[0] = p->hd; ila[1] = p->bi; |
| 54 |
< |
offset = ilhash(ila,2) + p->nc; |
| 55 |
< |
for (i = 0; i < p->nr; i++) { |
| 56 |
< |
do { /* next unique ray */ |
| 57 |
< |
multisamp(sl, 4, urand(offset+i)); |
| 58 |
< |
p->ra[i].r[0][0] = ila[0] = sl[0] * 256.; |
| 59 |
< |
p->ra[i].r[0][1] = ila[1] = sl[1] * 256.; |
| 60 |
< |
p->ra[i].r[1][0] = ila[2] = sl[2] * 256.; |
| 61 |
< |
p->ra[i].r[1][1] = ila[3] = sl[3] * 256.; |
| 62 |
< |
if (bp == NULL) |
| 63 |
< |
break; |
| 64 |
< |
for (k = ilhash(ila,4); (j = mhtab[k%nmh]) >= 0; k++) |
| 65 |
< |
if (hdbray(bp)[j].r[0][0] == |
| 66 |
< |
p->ra[i].r[0][0] && |
| 67 |
< |
hdbray(bp)[j].r[0][1] == |
| 68 |
< |
p->ra[i].r[0][1] && |
| 69 |
< |
hdbray(bp)[j].r[1][0] == |
| 70 |
< |
p->ra[i].r[1][0] && |
| 71 |
< |
hdbray(bp)[j].r[1][1] == |
| 72 |
< |
p->ra[i].r[1][1]) { |
| 73 |
< |
offset += bp->nrm - j; |
| 35 |
> |
for (i = 0, meandist = 0.; i < p->nr || meandist > myeye.rng+FTINY; ) { |
| 36 |
> |
rpos[0][0] = frandom() * 256.; |
| 37 |
> |
rpos[0][1] = frandom() * 256.; |
| 38 |
> |
rpos[1][0] = frandom() * 256.; |
| 39 |
> |
rpos[1][1] = frandom() * 256.; |
| 40 |
> |
d = hdray(ro, rd, hdlist[p->hd], gc, rpos); |
| 41 |
> |
if (myeye.rng > FTINY) { /* check eyepoint */ |
| 42 |
> |
register int nexti; |
| 43 |
> |
|
| 44 |
> |
VSUM(rp1, ro, rd, d); |
| 45 |
> |
dc = sqrt(dist2line(myeye.vpt, ro, rp1)) / p->nr; |
| 46 |
> |
if (i == p->nr) { /* packet full */ |
| 47 |
> |
nexti = packord[i-1]; |
| 48 |
> |
if (!iterleft--) |
| 49 |
> |
break; /* tried enough! */ |
| 50 |
> |
if (dc >= packdc[nexti]) |
| 51 |
> |
continue; /* worse than worst */ |
| 52 |
> |
meandist -= packdc[nexti]; |
| 53 |
> |
} else |
| 54 |
> |
nexti = i++; |
| 55 |
> |
meandist += packdc[nexti] = dc; /* new distance */ |
| 56 |
> |
for (ii = i; --ii; ) { /* insertion sort */ |
| 57 |
> |
if (dc > packdc[packord[ii-1]]) |
| 58 |
|
break; |
| 59 |
< |
} |
| 60 |
< |
} while (j >= 0); |
| 61 |
< |
d = hdray(ro, rd, hdlist[p->hd], gc, p->ra[i].r); |
| 62 |
< |
if (!vdef(OBSTRUCTIONS)) |
| 63 |
< |
d *= frandom(); /* random offset */ |
| 59 |
> |
packord[ii] = packord[ii-1]; |
| 60 |
> |
} |
| 61 |
> |
packord[ii] = nexti; |
| 62 |
> |
ii = nexti; /* put it here */ |
| 63 |
> |
} else |
| 64 |
> |
ii = i++; |
| 65 |
|
if (p->offset != NULL) { |
| 66 |
+ |
if (!vdef(OBSTRUCTIONS)) |
| 67 |
+ |
d *= frandom(); /* random offset */ |
| 68 |
|
VSUM(ro, ro, rd, d); /* advance ray */ |
| 69 |
< |
p->offset[i] = d; |
| 69 |
> |
p->offset[ii] = d; |
| 70 |
|
} |
| 71 |
< |
VCOPY(rod, ro); |
| 72 |
< |
rod += 3; |
| 73 |
< |
VCOPY(rod, rd); |
| 74 |
< |
rod += 3; |
| 71 |
> |
p->ra[ii].r[0][0] = rpos[0][0]; |
| 72 |
> |
p->ra[ii].r[0][1] = rpos[0][1]; |
| 73 |
> |
p->ra[ii].r[1][0] = rpos[1][0]; |
| 74 |
> |
p->ra[ii].r[1][1] = rpos[1][1]; |
| 75 |
> |
VCOPY(rod+6*ii, ro); |
| 76 |
> |
VCOPY(rod+6*ii+3, rd); |
| 77 |
|
} |
| 78 |
+ |
#ifdef DEBUG |
| 79 |
+ |
fprintf(stderr, "%f mean distance for target %f (%d iterations)\n", |
| 80 |
+ |
meandist, myeye.rng, 3*p->nr - iterleft); |
| 81 |
+ |
#endif |
| 82 |
|
} |
| 83 |
|
|
| 84 |
|
|
