ViewVC Help
View File | Revision Log | Show Annotations | Download File | Root Listing
root/radiance/ray/src/hd/rhdisp2.c
(Generate patch)

Comparing ray/src/hd/rhdisp2.c (file contents):
Revision 3.17 by gregl, Thu Jan 1 13:00:16 1998 UTC vs.
Revision 3.36 by schorsch, Sun Jul 27 22:12:02 2003 UTC

# Line 1 | Line 1
1 /* Copyright (c) 1998 Silicon Graphics, Inc. */
2
1   #ifndef lint
2 < static char SCCSid[] = "$SunId$ SGI";
2 > static const char       RCSid[] = "$Id$";
3   #endif
6
4   /*
5   * Holodeck beam tracking for display process
6   */
# Line 12 | Line 9 | static char SCCSid[] = "$SunId$ SGI";
9   #include "rhdisp.h"
10   #include "rhdriver.h"
11  
12 < #ifndef MAXDIST
13 < #define MAXDIST         42      /* maximum distance outside section */
12 > #ifndef MEYERNG
13 > #define MEYERNG         0.2     /* target mean eye range (rel. to grid) */
14   #endif
15  
19 extern GCOORD   *getviewcells();
20
21 static VIEW     dvw;            /* current view corresponding to beam list */
22
23 typedef struct {
24        int     hd;             /* holodeck section number (-1 if inactive) */
25        int     i[3];           /* voxel index (may be outside section) */
26 } VOXL;                 /* a voxel */
27
28 static VOXL voxel[8] = {        /* current voxel list */
29        {-1}, {-1}, {-1}, {-1},
30        {-1}, {-1}, {-1}, {-1}
31 };
32
16   #define CBEAMBLK        1024    /* cbeam allocation block size */
17  
18 < static struct beamcomp {
36 <        short   wants;          /* flags telling which voxels want us */
37 <        short   hd;             /* holodeck section number */
38 <        int     bi;             /* beam index */
39 < } *cbeam = NULL;        /* current beam list */
40 <
18 > static PACKHEAD *cbeam = NULL;  /* current beam list */
19   static int      ncbeams = 0;    /* number of sorted beams in cbeam */
20   static int      xcbeams = 0;    /* extra (unregistered) beams past ncbeams */
21   static int      maxcbeam = 0;   /* size of cbeam array */
22  
23 < struct cellact {
46 <        short   vi;             /* voxel index */
47 <        short   add;            /* zero means delete */
48 <        short   rev;            /* reverse ray direction? */
49 < };              /* action for cell */
23 > VIEWPOINT       cureye;         /* current eye position */
24  
51 struct beamact {
52        struct cellact  ca;     /* cell action */
53        GCOORD  gc;             /* grid coordinate */
54 };              /* beam origin and action */
25  
56
26   int
27   newcbeam()              /* allocate new entry at end of cbeam array */
28   {
# Line 62 | Line 31 | newcbeam()             /* allocate new entry at end of cbeam arra
31          if ((i = ncbeams + xcbeams++) >= maxcbeam) {    /* grow array */
32                  maxcbeam += CBEAMBLK;
33                  if (cbeam == NULL)
34 <                        cbeam = (struct beamcomp *)malloc(
35 <                                        maxcbeam*sizeof(struct beamcomp) );
34 >                        cbeam = (PACKHEAD *)malloc(
35 >                                        maxcbeam*sizeof(PACKHEAD) );
36                  else
37 <                        cbeam = (struct beamcomp *)realloc( (char *)cbeam,
38 <                                        maxcbeam*sizeof(struct beamcomp) );
37 >                        cbeam = (PACKHEAD *)realloc((void *)cbeam,
38 >                                        maxcbeam*sizeof(PACKHEAD) );
39                  if (cbeam == NULL)
40                          error(SYSTEM, "out of memory in newcbeam");
41          }
# Line 76 | Line 45 | newcbeam()             /* allocate new entry at end of cbeam arra
45  
46   int
47   cbeamcmp(cb1, cb2)      /* compare two cbeam entries for sort: keep orphans */
48 < register struct beamcomp        *cb1, *cb2;
48 > register PACKHEAD       *cb1, *cb2;
49   {
50          register int    c;
51  
# Line 88 | Line 57 | register struct beamcomp       *cb1, *cb2;
57  
58   int
59   cbeamcmp2(cb1, cb2)     /* compare two cbeam entries for sort: no orphans */
60 < register struct beamcomp        *cb1, *cb2;
60 > register PACKHEAD       *cb1, *cb2;
61   {
62          register int    c;
63  
64 <        if (!cb1->wants)                /* put orphans at the end, unsorted */
65 <                return(cb2->wants);
66 <        if (!cb2->wants)
64 >        if (!cb1->nr)                   /* put orphans at the end, unsorted */
65 >                return(cb2->nr);
66 >        if (!cb2->nr)
67                  return(-1);
68          if ((c = cb1->bi - cb2->bi))    /* sort on beam index first */
69                  return(c);
# Line 106 | Line 75 | int
75   findcbeam(hd, bi)       /* find the specified beam in our sorted list */
76   int     hd, bi;
77   {
78 <        struct beamcomp cb;
79 <        register struct beamcomp        *p;
78 >        PACKHEAD        cb;
79 >        register PACKHEAD       *p;
80  
81          if (ncbeams <= 0)
82                  return(-1);
83 <        cb.wants = 0; cb.hd = hd; cb.bi = bi;
84 <        p = (struct beamcomp *)bsearch((char *)&cb, (char *)cbeam, ncbeams,
85 <                        sizeof(struct beamcomp), cbeamcmp);
83 >        cb.hd = hd; cb.bi = bi; cb.nr = cb.nc = 0;
84 >        p = (PACKHEAD *)bsearch((char *)&cb, (char *)cbeam, ncbeams,
85 >                        sizeof(PACKHEAD), cbeamcmp);
86          if (p == NULL)
87                  return(-1);
88          return(p - cbeam);
# Line 134 | Line 103 | int    bi;
103                  if (cbeam[n].bi == bi && cbeam[n].hd == hd)
104                          return(n);
105                                  /* check legality */
106 <        if (hd < 0 | hd >= HDMAX || hdlist[hd] == NULL)
106 >        if ((hd < 0) | (hd >= HDMAX) || hdlist[hd] == NULL)
107                  error(INTERNAL, "illegal holodeck number in getcbeam");
108 <        if (bi < 1 | bi > nbeams(hdlist[hd]))
108 >        if ((bi < 1) | (bi > nbeams(hdlist[hd])))
109                  error(INTERNAL, "illegal beam index in getcbeam");
110          n = newcbeam();         /* allocate and assign */
111 <        cbeam[n].wants = 0; cbeam[n].hd = hd; cbeam[n].bi = bi;
111 >        cbeam[n].hd = hd; cbeam[n].bi = bi; cbeam[n].nr = cbeam[n].nc = 0;
112          return(n);
113   }
114  
# Line 152 | Line 121 | int    adopt;
121          if (!(ncbeams += xcbeams))
122                  return;
123          xcbeams = 0;
124 <        qsort((char *)cbeam, ncbeams, sizeof(struct beamcomp),
124 >        qsort((char *)cbeam, ncbeams, sizeof(PACKHEAD),
125                          adopt ? cbeamcmp : cbeamcmp2);
126          if (adopt)
127                  return;
128          for (i = ncbeams; i--; )        /* identify orphans */
129 <                if (cbeam[i].wants)
129 >                if (cbeam[i].nr)
130                          break;
131          xcbeams = ncbeams - ++i;        /* put orphans after ncbeams */
132          ncbeams = i;
133   }
134  
135  
136 < cbeamop(op, bl, n, v, hr, vr)   /* update beams on server list */
137 < int     op;
169 < register struct beamcomp        *bl;
170 < int     n;
171 < VIEW    *v;
172 < int     hr, vr;
136 > beam_init(fresh)                /* clear beam list for new view(s) */
137 > int     fresh;
138   {
174        register PACKHEAD       *pa;
139          register int    i;
140  
141 <        if (n <= 0)
142 <                return;
143 <        pa = (PACKHEAD *)malloc(n*sizeof(PACKHEAD));
144 <        if (pa == NULL)
145 <                error(SYSTEM, "out of memory in cbeamadd");
146 <        for (i = 0; i < n; i++) {
183 <                pa[i].hd = bl[i].hd;
184 <                pa[i].bi = bl[i].bi;
185 <                pa[i].nr = v==NULL ? 0 :
186 <                                npixels(v, hr, vr, hdlist[bl[i].hd], bl[i].bi);
187 <                pa[i].nc = 0;
188 <        }
189 <        serv_request(op, n*sizeof(PACKHEAD), (char *)pa);
190 <        free((char *)pa);
141 >        if (fresh)                      /* discard old beams? */
142 >                ncbeams = xcbeams = 0;
143 >        else                            /* else clear sample requests */
144 >                for (i = ncbeams+xcbeams; i--; )
145 >                        cbeam[i].nr = 0;
146 >        cureye.rng = 0.;
147   }
148  
149  
150 < int
151 < set_voxels(vl, n)       /* set new voxel array */
152 < VOXL    vl[8];
153 < int     n;
150 > int16 *
151 > beam_view(vn, hr, vr)           /* add beam view (if advisable) */
152 > VIEW    *vn;
153 > int     hr, vr;
154   {
155 <        short   wmap[256];
156 <        int     vmap[8];
157 <        int     comn = 0;
158 <        int     no;
159 <        register int    i, j;
160 <                                        /* find common voxels */
161 <        for (j = 0; j < 8 && voxel[j].hd >= 0; j++) {
162 <                vmap[j] = -1;
163 <                for (i = n; i--; )
164 <                        if (!bcmp((char *)(vl+i), (char *)(voxel+j),
209 <                                        sizeof(VOXL))) {
210 <                                vmap[j] = i;
211 <                                comn |= 1<<i;
212 <                                break;
213 <                        }
155 >        int16   *slist;
156 >        BEAMLIST        blist;
157 >        double  eravg, d;
158 >        register HOLO   *hp;
159 >        register int    i, n;
160 >                                        /* compute beams for view */
161 >        slist = viewbeams(vn, hr, vr, &blist);
162 >        if (*slist < 0) {
163 >                error(COMMAND, "no sections visible from this view");
164 >                return(NULL);
165          }
166 <        no = comn ? j : 0;              /* compute flag mapping */
167 <        for (i = 256; i--; ) {
168 <                wmap[i] = 0;
169 <                for (j = no; j--; )
170 <                        if (vmap[j] >= 0 && i & 1<<j)
171 <                                wmap[i] |= 1<<vmap[j];
166 >                                        /* sort current beam list */
167 >        cbeamsort(1);
168 >                                        /* add new beams to list */
169 >        for (i = blist.nb; i--; ) {
170 >                n = getcbeam(blist.bl[i].hd, blist.bl[i].bi);
171 >                if (blist.bl[i].nr > cbeam[n].nr)
172 >                        cbeam[n].nr = blist.bl[i].nr;
173          }
174 <                                        /* fix cbeam flags */
175 <        for (i = ncbeams; i--; )
176 <                cbeam[i].wants = wmap[cbeam[i].wants];
177 <                                        /* update our voxel list */
178 <        bcopy((char *)vl, (char *)voxel, n*sizeof(VOXL));
179 <        for (j = n; j < 8; j++)
180 <                voxel[j].hd = -1;
181 <        return(comn);                   /* return bit array of common voxels */
182 < }
183 <
232 <
233 < int
234 < get_voxels(vl, vp)      /* find voxels corresponding to view point */
235 < VOXL    vl[8];
236 < FVECT   vp;
237 < {
238 <        int     n = 0;
239 <        FVECT   gp;
240 <        double  d;
241 <        int     dist, bestd = 0x7fff;
242 <        VOXL    vox;
243 <        register int    i, j, k;
244 <                                        /* find closest voxels */
245 <        for (i = 0; n < 8 && hdlist[i]; i++) {
246 <                hdgrid(gp, hdlist[i], vp);
247 <                for (j = 0; n < 8 && j < 8; j++) {
248 <                        dist = 0;
249 <                        for (k = 0; k < 3; k++) {
250 <                                d = gp[k] - .5 + (j>>k & 1);
251 <                                if (d < 0.)
252 <                                        dist += -(vox.i[k] = (int)d - 1);
253 <                                else if ((vox.i[k] = d) >= hdlist[i]->grid[k])
254 <                                        dist += vox.i[k] -
255 <                                                        hdlist[i]->grid[k] + 1;
256 <                        }
257 <                        if (dist > bestd)       /* others were closer */
258 <                                continue;
259 <                        if (dist < bestd) {     /* start closer list */
260 <                                n = 0;
261 <                                bestd = dist;
262 <                        }
263 <                        vox.hd = i;             /* add this voxel */
264 <                        copystruct(&vl[n], &vox);
265 <                        n++;
266 <                }
174 >        free((void *)blist.bl);         /* free list */
175 >        if (MEYERNG <= FTINY)
176 >                return(slist);
177 >                                        /* compute average eye range */
178 >        eravg = 0.;
179 >        for (n = 0; slist[n] >= 0; n++) {
180 >                hp = hdlist[slist[n]];
181 >                eravg +=        MEYERNG/3. / VLEN(hp->wg[0]) +
182 >                                MEYERNG/3. / VLEN(hp->wg[1]) +
183 >                                MEYERNG/3. / VLEN(hp->wg[2]) ;
184          }
185 <                                        /* check for really stupid move */
186 <        if (bestd > MAXDIST) {
187 <                error(COMMAND, "move past outer limits");
188 <                return(0);
185 >        eravg /= (double)n;
186 >                                        /* add to current eye position */
187 >        if (cureye.rng <= FTINY) {
188 >                VCOPY(cureye.vpt, vn->vp);
189 >                cureye.rng = eravg;
190 >        } else if ((d = sqrt(dist2(vn->vp,cureye.vpt))) + eravg > cureye.rng) {
191 >                for (i = 3; i--; )
192 >                        cureye.vpt[i] = 0.5*(cureye.vpt[i] + vn->vp[i]);
193 >                cureye.rng = 0.5*(cureye.rng + eravg + d);
194          }
195 <        return(n);
195 >        return(slist);
196   }
197  
198  
199   int
200 < dobeam(gcp, bp)         /* express interest or disintrest in a beam */
201 < GCOORD  *gcp;
280 < register struct beamact *bp;
200 > beam_sync(all)                  /* update beam list on server */
201 > int     all;
202   {
203 <        GCOORD  gc[2];
204 <        int     bi, i;
205 <                                        /* compute beam index */
206 <        if (bp->ca.rev) {
207 <                copystruct(gc, &bp->gc);
208 <                copystruct(gc+1, gcp);
203 >                                        /* set new eye position */
204 >        serv_request(DR_VIEWPOINT, sizeof(VIEWPOINT), (char *)&cureye);
205 >                                        /* sort list (put orphans at end) */
206 >        cbeamsort(all < 0);
207 >                                        /* send beam request */
208 >        if (all) {
209 >                if (ncbeams > 0)
210 >                        serv_request(DR_NEWSET,
211 >                                        ncbeams*sizeof(PACKHEAD), cbeam);
212          } else {
213 <                copystruct(gc, gcp);
214 <                copystruct(gc+1, &bp->gc);
213 >                if (ncbeams+xcbeams > 0)
214 >                        serv_request(DR_ADJSET,
215 >                                (ncbeams+xcbeams)*sizeof(PACKHEAD), cbeam);
216          }
217 <        if ((bi = hdbindex(hdlist[voxel[bp->ca.vi].hd], gc)) <= 0)
293 <                error(CONSISTENCY, "bad grid coordinate in dobeam");
294 <        if (bp->ca.add) {               /* add it in */
295 <                i = getcbeam(voxel[bp->ca.vi].hd, bi);
296 <                cbeam[i].wants |= 1<<bp->ca.vi; /* say we want it */
297 <                return(i == ncbeams+xcbeams-1); /* return 1 if totally new */
298 <        }
299 <                                        /* else delete it */
300 <        i = findcbeam(voxel[bp->ca.vi].hd, bi);
301 <        if (i >= 0 && cbeam[i].wants & 1<<bp->ca.vi) {
302 <                cbeam[i].wants &= ~(1<<bp->ca.vi);      /* we don't want it */
303 <                return(1);                      /* indicate change */
304 <        }
305 <        return(0);
306 < }
307 <
308 <
309 <
310 < int
311 < docell(gcp, cap)        /* find beams corresponding to cell and voxel */
312 < GCOORD  *gcp;
313 < register struct cellact *cap;
314 < {
315 <        register HOLO   *hp = hdlist[voxel[cap->vi].hd];
316 <        FVECT   org, dir[4];
317 <        FVECT   vgp, cgp, vc;
318 <        FVECT   v1, v2;
319 <        struct beamact  bo;
320 <        int     axmax, j;
321 <        double  d, avmax;
322 <        register int    i;
323 <                                /* compute cell center */
324 <        cgp[gcp->w>>1] = gcp->w&1 ? hp->grid[gcp->w>>1] : 0 ;
325 <        cgp[((gcp->w>>1)+1)%3] = gcp->i[0] + .5;
326 <        cgp[((gcp->w>>1)+2)%3] = gcp->i[1] + .5;
327 <        hdworld(org, hp, cgp);
328 <                                /* compute direction to voxel center */
329 <        for (i = 3; i--; )
330 <                vgp[i] = voxel[cap->vi].i[i] + .5;
331 <        hdworld(vc, hp, vgp);
332 <        for (i = 3; i--; )
333 <                vc[i] -= org[i];
334 <                                /* compute maximum area axis */
335 <        axmax = -1; avmax = 0;
336 <        for (i = 3; i--; ) {
337 <                d = vgp[i] - cgp[i];
338 <                if (d < 0.) d = -d;
339 <                if (d > avmax) {
340 <                        avmax = d;
341 <                        axmax = i;
342 <                }
343 <        }
344 < #ifdef DEBUG
345 <        if (axmax < 0.)
346 <                error(CONSISTENCY, "botched axis computation in docell");
347 < #endif
348 <                                /* compute offset vectors */
349 <        d = 0.5/hp->grid[j=(axmax+1)%3];
350 <        for (i = 3; i--; )
351 <                v1[i] = hp->xv[j][i] * d;
352 <        d = 0.5/hp->grid[j=(axmax+2)%3];
353 <        if (DOT(hp->wn[axmax], vc) < 0.)
354 <                d = -d; /* reverse vertex ordering */
355 <        for (i = 3; i--; )
356 <                v2[i] = hp->xv[j][i] * d;
357 <                                /* compute voxel pyramid */
358 <        for (i = 3; i--; ) {
359 <                dir[0][i] = vc[i] - v1[i] - v2[i];
360 <                dir[1][i] = vc[i] + v1[i] - v2[i];
361 <                dir[2][i] = vc[i] + v1[i] + v2[i];
362 <                dir[3][i] = vc[i] - v1[i] + v2[i];
363 <        }
364 <                                /* visit beams for opposite cells */
365 <        copystruct(&bo.ca, cap);
366 <        copystruct(&bo.gc, gcp);
367 <        return(visit_cells(org, dir, hp, dobeam, &bo));
368 < }
369 <
370 <
371 < int
372 < doview(cap, vp)                 /* visit cells for a given view */
373 < struct cellact  *cap;
374 < VIEW    *vp;
375 < {
376 <        int     orient;
377 <        FVECT   org, dir[4];
378 <                                        /* compute view pyramid */
379 <        orient = viewpyramid(org, dir, hdlist[voxel[cap->vi].hd], vp);
380 <        if (!orient)
381 <                error(INTERNAL, "unusable view in doview");
382 <        cap->rev = orient < 0;
383 <                                        /* visit cells within pyramid */
384 <        return(visit_cells(org, dir, hdlist[voxel[cap->vi].hd], docell, cap));
385 < }
386 <
387 <
388 < mvview(voxi, vold, vnew)        /* move view for a voxel */
389 < int     voxi;
390 < VIEW    *vold, *vnew;
391 < {
392 <        int     netchange = 0;
393 <        struct cellact  oca, nca;
394 <        int     ocnt, ncnt;
395 <        int     c;
396 <        GCOORD  *ogcl, *ngcl;
397 <        register GCOORD *ogcp, *ngcp;
398 <                                /* get old and new cell lists */
399 <        ogcp = ogcl = getviewcells(&ocnt, hdlist[voxel[voxi].hd], vold);
400 <        ngcp = ngcl = getviewcells(&ncnt, hdlist[voxel[voxi].hd], vnew);
401 <                                /* set up actions */
402 <        oca.vi = nca.vi = voxi;
403 <        oca.add = 0; nca.add = 1;
404 <        if ((oca.rev = ocnt < 0))
405 <                ocnt = -ocnt;
406 <        if ((nca.rev = ncnt < 0))
407 <                ncnt = -ncnt;
408 <        if (nca.rev == oca.rev)         /* add and delete cells in order */
409 <                while (ocnt > 0 & ncnt > 0)
410 <                        if ((c = cellcmp(ogcp, ngcp)) > 0) {    /* new cell */
411 <                                netchange += docell(ngcp++, &nca);
412 <                                ncnt--;
413 <                        } else if (c < 0) {                     /* old cell */
414 <                                netchange -= docell(ogcp++, &oca);
415 <                                ocnt--;
416 <                        } else {                                /* same cell */
417 <                                ogcp++; ocnt--;
418 <                                ngcp++; ncnt--;
419 <                        }
420 <                                /* take care of list tails */
421 <        for ( ; ncnt > 0; ncnt--)
422 <                netchange += docell(ngcp++, &nca);
423 <        for ( ; ocnt > 0; ocnt--)
424 <                netchange -= docell(ogcp++, &oca);
425 <                                /* clean up */
426 <        if (ogcl != NULL) free((char *)ogcl);
427 <        if (ngcl != NULL) free((char *)ngcl);
428 <        return(netchange);
429 < }
430 <
431 <
432 < int
433 < beam_sync()             /* synchronize beams on server */
434 < {
435 <        cbeamop(DR_NEWSET, cbeam, ncbeams, &odev.v, odev.hres, odev.vres);
217 >        xcbeams = 0;                    /* truncate our list */
218          return(ncbeams);
219   }
220  
221  
222 < beam_view(vn)                   /* change beam view (if advisable) */
223 < VIEW    *vn;
222 > gridlines(f)                    /* run through holodeck section grid lines */
223 > int     (*f)();
224   {
225 <        struct cellact  ca;
226 <        VOXL    vlnew[8];
227 <        int     n, comn;
228 <
229 <        if (vn == NULL || !vn->type) {  /* clear our beam list */
230 <                set_voxels(vlnew, 0);
231 <                cbeamop(DR_DELSET, cbeam, ncbeams, NULL, 0, 0);
232 <                ncbeams = 0;
233 <                dvw.type = 0;
234 <                return(1);
235 <        }
236 <                                        /* find our new voxels */
237 <        n = get_voxels(vlnew, vn->vp);
238 <        if (dvw.type && !n) {
239 <                copystruct(vn, &dvw);           /* cancel move */
240 <                return(0);
241 <        }
242 <                                        /* set the new voxels */
243 <        comn = set_voxels(vlnew, n);
244 <        if (!dvw.type)
245 <                comn = 0;
246 <        ca.add = 1;                     /* update our beam list */
247 <        for (ca.vi = n; ca.vi--; )
248 <                if (comn & 1<<ca.vi)    /* change which cells we see */
249 <                        mvview(ca.vi, &dvw, vn);
250 <                else                    /* else add all new cells */
251 <                        doview(&ca, vn);
252 <                                        /* inform server of new beams */
253 <        cbeamop(DR_ADDSET, cbeam+ncbeams, xcbeams, vn, odev.hres, odev.vres);
254 <                                        /* sort list to put orphans at end */
255 <        cbeamsort(0);
256 <                                        /* tell server to delete orphans */
257 <        cbeamop(DR_DELSET, cbeam+ncbeams, xcbeams, NULL, 0, 0);
258 <        xcbeams = 0;                    /* truncate our list */
259 <        copystruct(&dvw, vn);           /* record new view */
260 <        return(1);
225 >        register int    hd, w, i;
226 >        int     g0, g1;
227 >        FVECT   wp[2], mov;
228 >        double  d;
229 >                                        /* do each wall on each section */
230 >        for (hd = 0; hdlist[hd] != NULL; hd++)
231 >                for (w = 0; w < 6; w++) {
232 >                        g0 = hdwg0[w];
233 >                        g1 = hdwg1[w];
234 >                        d = 1.0/hdlist[hd]->grid[g0];
235 >                        mov[0] = d * hdlist[hd]->xv[g0][0];
236 >                        mov[1] = d * hdlist[hd]->xv[g0][1];
237 >                        mov[2] = d * hdlist[hd]->xv[g0][2];
238 >                        if (w & 1) {
239 >                                VSUM(wp[0], hdlist[hd]->orig,
240 >                                                hdlist[hd]->xv[w>>1], 1.);
241 >                                VSUM(wp[0], wp[0], mov, 1.);
242 >                        } else
243 >                                VCOPY(wp[0], hdlist[hd]->orig);
244 >                        VSUM(wp[1], wp[0], hdlist[hd]->xv[g1], 1.);
245 >                        for (i = hdlist[hd]->grid[g0]; ; ) {    /* g0 lines */
246 >                                (*f)(wp);
247 >                                if (!--i) break;
248 >                                wp[0][0] += mov[0]; wp[0][1] += mov[1];
249 >                                wp[0][2] += mov[2]; wp[1][0] += mov[0];
250 >                                wp[1][1] += mov[1]; wp[1][2] += mov[2];
251 >                        }
252 >                        d = 1.0/hdlist[hd]->grid[g1];
253 >                        mov[0] = d * hdlist[hd]->xv[g1][0];
254 >                        mov[1] = d * hdlist[hd]->xv[g1][1];
255 >                        mov[2] = d * hdlist[hd]->xv[g1][2];
256 >                        if (w & 1)
257 >                                VSUM(wp[0], hdlist[hd]->orig,
258 >                                                hdlist[hd]->xv[w>>1], 1.);
259 >                        else
260 >                                VSUM(wp[0], hdlist[hd]->orig, mov, 1.);
261 >                        VSUM(wp[1], wp[0], hdlist[hd]->xv[g0], 1.);
262 >                        for (i = hdlist[hd]->grid[g1]; ; ) {    /* g1 lines */
263 >                                (*f)(wp);
264 >                                if (!--i) break;
265 >                                wp[0][0] += mov[0]; wp[0][1] += mov[1];
266 >                                wp[0][2] += mov[2]; wp[1][0] += mov[0];
267 >                                wp[1][1] += mov[1]; wp[1][2] += mov[2];
268 >                        }
269 >                }
270   }

Diff Legend

Removed lines
+ Added lines
< Changed lines
> Changed lines