ViewVC Help
View File | Revision Log | Show Annotations | Download File | Root Listing
root/radiance/ray/src/cv/bsdfmesh.c
Revision: 2.21
Committed: Sun Mar 9 01:51:48 2014 UTC (10 years ago) by greg
Content type: text/plain
Branch: MAIN
Changes since 2.20: +2 -2 lines
Log Message:
Tuned neighborhood factor down until it seemed to make the right difference

File Contents

# User Rev Content
1 greg 2.1 #ifndef lint
2 greg 2.21 static const char RCSid[] = "$Id: bsdfmesh.c,v 2.20 2014/03/08 21:06:14 greg Exp $";
3 greg 2.1 #endif
4     /*
5     * Create BSDF advection mesh from radial basis functions.
6     *
7     * G. Ward
8     */
9    
10     #ifndef _WIN32
11     #include <unistd.h>
12     #include <sys/wait.h>
13     #include <sys/mman.h>
14     #endif
15     #define _USE_MATH_DEFINES
16     #include <stdio.h>
17     #include <stdlib.h>
18     #include <string.h>
19     #include <math.h>
20     #include "bsdfrep.h"
21 greg 2.19
22     #ifndef NEIGH_FACT2
23 greg 2.21 #define NEIGH_FACT2 0.1 /* empirical neighborhood distance weight */
24 greg 2.19 #endif
25 greg 2.1 /* number of processes to run */
26     int nprocs = 1;
27     /* number of children (-1 in child) */
28     static int nchild = 0;
29    
30 greg 2.3 typedef struct {
31     int nrows, ncols; /* array size (matches migration) */
32     float *price; /* migration prices */
33     short *sord; /* sort for each row, low to high */
34 greg 2.10 float *prow; /* current price row */
35 greg 2.3 } PRICEMAT; /* sorted pricing matrix */
36    
37     #define pricerow(p,i) ((p)->price + (i)*(p)->ncols)
38     #define psortrow(p,i) ((p)->sord + (i)*(p)->ncols)
39    
40 greg 2.2 /* Create a new migration holder (sharing memory for multiprocessing) */
41     static MIGRATION *
42     new_migration(RBFNODE *from_rbf, RBFNODE *to_rbf)
43     {
44     size_t memlen = sizeof(MIGRATION) +
45     sizeof(float)*(from_rbf->nrbf*to_rbf->nrbf - 1);
46     MIGRATION *newmig;
47     #ifdef _WIN32
48     if (nprocs > 1)
49     fprintf(stderr, "%s: warning - multiprocessing not supported\n",
50     progname);
51     nprocs = 1;
52     newmig = (MIGRATION *)malloc(memlen);
53     #else
54     if (nprocs <= 1) { /* single process? */
55     newmig = (MIGRATION *)malloc(memlen);
56     } else { /* else need to share memory */
57     newmig = (MIGRATION *)mmap(NULL, memlen, PROT_READ|PROT_WRITE,
58     MAP_ANON|MAP_SHARED, -1, 0);
59     if ((void *)newmig == MAP_FAILED)
60     newmig = NULL;
61     }
62     #endif
63     if (newmig == NULL) {
64     fprintf(stderr, "%s: cannot allocate new migration\n", progname);
65     exit(1);
66     }
67     newmig->rbfv[0] = from_rbf;
68     newmig->rbfv[1] = to_rbf;
69     /* insert in edge lists */
70     newmig->enxt[0] = from_rbf->ejl;
71     from_rbf->ejl = newmig;
72     newmig->enxt[1] = to_rbf->ejl;
73     to_rbf->ejl = newmig;
74     newmig->next = mig_list; /* push onto global list */
75     return(mig_list = newmig);
76     }
77    
78     #ifdef _WIN32
79     #define await_children(n) (void)(n)
80     #define run_subprocess() 0
81     #define end_subprocess() (void)0
82     #else
83    
84     /* Wait for the specified number of child processes to complete */
85     static void
86     await_children(int n)
87     {
88     int exit_status = 0;
89    
90     if (n > nchild)
91     n = nchild;
92     while (n-- > 0) {
93     int status;
94     if (wait(&status) < 0) {
95     fprintf(stderr, "%s: missing child(ren)!\n", progname);
96     nchild = 0;
97     break;
98     }
99     --nchild;
100     if (status) { /* something wrong */
101     if ((status = WEXITSTATUS(status)))
102     exit_status = status;
103     else
104     exit_status += !exit_status;
105     fprintf(stderr, "%s: subprocess died\n", progname);
106     n = nchild; /* wait for the rest */
107     }
108     }
109     if (exit_status)
110     exit(exit_status);
111     }
112    
113     /* Start child process if multiprocessing selected */
114     static pid_t
115     run_subprocess(void)
116     {
117     int status;
118     pid_t pid;
119    
120     if (nprocs <= 1) /* any children requested? */
121     return(0);
122     await_children(nchild + 1 - nprocs); /* free up child process */
123     if ((pid = fork())) {
124     if (pid < 0) {
125     fprintf(stderr, "%s: cannot fork subprocess\n",
126     progname);
127 greg 2.6 await_children(nchild);
128 greg 2.2 exit(1);
129     }
130     ++nchild; /* subprocess started */
131     return(pid);
132     }
133     nchild = -1;
134     return(0); /* put child to work */
135     }
136    
137     /* If we are in subprocess, call exit */
138     #define end_subprocess() if (nchild < 0) _exit(0); else
139    
140     #endif /* ! _WIN32 */
141    
142 greg 2.19 /* Compute normalized distribution scattering functions for comparison */
143     static void
144     compute_nDSFs(const RBFNODE *rbf0, const RBFNODE *rbf1)
145     {
146     const double nf0 = (GRIDRES*GRIDRES) / rbf0->vtotal;
147     const double nf1 = (GRIDRES*GRIDRES) / rbf1->vtotal;
148     int x, y;
149     FVECT dv;
150    
151     for (x = GRIDRES; x--; )
152     for (y = GRIDRES; y--; ) {
153 greg 2.20 ovec_from_pos(dv, x, y); /* cube root (brightness) */
154     dsf_grid[x][y].val[0] = pow(nf0*eval_rbfrep(rbf0, dv), .3333);
155     dsf_grid[x][y].val[1] = pow(nf1*eval_rbfrep(rbf1, dv), .3333);
156 greg 2.19 }
157     }
158    
159     /* Compute neighborhood distance-squared (dissimilarity) */
160     static double
161     neighborhood_dist2(int x0, int y0, int x1, int y1)
162     {
163     int rad = GRIDRES>>5;
164     double sum2 = 0.;
165     double d;
166     int p[4];
167     int i, j;
168    
169     if ((x0 == x1) & (y0 == y1))
170     return(0.);
171     /* check radius */
172     p[0] = x0; p[1] = y0; p[2] = x1; p[3] = y1;
173     for (i = 4; i--; ) {
174     if (p[i] < rad) rad = p[i];
175     if (GRIDRES-1-p[i] < rad) rad = GRIDRES-1-p[i];
176     }
177     for (i = -rad; i <= rad; i++)
178     for (j = -rad; j <= rad; j++) {
179     d = dsf_grid[x0+i][y0+j].val[0] -
180     dsf_grid[x1+i][y1+j].val[1];
181     sum2 += d*d;
182     }
183     return(sum2 / (4*rad*(rad+1) + 1));
184     }
185    
186 greg 2.3 /* Comparison routine needed for sorting price row */
187     static int
188     msrt_cmp(void *b, const void *p1, const void *p2)
189     {
190     PRICEMAT *pm = (PRICEMAT *)b;
191 greg 2.10 float c1 = pm->prow[*(const short *)p1];
192     float c2 = pm->prow[*(const short *)p2];
193 greg 2.3
194     if (c1 > c2) return(1);
195     if (c1 < c2) return(-1);
196     return(0);
197     }
198    
199 greg 2.1 /* Compute (and allocate) migration price matrix for optimization */
200 greg 2.3 static void
201     price_routes(PRICEMAT *pm, const RBFNODE *from_rbf, const RBFNODE *to_rbf)
202 greg 2.1 {
203     FVECT *vto = (FVECT *)malloc(sizeof(FVECT) * to_rbf->nrbf);
204     int i, j;
205    
206 greg 2.19 compute_nDSFs(from_rbf, to_rbf);
207 greg 2.3 pm->nrows = from_rbf->nrbf;
208     pm->ncols = to_rbf->nrbf;
209     pm->price = (float *)malloc(sizeof(float) * pm->nrows*pm->ncols);
210     pm->sord = (short *)malloc(sizeof(short) * pm->nrows*pm->ncols);
211    
212     if ((pm->price == NULL) | (pm->sord == NULL) | (vto == NULL)) {
213 greg 2.1 fprintf(stderr, "%s: Out of memory in migration_costs()\n",
214     progname);
215     exit(1);
216     }
217     for (j = to_rbf->nrbf; j--; ) /* save repetitive ops. */
218     ovec_from_pos(vto[j], to_rbf->rbfa[j].gx, to_rbf->rbfa[j].gy);
219    
220     for (i = from_rbf->nrbf; i--; ) {
221     const double from_ang = R2ANG(from_rbf->rbfa[i].crad);
222     FVECT vfrom;
223 greg 2.10 short *srow;
224 greg 2.1 ovec_from_pos(vfrom, from_rbf->rbfa[i].gx, from_rbf->rbfa[i].gy);
225 greg 2.10 pm->prow = pricerow(pm,i);
226     srow = psortrow(pm,i);
227 greg 2.3 for (j = to_rbf->nrbf; j--; ) {
228 greg 2.20 double d; /* quadratic cost function */
229 greg 2.18 d = Acos(DOT(vfrom, vto[j]));
230 greg 2.13 pm->prow[j] = d*d;
231     d = R2ANG(to_rbf->rbfa[j].crad) - from_ang;
232 greg 2.19 pm->prow[j] += d*d;
233     /* neighborhood difference */
234     pm->prow[j] += NEIGH_FACT2 * neighborhood_dist2(
235     from_rbf->rbfa[i].gx, from_rbf->rbfa[i].gy,
236     to_rbf->rbfa[j].gx, to_rbf->rbfa[j].gy );
237 greg 2.10 srow[j] = j;
238 greg 2.3 }
239 greg 2.10 qsort_r(srow, pm->ncols, sizeof(short), pm, &msrt_cmp);
240 greg 2.1 }
241     free(vto);
242     }
243    
244 greg 2.3 /* Free price matrix */
245     static void
246     free_routes(PRICEMAT *pm)
247 greg 2.1 {
248 greg 2.3 free(pm->price); pm->price = NULL;
249     free(pm->sord); pm->sord = NULL;
250 greg 2.1 }
251    
252     /* Compute minimum (optimistic) cost for moving the given source material */
253     static double
254 greg 2.3 min_cost(double amt2move, const double *avail, const PRICEMAT *pm, int s)
255 greg 2.1 {
256 greg 2.11 const short *srow = psortrow(pm,s);
257     const float *prow = pricerow(pm,s);
258 greg 2.1 double total_cost = 0;
259 greg 2.3 int j;
260 greg 2.1 /* move cheapest first */
261 greg 2.11 for (j = 0; (j < pm->ncols) & (amt2move > FTINY); j++) {
262     int d = srow[j];
263 greg 2.1 double amt = (amt2move < avail[d]) ? amt2move : avail[d];
264    
265 greg 2.11 total_cost += amt * prow[d];
266 greg 2.1 amt2move -= amt;
267     }
268     return(total_cost);
269     }
270    
271 greg 2.17 typedef struct {
272     short s, d; /* source and destination */
273     float dc; /* discount to push inventory */
274     } ROWSENT; /* row sort entry */
275    
276     /* Compare entries by discounted moving price */
277 greg 2.11 static int
278     rmovcmp(void *b, const void *p1, const void *p2)
279     {
280     PRICEMAT *pm = (PRICEMAT *)b;
281 greg 2.17 const ROWSENT *re1 = (const ROWSENT *)p1;
282     const ROWSENT *re2 = (const ROWSENT *)p2;
283     double price_diff;
284    
285     if (re1->d < 0) return(re2->d >= 0);
286     if (re2->d < 0) return(-1);
287     price_diff = re1->dc*pricerow(pm,re1->s)[re1->d] -
288     re2->dc*pricerow(pm,re2->s)[re2->d];
289 greg 2.11 if (price_diff > 0) return(1);
290     if (price_diff < 0) return(-1);
291     return(0);
292     }
293    
294     /* Take a step in migration by choosing reasonable bucket to transfer */
295 greg 2.1 static double
296 greg 2.11 migration_step(MIGRATION *mig, double *src_rem, double *dst_rem, PRICEMAT *pm)
297 greg 2.1 {
298 greg 2.11 const int max2check = 100;
299 greg 2.4 const double maxamt = 1./(double)pm->ncols;
300 greg 2.12 const double minamt = maxamt*1e-4;
301 greg 2.5 double *src_cost;
302 greg 2.17 ROWSENT *rord;
303 greg 2.1 struct {
304     int s, d; /* source and destination */
305 greg 2.17 double price; /* cost per amount moved */
306 greg 2.1 double amt; /* amount we can move */
307     } cur, best;
308 greg 2.11 int r2check, i, ri;
309     /*
310     * Check cheapest available routes only -- a higher adjusted
311     * destination price implies that another source is closer, so
312     * we can hold off considering more expensive options until
313     * some other (hopefully better) moves have been made.
314 greg 2.17 * A discount based on source remaining is supposed to prioritize
315     * movement from large lobes, but it doesn't seem to do much,
316     * so we have it set to 1.0 at the moment.
317 greg 2.11 */
318 greg 2.17 #define discount(qr) 1.0
319 greg 2.11 /* most promising row order */
320 greg 2.17 rord = (ROWSENT *)malloc(sizeof(ROWSENT)*pm->nrows);
321 greg 2.11 if (rord == NULL)
322     goto memerr;
323     for (ri = pm->nrows; ri--; ) {
324 greg 2.17 rord[ri].s = ri;
325     rord[ri].d = -1;
326     rord[ri].dc = 1.f;
327 greg 2.11 if (src_rem[ri] <= minamt) /* enough source material? */
328     continue;
329     for (i = 0; i < pm->ncols; i++)
330 greg 2.17 if (dst_rem[ rord[ri].d = psortrow(pm,ri)[i] ] > minamt)
331 greg 2.11 break;
332     if (i >= pm->ncols) { /* moved all we can? */
333     free(rord);
334     return(.0);
335     }
336 greg 2.17 rord[ri].dc = discount(src_rem[ri]);
337 greg 2.11 }
338     if (pm->nrows > max2check) /* sort if too many sources */
339 greg 2.17 qsort_r(rord, pm->nrows, sizeof(ROWSENT), pm, &rmovcmp);
340 greg 2.5 /* allocate cost array */
341     src_cost = (double *)malloc(sizeof(double)*pm->nrows);
342 greg 2.11 if (src_cost == NULL)
343     goto memerr;
344 greg 2.3 for (i = pm->nrows; i--; ) /* starting costs for diff. */
345     src_cost[i] = min_cost(src_rem[i], dst_rem, pm, i);
346 greg 2.1 /* find best source & dest. */
347     best.s = best.d = -1; best.price = FHUGE; best.amt = 0;
348 greg 2.11 if ((r2check = pm->nrows) > max2check)
349     r2check = max2check; /* put a limit on search */
350     for (ri = 0; ri < r2check; ri++) { /* check each source row */
351 greg 2.1 double cost_others = 0;
352 greg 2.17 cur.s = rord[ri].s;
353     if ((cur.d = rord[ri].d) < 0 ||
354     rord[ri].dc*pricerow(pm,cur.s)[cur.d] >= best.price) {
355 greg 2.11 if (pm->nrows > max2check) break; /* sorted end */
356     continue; /* else skip this one */
357     }
358 greg 2.1 cur.amt = (src_rem[cur.s] < dst_rem[cur.d]) ?
359     src_rem[cur.s] : dst_rem[cur.d];
360 greg 2.11 /* don't just leave smidgen */
361     if (cur.amt > maxamt*1.02) cur.amt = maxamt;
362     dst_rem[cur.d] -= cur.amt; /* add up opportunity costs */
363 greg 2.3 for (i = pm->nrows; i--; )
364 greg 2.1 if (i != cur.s)
365 greg 2.11 cost_others += min_cost(src_rem[i], dst_rem, pm, i)
366 greg 2.1 - src_cost[i];
367     dst_rem[cur.d] += cur.amt; /* undo trial move */
368 greg 2.17 /* discount effective price */
369     cur.price = ( pricerow(pm,cur.s)[cur.d] + cost_others/cur.amt ) *
370     rord[ri].dc;
371 greg 2.1 if (cur.price < best.price) /* are we better than best? */
372 greg 2.11 best = cur;
373 greg 2.1 }
374 greg 2.11 free(src_cost); /* clean up */
375     free(rord);
376 greg 2.5 if ((best.s < 0) | (best.d < 0)) /* nothing left to move? */
377 greg 2.1 return(.0);
378 greg 2.5 /* else make the actual move */
379 greg 2.2 mtx_coef(mig,best.s,best.d) += best.amt;
380 greg 2.1 src_rem[best.s] -= best.amt;
381     dst_rem[best.d] -= best.amt;
382     return(best.amt);
383 greg 2.11 memerr:
384     fprintf(stderr, "%s: Out of memory in migration_step()\n", progname);
385     exit(1);
386 greg 2.17 #undef discount
387 greg 2.1 }
388    
389     /* Compute and insert migration along directed edge (may fork child) */
390     static MIGRATION *
391     create_migration(RBFNODE *from_rbf, RBFNODE *to_rbf)
392     {
393 greg 2.2 const double end_thresh = 5e-6;
394 greg 2.3 PRICEMAT pmtx;
395 greg 2.1 MIGRATION *newmig;
396     double *src_rem, *dst_rem;
397     double total_rem = 1., move_amt;
398 greg 2.6 int i, j;
399 greg 2.1 /* check if exists already */
400     for (newmig = from_rbf->ejl; newmig != NULL;
401     newmig = nextedge(from_rbf,newmig))
402     if (newmig->rbfv[1] == to_rbf)
403     return(NULL);
404     /* else allocate */
405 greg 2.7 #ifdef DEBUG
406 greg 2.14 fprintf(stderr, "Building path from (theta,phi) (%.1f,%.1f) ",
407 greg 2.7 get_theta180(from_rbf->invec),
408     get_phi360(from_rbf->invec));
409 greg 2.14 fprintf(stderr, "to (%.1f,%.1f) with %d x %d matrix\n",
410 greg 2.7 get_theta180(to_rbf->invec),
411     get_phi360(to_rbf->invec),
412     from_rbf->nrbf, to_rbf->nrbf);
413     #endif
414 greg 2.1 newmig = new_migration(from_rbf, to_rbf);
415     if (run_subprocess())
416     return(newmig); /* child continues */
417 greg 2.3 price_routes(&pmtx, from_rbf, to_rbf);
418 greg 2.1 src_rem = (double *)malloc(sizeof(double)*from_rbf->nrbf);
419     dst_rem = (double *)malloc(sizeof(double)*to_rbf->nrbf);
420     if ((src_rem == NULL) | (dst_rem == NULL)) {
421     fprintf(stderr, "%s: Out of memory in create_migration()\n",
422     progname);
423     exit(1);
424     }
425     /* starting quantities */
426     memset(newmig->mtx, 0, sizeof(float)*from_rbf->nrbf*to_rbf->nrbf);
427     for (i = from_rbf->nrbf; i--; )
428     src_rem[i] = rbf_volume(&from_rbf->rbfa[i]) / from_rbf->vtotal;
429 greg 2.6 for (j = to_rbf->nrbf; j--; )
430     dst_rem[j] = rbf_volume(&to_rbf->rbfa[j]) / to_rbf->vtotal;
431    
432 greg 2.1 do { /* move a bit at a time */
433 greg 2.3 move_amt = migration_step(newmig, src_rem, dst_rem, &pmtx);
434 greg 2.1 total_rem -= move_amt;
435 greg 2.2 } while ((total_rem > end_thresh) & (move_amt > 0));
436 greg 2.6
437 greg 2.1 for (i = from_rbf->nrbf; i--; ) { /* normalize final matrix */
438 greg 2.6 double nf = rbf_volume(&from_rbf->rbfa[i]);
439 greg 2.1 if (nf <= FTINY) continue;
440     nf = from_rbf->vtotal / nf;
441     for (j = to_rbf->nrbf; j--; )
442 greg 2.6 mtx_coef(newmig,i,j) *= nf; /* row now sums to 1.0 */
443 greg 2.1 }
444     end_subprocess(); /* exit here if subprocess */
445 greg 2.3 free_routes(&pmtx); /* free working arrays */
446 greg 2.1 free(src_rem);
447     free(dst_rem);
448     return(newmig);
449     }
450    
451     /* Check if prospective vertex would create overlapping triangle */
452     static int
453     overlaps_tri(const RBFNODE *bv0, const RBFNODE *bv1, const RBFNODE *pv)
454     {
455     const MIGRATION *ej;
456     RBFNODE *vother[2];
457     int im_rev;
458     /* find shared edge in mesh */
459     for (ej = pv->ejl; ej != NULL; ej = nextedge(pv,ej)) {
460     const RBFNODE *tv = opp_rbf(pv,ej);
461     if (tv == bv0) {
462     im_rev = is_rev_tri(ej->rbfv[0]->invec,
463     ej->rbfv[1]->invec, bv1->invec);
464     break;
465     }
466     if (tv == bv1) {
467     im_rev = is_rev_tri(ej->rbfv[0]->invec,
468     ej->rbfv[1]->invec, bv0->invec);
469     break;
470     }
471     }
472     if (!get_triangles(vother, ej)) /* triangle on same side? */
473     return(0);
474     return(vother[im_rev] != NULL);
475     }
476    
477 greg 2.14 /* Find convex hull vertex to complete triangle (oriented call) */
478 greg 2.1 static RBFNODE *
479     find_chull_vert(const RBFNODE *rbf0, const RBFNODE *rbf1)
480     {
481     FVECT vmid, vejn, vp;
482     RBFNODE *rbf, *rbfbest = NULL;
483     double dprod, area2, bestarea2 = FHUGE, bestdprod = -.5;
484    
485     VSUB(vejn, rbf1->invec, rbf0->invec);
486     VADD(vmid, rbf0->invec, rbf1->invec);
487     if (normalize(vejn) == 0 || normalize(vmid) == 0)
488     return(NULL);
489     /* XXX exhaustive search */
490     /* Find triangle with minimum rotation from perpendicular */
491     for (rbf = dsf_list; rbf != NULL; rbf = rbf->next) {
492     if ((rbf == rbf0) | (rbf == rbf1))
493     continue;
494     tri_orient(vp, rbf0->invec, rbf1->invec, rbf->invec);
495     if (DOT(vp, vmid) <= FTINY)
496     continue; /* wrong orientation */
497     area2 = .25*DOT(vp,vp);
498 greg 2.14 VSUB(vp, rbf->invec, vmid);
499 greg 2.1 dprod = -DOT(vp, vejn);
500     VSUM(vp, vp, vejn, dprod); /* above guarantees non-zero */
501     dprod = DOT(vp, vmid) / VLEN(vp);
502     if (dprod <= bestdprod + FTINY*(1 - 2*(area2 < bestarea2)))
503     continue; /* found better already */
504     if (overlaps_tri(rbf0, rbf1, rbf))
505     continue; /* overlaps another triangle */
506     rbfbest = rbf;
507     bestdprod = dprod; /* new one to beat */
508     bestarea2 = area2;
509     }
510     return(rbfbest);
511     }
512    
513     /* Create new migration edge and grow mesh recursively around it */
514     static void
515     mesh_from_edge(MIGRATION *edge)
516     {
517     MIGRATION *ej0, *ej1;
518     RBFNODE *tvert[2];
519    
520     if (edge == NULL)
521     return;
522     /* triangle on either side? */
523     get_triangles(tvert, edge);
524     if (tvert[0] == NULL) { /* grow mesh on right */
525     tvert[0] = find_chull_vert(edge->rbfv[0], edge->rbfv[1]);
526     if (tvert[0] != NULL) {
527     if (tvert[0]->ord > edge->rbfv[0]->ord)
528     ej0 = create_migration(edge->rbfv[0], tvert[0]);
529     else
530     ej0 = create_migration(tvert[0], edge->rbfv[0]);
531     if (tvert[0]->ord > edge->rbfv[1]->ord)
532     ej1 = create_migration(edge->rbfv[1], tvert[0]);
533     else
534     ej1 = create_migration(tvert[0], edge->rbfv[1]);
535     mesh_from_edge(ej0);
536     mesh_from_edge(ej1);
537     }
538     } else if (tvert[1] == NULL) { /* grow mesh on left */
539     tvert[1] = find_chull_vert(edge->rbfv[1], edge->rbfv[0]);
540     if (tvert[1] != NULL) {
541     if (tvert[1]->ord > edge->rbfv[0]->ord)
542     ej0 = create_migration(edge->rbfv[0], tvert[1]);
543     else
544     ej0 = create_migration(tvert[1], edge->rbfv[0]);
545     if (tvert[1]->ord > edge->rbfv[1]->ord)
546     ej1 = create_migration(edge->rbfv[1], tvert[1]);
547     else
548     ej1 = create_migration(tvert[1], edge->rbfv[1]);
549     mesh_from_edge(ej0);
550     mesh_from_edge(ej1);
551     }
552     }
553     }
554 greg 2.15
555     /* Add normal direction if missing */
556     static void
557     check_normal_incidence(void)
558     {
559 greg 2.16 static const FVECT norm_vec = {.0, .0, 1.};
560     const int saved_nprocs = nprocs;
561     RBFNODE *near_rbf, *mir_rbf, *rbf;
562     double bestd;
563     int n;
564 greg 2.15
565     if (dsf_list == NULL)
566     return; /* XXX should be error? */
567     near_rbf = dsf_list;
568     bestd = input_orient*near_rbf->invec[2];
569     if (single_plane_incident) { /* ordered plane incidence? */
570     if (bestd >= 1.-2.*FTINY)
571     return; /* already have normal */
572     } else {
573     switch (inp_coverage) {
574     case INP_QUAD1:
575     case INP_QUAD2:
576     case INP_QUAD3:
577     case INP_QUAD4:
578     break; /* quadrilateral symmetry? */
579     default:
580     return; /* else we can interpolate */
581     }
582     for (rbf = near_rbf->next; rbf != NULL; rbf = rbf->next) {
583     const double d = input_orient*rbf->invec[2];
584     if (d >= 1.-2.*FTINY)
585     return; /* seems we have normal */
586     if (d > bestd) {
587     near_rbf = rbf;
588     bestd = d;
589     }
590     }
591     }
592     if (mig_list != NULL) { /* need to be called first */
593     fprintf(stderr, "%s: Late call to check_normal_incidence()\n",
594     progname);
595     exit(1);
596     }
597     #ifdef DEBUG
598     fprintf(stderr, "Interpolating normal incidence by mirroring (%.1f,%.1f)\n",
599     get_theta180(near_rbf->invec), get_phi360(near_rbf->invec));
600     #endif
601     /* mirror nearest incidence */
602     n = sizeof(RBFNODE) + sizeof(RBFVAL)*(near_rbf->nrbf-1);
603     mir_rbf = (RBFNODE *)malloc(n);
604     if (mir_rbf == NULL)
605     goto memerr;
606     memcpy(mir_rbf, near_rbf, n);
607     mir_rbf->ord = near_rbf->ord - 1; /* not used, I think */
608     mir_rbf->next = NULL;
609     rev_rbf_symmetry(mir_rbf, MIRROR_X|MIRROR_Y);
610     nprocs = 1; /* compute migration matrix */
611     if (mig_list != create_migration(mir_rbf, near_rbf))
612     exit(1); /* XXX should never happen! */
613 greg 2.16 /* interpolate normal dist. */
614     rbf = e_advect_rbf(mig_list, norm_vec, 2*near_rbf->nrbf);
615 greg 2.15 nprocs = saved_nprocs; /* final clean-up */
616     free(mir_rbf);
617     free(mig_list);
618     mig_list = near_rbf->ejl = NULL;
619     insert_dsf(rbf); /* insert interpolated normal */
620     return;
621     memerr:
622     fprintf(stderr, "%s: Out of memory in check_normal_incidence()\n",
623     progname);
624     exit(1);
625     }
626 greg 2.1
627     /* Build our triangle mesh from recorded RBFs */
628     void
629     build_mesh(void)
630     {
631     double best2 = M_PI*M_PI;
632     RBFNODE *shrt_edj[2];
633     RBFNODE *rbf0, *rbf1;
634 greg 2.15 /* add normal if needed */
635     check_normal_incidence();
636 greg 2.1 /* check if isotropic */
637     if (single_plane_incident) {
638     for (rbf0 = dsf_list; rbf0 != NULL; rbf0 = rbf0->next)
639     if (rbf0->next != NULL)
640     create_migration(rbf0, rbf0->next);
641     await_children(nchild);
642     return;
643     }
644     shrt_edj[0] = shrt_edj[1] = NULL; /* start w/ shortest edge */
645     for (rbf0 = dsf_list; rbf0 != NULL; rbf0 = rbf0->next)
646     for (rbf1 = rbf0->next; rbf1 != NULL; rbf1 = rbf1->next) {
647     double dist2 = 2. - 2.*DOT(rbf0->invec,rbf1->invec);
648     if (dist2 < best2) {
649     shrt_edj[0] = rbf0;
650     shrt_edj[1] = rbf1;
651     best2 = dist2;
652     }
653     }
654     if (shrt_edj[0] == NULL) {
655     fprintf(stderr, "%s: Cannot find shortest edge\n", progname);
656     exit(1);
657     }
658     /* build mesh from this edge */
659     if (shrt_edj[0]->ord < shrt_edj[1]->ord)
660     mesh_from_edge(create_migration(shrt_edj[0], shrt_edj[1]));
661     else
662     mesh_from_edge(create_migration(shrt_edj[1], shrt_edj[0]));
663     /* complete migrations */
664     await_children(nchild);
665     }