24 |
|
#ifndef MINADIV |
25 |
|
#define MINADIV 7 /* minimum # divisions in each dimension */ |
26 |
|
#endif |
27 |
+ |
#ifndef MINSDIST |
28 |
+ |
#define MINSDIST 0.25 /* def. min. spacing = 1/4th division */ |
29 |
+ |
#endif |
30 |
|
|
31 |
|
typedef struct { |
32 |
|
FVECT p; /* intersection point */ |
55 |
|
} FFTRI; /* vectors and coefficients for Hessian calculation */ |
56 |
|
|
57 |
|
|
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)) |
62 |
+ |
|
63 |
|
static int |
64 |
< |
ambcollision( /* proposed direciton collides? */ |
64 |
> |
psample_class(double ss[2]) /* classify patch sample */ |
65 |
> |
{ |
66 |
> |
if (ss[0] < MINSDIST) { |
67 |
> |
if (ss[1] < MINSDIST) |
68 |
> |
return(CFIRST); |
69 |
> |
if (ss[1] > 1.-MINSDIST) |
70 |
> |
return(CFIRST+2); |
71 |
> |
} else if (ss[0] > 1.-MINSDIST) { |
72 |
> |
if (ss[1] < MINSDIST) |
73 |
> |
return(CFIRST+1); |
74 |
> |
if (ss[1] > 1.-MINSDIST) |
75 |
> |
return(CFIRST+3); |
76 |
> |
} |
77 |
> |
return(COTHER); /* not in a corner */ |
78 |
> |
} |
79 |
> |
|
80 |
> |
static void |
81 |
> |
trade_patchsamp(double ss[2]) /* trade in problem patch position */ |
82 |
> |
{ |
83 |
> |
static float tradelot[XLOTSIZ][2]; |
84 |
> |
static short gterm[COTHER+1]; |
85 |
> |
double repl[2]; |
86 |
> |
int sclass, rclass; |
87 |
> |
int x; |
88 |
> |
/* initialize lot? */ |
89 |
> |
while (gterm[COTHER] < XLOTSIZ) { |
90 |
> |
tradelot[gterm[COTHER]][0] = frandom(); |
91 |
> |
tradelot[gterm[COTHER]][1] = frandom(); |
92 |
> |
++gterm[COTHER]; |
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 */ |
98 |
> |
x = irandom( gterm[COTHER-1] > CMAXTARGET |
99 |
> |
? gterm[COTHER-1] : XLOTSIZ ); |
100 |
> |
break; |
101 |
> |
case CFIRST: /* kick out of first corner */ |
102 |
> |
x = gterm[CFIRST] + irandom(XLOTSIZ - gterm[CFIRST]); |
103 |
> |
break; |
104 |
> |
default: /* kick out of 2nd-4th corner */ |
105 |
> |
x = irandom(XLOTSIZ - (gterm[sclass] - gterm[sclass-1])); |
106 |
> |
x += (x >= gterm[sclass-1])*(gterm[sclass] - gterm[sclass-1]); |
107 |
> |
break; |
108 |
> |
} |
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 |
> |
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 |
> |
tradelot[x][0] = tradelot[--gterm[rclass]][0]; |
122 |
> |
tradelot[x][1] = tradelot[gterm[rclass]][1]; |
123 |
> |
x = gterm[rclass++]; |
124 |
> |
} |
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 |
> |
|
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 |
< |
FVECT dv |
141 |
> |
RREAL spt[2] |
142 |
|
) |
143 |
|
{ |
63 |
– |
double cos_thresh; |
144 |
|
int ii, jj; |
65 |
– |
/* min. spacing = 1/4th division */ |
66 |
– |
cos_thresh = (PI/4.)/(double)hp->ns; |
67 |
– |
cos_thresh = 1. - .5*cos_thresh*cos_thresh; |
145 |
|
/* check existing neighbors */ |
146 |
|
for (ii = i-1; ii <= i+1; ii++) { |
147 |
|
if (ii < 0) continue; |
149 |
|
for (jj = j-1; jj <= j+1; jj++) { |
150 |
|
AMBSAMP *ap; |
151 |
|
FVECT avec; |
152 |
< |
double dprod; |
152 |
> |
double dx, dy; |
153 |
|
if (jj < 0) continue; |
154 |
|
if (jj >= hp->ns) break; |
155 |
|
if ((ii==i) & (jj==j)) continue; |
157 |
|
if (ap->d <= .5/FHUGE) |
158 |
|
continue; /* no one home */ |
159 |
|
VSUB(avec, ap->p, hp->rp->rop); |
160 |
< |
dprod = DOT(avec, dv); |
161 |
< |
if (dprod >= cos_thresh*VLEN(avec)) |
162 |
< |
return(1); /* collision */ |
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 */ |
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)); |
122 |
– |
resample: |
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); |
130 |
– |
/* avoid coincident samples */ |
131 |
– |
if (!n && hp->ns >= 4 && ambcollision(hp, i, j, ar.rdir)) { |
132 |
– |
ss[0] = frandom(); ss[1] = frandom(); |
133 |
– |
goto resample; /* reject this sample */ |
134 |
– |
} |
220 |
|
dimlist[ndims++] = AI(hp,i,j) + 90171; |
221 |
|
rayvalue(&ar); /* evaluate ray */ |
222 |
|
ndims--; |