55 |
|
} FFTRI; /* vectors and coefficients for Hessian calculation */ |
56 |
|
|
57 |
|
|
58 |
< |
static int |
59 |
< |
ambcollision( /* proposed direciton collides? */ |
60 |
< |
AMBHEMI *hp, |
61 |
< |
int i, |
62 |
< |
int j, |
63 |
< |
FVECT dv |
64 |
< |
) |
65 |
< |
{ |
66 |
< |
double cos_thresh; |
67 |
< |
int ii, jj; |
68 |
< |
|
69 |
< |
cos_thresh = (PI*MINSDIST)/(double)hp->ns; |
70 |
< |
cos_thresh = 1. - .5*cos_thresh*cos_thresh; |
71 |
< |
/* check existing neighbors */ |
72 |
< |
for (ii = i-1; ii <= i+1; ii++) { |
73 |
< |
if (ii < 0) continue; |
74 |
< |
if (ii >= hp->ns) break; |
75 |
< |
for (jj = j-1; jj <= j+1; jj++) { |
76 |
< |
AMBSAMP *ap; |
77 |
< |
FVECT avec; |
78 |
< |
double dprod; |
79 |
< |
if (jj < 0) continue; |
80 |
< |
if (jj >= hp->ns) break; |
81 |
< |
if ((ii==i) & (jj==j)) continue; |
82 |
< |
ap = &ambsam(hp,ii,jj); |
83 |
< |
if (ap->d <= .5/FHUGE) |
84 |
< |
continue; /* no one home */ |
85 |
< |
VSUB(avec, ap->p, hp->rp->rop); |
86 |
< |
dprod = DOT(avec, dv); |
87 |
< |
if (dprod >= cos_thresh*VLEN(avec)) |
88 |
< |
return(1); /* collision */ |
89 |
< |
} |
90 |
< |
} |
91 |
< |
return(0); /* nothing to worry about */ |
92 |
< |
} |
93 |
< |
|
94 |
< |
|
95 |
< |
#define XLOTSIZ 251 /* size of used car lot */ |
58 |
> |
#define XLOTSIZ 512 /* size of used car lot */ |
59 |
|
#define CFIRST 0 /* first corner */ |
60 |
|
#define COTHER (CFIRST+4) /* non-corner sample */ |
61 |
|
#define CMAXTARGET (int)(XLOTSIZ*MINSDIST/(1-MINSDIST)) |
99 |
– |
#define CXCOPY(d,s) (excharr[d][0]=excharr[s][0], excharr[d][1]=excharr[s][1]) |
62 |
|
|
63 |
|
static int |
64 |
|
psample_class(double ss[2]) /* classify patch sample */ |
80 |
|
static void |
81 |
|
trade_patchsamp(double ss[2]) /* trade in problem patch position */ |
82 |
|
{ |
83 |
< |
static float excharr[XLOTSIZ][2]; |
83 |
> |
static float tradelot[XLOTSIZ][2]; |
84 |
|
static short gterm[COTHER+1]; |
85 |
< |
double srep[2]; |
85 |
> |
double repl[2]; |
86 |
|
int sclass, rclass; |
87 |
|
int x; |
88 |
< |
/* reset on corner overload */ |
127 |
< |
if (gterm[COTHER-1] >= (CMAXTARGET+XLOTSIZ)/2) |
128 |
< |
memset(gterm, 0, sizeof(gterm)); |
129 |
< |
/* (re-)initialize? */ |
88 |
> |
/* initialize lot? */ |
89 |
|
while (gterm[COTHER] < XLOTSIZ) { |
90 |
< |
excharr[gterm[COTHER]][0] = frandom(); |
91 |
< |
excharr[gterm[COTHER]][1] = frandom(); |
90 |
> |
tradelot[gterm[COTHER]][0] = frandom(); |
91 |
> |
tradelot[gterm[COTHER]][1] = frandom(); |
92 |
|
++gterm[COTHER]; |
93 |
< |
} /* get trade-in candidate... */ |
93 |
> |
} |
94 |
> |
/* get trade-in candidate... */ |
95 |
|
sclass = psample_class(ss); /* submitted corner or not? */ |
96 |
|
switch (sclass) { |
97 |
|
case COTHER: /* trade mid-edge with corner/any */ |
106 |
|
x += (x >= gterm[sclass-1])*(gterm[sclass] - gterm[sclass-1]); |
107 |
|
break; |
108 |
|
} |
109 |
< |
srep[0] = excharr[x][0]; /* save selected replacement (result) */ |
110 |
< |
srep[1] = excharr[x][1]; |
109 |
> |
repl[0] = tradelot[x][0]; /* save selected replacement (result) */ |
110 |
> |
repl[1] = tradelot[x][1]; |
111 |
|
/* identify replacement class */ |
112 |
|
for (rclass = CFIRST; rclass < COTHER; rclass++) |
113 |
|
if (x < gterm[rclass]) |
114 |
|
break; /* repark to keep classes grouped */ |
115 |
|
while (rclass > sclass) { /* replacement group after submitted? */ |
116 |
< |
CXCOPY(x, gterm[rclass-1]); |
116 |
> |
tradelot[x][0] = tradelot[gterm[rclass-1]][0]; |
117 |
> |
tradelot[x][1] = tradelot[gterm[rclass-1]][1]; |
118 |
|
x = gterm[--rclass]++; |
119 |
|
} |
120 |
|
while (rclass < sclass) { /* replacement group before submitted? */ |
121 |
< |
--gterm[rclass]; |
122 |
< |
CXCOPY(x, gterm[rclass]); |
121 |
> |
tradelot[x][0] = tradelot[--gterm[rclass]][0]; |
122 |
> |
tradelot[x][1] = tradelot[gterm[rclass]][1]; |
123 |
|
x = gterm[rclass++]; |
124 |
|
} |
125 |
< |
excharr[x][0] = ss[0]; /* complete the trade-in */ |
126 |
< |
excharr[x][1] = ss[1]; |
127 |
< |
ss[0] = srep[0]; |
128 |
< |
ss[1] = srep[1]; |
125 |
> |
tradelot[x][0] = ss[0]; /* complete the trade-in */ |
126 |
> |
tradelot[x][1] = ss[1]; |
127 |
> |
ss[0] = repl[0]; |
128 |
> |
ss[1] = repl[1]; |
129 |
|
} |
130 |
|
|
170 |
– |
#undef CXCOPY |
131 |
|
#undef XLOTSIZ |
132 |
|
#undef COTHER |
133 |
|
#undef CFIRST |
134 |
|
|
135 |
|
|
136 |
|
static int |
137 |
+ |
ambcollision( /* proposed direction collides? */ |
138 |
+ |
AMBHEMI *hp, |
139 |
+ |
int i, |
140 |
+ |
int j, |
141 |
+ |
RREAL spt[2] |
142 |
+ |
) |
143 |
+ |
{ |
144 |
+ |
int ii, jj; |
145 |
+ |
/* check existing neighbors */ |
146 |
+ |
for (ii = i-1; ii <= i+1; ii++) { |
147 |
+ |
if (ii < 0) continue; |
148 |
+ |
if (ii >= hp->ns) break; |
149 |
+ |
for (jj = j-1; jj <= j+1; jj++) { |
150 |
+ |
AMBSAMP *ap; |
151 |
+ |
FVECT avec; |
152 |
+ |
double dx, dy; |
153 |
+ |
if (jj < 0) continue; |
154 |
+ |
if (jj >= hp->ns) break; |
155 |
+ |
if ((ii==i) & (jj==j)) continue; |
156 |
+ |
ap = &ambsam(hp,ii,jj); |
157 |
+ |
if (ap->d <= .5/FHUGE) |
158 |
+ |
continue; /* no one home */ |
159 |
+ |
VSUB(avec, ap->p, hp->rp->rop); |
160 |
+ |
normalize(avec); /* use diskworld distance */ |
161 |
+ |
dx = DOT(avec, hp->ux) - spt[0]; |
162 |
+ |
dy = DOT(avec, hp->uy) - spt[1]; |
163 |
+ |
if ((dx*dx + dy*dy)*(hp->ns*hp->ns) < |
164 |
+ |
PI*MINSDIST*MINSDIST) |
165 |
+ |
return(1); /* too close */ |
166 |
+ |
} |
167 |
+ |
} |
168 |
+ |
return(0); /* nothing to worry about */ |
169 |
+ |
} |
170 |
+ |
|
171 |
+ |
|
172 |
+ |
static int |
173 |
|
ambsample( /* initial ambient division sample */ |
174 |
|
AMBHEMI *hp, |
175 |
|
int i, |
177 |
|
int n |
178 |
|
) |
179 |
|
{ |
180 |
+ |
int trade_ok = (!n & (hp->ns >= 4))*21; |
181 |
|
AMBSAMP *ap = &ambsam(hp,i,j); |
182 |
|
RAY ar; |
183 |
|
int hlist[3], ii; |
200 |
|
hlist[1] = AI(hp,i,j); |
201 |
|
hlist[2] = samplendx; |
202 |
|
multisamp(ss, 2, urand(ilhash(hlist,3)+n)); |
206 |
– |
patch_redo: |
203 |
|
square2disk(spt, (j+ss[1])/hp->ns, (i+ss[0])/hp->ns); |
204 |
+ |
/* avoid coincident samples? */ |
205 |
+ |
while (trade_ok-- && ambcollision(hp, i, j, spt)) { |
206 |
+ |
if (trade_ok) { |
207 |
+ |
trade_patchsamp(ss); |
208 |
+ |
} else { /* punting... */ |
209 |
+ |
ss[0] = MINSDIST + (1-2*MINSDIST)*frandom(); |
210 |
+ |
ss[1] = MINSDIST + (1-2*MINSDIST)*frandom(); |
211 |
+ |
} |
212 |
+ |
square2disk(spt, (j+ss[1])/hp->ns, (i+ss[0])/hp->ns); |
213 |
+ |
} |
214 |
|
zd = sqrt(1. - spt[0]*spt[0] - spt[1]*spt[1]); |
215 |
|
for (ii = 3; ii--; ) |
216 |
|
ar.rdir[ii] = spt[0]*hp->ux[ii] + |
217 |
|
spt[1]*hp->uy[ii] + |
218 |
|
zd*hp->onrm[ii]; |
219 |
|
checknorm(ar.rdir); |
214 |
– |
/* avoid coincident samples */ |
215 |
– |
if (!n & (hp->ns >= 4) && ambcollision(hp, i, j, ar.rdir)) { |
216 |
– |
trade_patchsamp(ss); |
217 |
– |
goto patch_redo; |
218 |
– |
} |
220 |
|
dimlist[ndims++] = AI(hp,i,j) + 90171; |
221 |
|
rayvalue(&ar); /* evaluate ray */ |
222 |
|
ndims--; |