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

Comparing ray/src/gen/gensurf.c (file contents):
Revision 1.3 by greg, Wed Oct 18 15:01:23 1989 UTC vs.
Revision 2.27 by greg, Sun Jun 14 03:54:23 2020 UTC

# Line 1 | Line 1
1 – /* Copyright (c) 1989 Regents of the University of California */
2 –
1   #ifndef lint
2 < static char SCCSid[] = "$SunId$ LBL";
2 > static const char RCSid[] = "$Id$";
3   #endif
6 –
4   /*
5   *  gensurf.c - program to generate functional surfaces
6   *
# Line 14 | Line 11 | static char SCCSid[] = "$SunId$ LBL";
11   *  rule applied to (s,t).
12   *
13   *      4/3/87
14 + *
15 + *      4/16/02 Added conditional vertex output
16   */
17  
18 < #include  <stdio.h>
20 < #include  "fvect.h"
18 > #include  "standard.h"
19  
20 < #define  XNAME          "X_"                    /* x function name */
21 < #define  YNAME          "Y_"                    /* y function name */
22 < #define  ZNAME          "Z_"                    /* z function name */
20 > #include  "paths.h"
21 > #include  "resolu.h"
22 > #include  "rterror.h"
23 > #include  "calcomp.h"
24  
25 < #define  PI             3.14159265358979323846
25 > char  XNAME[] =         "X`SYS";                /* x function name */
26 > char  YNAME[] =         "Y`SYS";                /* y function name */
27 > char  ZNAME[] =         "Z`SYS";                /* z function name */
28  
29 < #define  FTINY          1e-7
29 > char  VNAME[] =         "valid";                /* valid vertex name */
30  
31 + #define  ABS(x)         ((x)>=0 ? (x) : -(x))
32 +
33 + #define  ZEROVECT(v)    (DOT(v,v) <= FTINY*FTINY)
34 +
35   #define  pvect(p)       printf(vformat, (p)[0], (p)[1], (p)[2])
36  
37 < char  vformat[] = "%15.9g %15.9g %15.9g\n";
38 < char  tsargs[] = "4 surf_dx surf_dy surf_dz surf.cal\n";
37 > char  vformat[] = "%18.12g %18.12g %18.12g\n";
38 > char  tsargs[] = "4 surf_dx surf_dy surf_dz surf.cal";
39   char  texname[] = "Phong";
40  
41   int  smooth = 0;                /* apply smoothing? */
42 + int  objout = 0;                /* output .OBJ format? */
43  
44   char  *modname, *surfname;
45  
46 < double  funvalue(), l_hermite(), argument(), fabs();
46 >                                /* recorded data flags */
47 > #define  HASBORDER      01
48 > #define  TRIPLETS       02
49 >                                /* a data structure */
50 > struct {
51 >        int     flags;                  /* data type */
52 >        short   m, n;                   /* number of s and t values */
53 >        RREAL   *data;                  /* the data itself, s major sort */
54 > } datarec;                      /* our recorded data */
55  
56 + /* XXX this is redundant with rt/noise3.c, should go to a library */
57 + double  l_hermite(), l_bezier(), l_bspline(), l_dataval();
58 +
59   typedef struct {
60 +        int  valid;     /* point is valid (vertex number) */
61 +        int  nvalid;    /* normal is valid */
62          FVECT  p;       /* vertex position */
63          FVECT  n;       /* average normal */
64 +        RREAL  uv[2];   /* (u,v) position */
65   } POINT;
66  
67 + int  nverts = 0;                /* vertex output count */
68 + int  nnorms = 0;                /* normal output count */
69  
70 + void loaddata(char *file, int m, int n, int pointsize);
71 + double l_dataval(char *nam);
72 + void putobjrow(POINT *rp, int n);
73 + void putobjvert(POINT *p);
74 + void putsquare(POINT *p0, POINT *p1, POINT *p2, POINT *p3);
75 + void comprow(double s, POINT *row, int siz);
76 + void compnorms(POINT *r0, POINT *r1, POINT *r2, int siz);
77 + int norminterp(FVECT resmat[4], POINT *p0, POINT *p1, POINT *p2, POINT *p3);
78 +
79 +
80 + int
81   main(argc, argv)
82   int  argc;
83   char  *argv[];
# Line 53 | Line 86 | char  *argv[];
86          int  i, j, m, n;
87          char  stmp[256];
88  
89 <        varset("PI", PI);
90 <        funset("hermite", 5, l_hermite);
89 >        esupport |= E_VARIABLE|E_FUNCTION|E_RCONST;
90 >        esupport &= ~(E_OUTCHAN|E_INCHAN);
91 >        varset("PI", ':', PI);
92 >        funset("hermite", 5, ':', l_hermite);
93 >        funset("bezier", 5, ':', l_bezier);
94 >        funset("bspline", 5, ':', l_bspline);
95  
96          if (argc < 8)
97                  goto userror;
98  
99          for (i = 8; i < argc; i++)
100                  if (!strcmp(argv[i], "-e"))
101 <                        scompile(NULL, argv[++i]);
102 <                else if (!strcmp(argv[i], "-f"))
103 <                        fcompile(argv[++i]);
104 <                else if (!strcmp(argv[i], "-s"))
101 >                        scompile(argv[++i], NULL, 0);
102 >                else if (!strcmp(argv[i], "-f")) {
103 >                        char  *fpath = getpath(argv[++i], getrlibpath(), 0);
104 >                        if (fpath == NULL) {
105 >                                fprintf(stderr, "%s: cannot find file '%s'\n",
106 >                                                argv[0], argv[i]);
107 >                                quit(1);
108 >                        }
109 >                        fcompile(fpath);
110 >                } else if (!strcmp(argv[i], "-s"))
111                          smooth++;
112 +                else if (!strcmp(argv[i], "-o"))
113 +                        objout++;
114                  else
115                          goto userror;
116  
117          modname = argv[1];
118          surfname = argv[2];
119 <        sprintf(stmp, "%s(s,t)=%s;", XNAME, argv[3]);
120 <        scompile(NULL, stmp);
76 <        sprintf(stmp, "%s(s,t)=%s;", YNAME, argv[4]);
77 <        scompile(NULL, stmp);
78 <        sprintf(stmp, "%s(s,t)=%s;", ZNAME, argv[5]);
79 <        scompile(NULL, stmp);
80 <        m = atoi(argv[6]);
81 <        n = atoi(argv[7]);
119 >        m = eval(argv[6]) + .5;
120 >        n = eval(argv[7]) + .5;
121          if (m <= 0 || n <= 0)
122                  goto userror;
123 <
124 <        row0 = (POINT *)malloc((n+1)*sizeof(POINT));
125 <        row1 = (POINT *)malloc((n+1)*sizeof(POINT));
126 <        row2 = (POINT *)malloc((n+1)*sizeof(POINT));
123 >        if (!strcmp(argv[5], "-") || access(argv[5], 4) == 0) { /* file? */
124 >                funset(ZNAME, 2, ':', l_dataval);
125 >                if (!strcmp(argv[5],argv[3]) && !strcmp(argv[5],argv[4])) {
126 >                        loaddata(argv[5], m, n, 3);
127 >                        funset(XNAME, 2, ':', l_dataval);
128 >                        funset(YNAME, 2, ':', l_dataval);
129 >                } else {
130 >                        loaddata(argv[5], m, n, 1);
131 >                        sprintf(stmp, "%s(s,t)=%s;", XNAME, argv[3]);
132 >                        scompile(stmp, NULL, 0);
133 >                        sprintf(stmp, "%s(s,t)=%s;", YNAME, argv[4]);
134 >                        scompile(stmp, NULL, 0);
135 >                }
136 >        } else {
137 >                sprintf(stmp, "%s(s,t)=%s;", XNAME, argv[3]);
138 >                scompile(stmp, NULL, 0);
139 >                sprintf(stmp, "%s(s,t)=%s;", YNAME, argv[4]);
140 >                scompile(stmp, NULL, 0);
141 >                sprintf(stmp, "%s(s,t)=%s;", ZNAME, argv[5]);
142 >                scompile(stmp, NULL, 0);
143 >        }
144 >        row0 = (POINT *)malloc((n+3)*sizeof(POINT));
145 >        row1 = (POINT *)malloc((n+3)*sizeof(POINT));
146 >        row2 = (POINT *)malloc((n+3)*sizeof(POINT));
147          if (row0 == NULL || row1 == NULL || row2 == NULL) {
148                  fprintf(stderr, "%s: out of memory\n", argv[0]);
149                  quit(1);
150          }
151 +        row0++; row1++; row2++;
152                                                  /* print header */
153 <        printhead(argc, argv);
154 <                                                /* compute first two rows */
153 >        fputs("# ", stdout);
154 >        printargs(argc, argv, stdout);
155 >        eclock = 0;
156 >                                                /* initialize */
157 >        comprow(-1.0/m, row0, n);
158          comprow(0.0, row1, n);
159          comprow(1.0/m, row2, n);
160 <        compnorms(row1, row1, row2, n);
160 >        compnorms(row0, row1, row2, n);
161 >        if (objout) {
162 >                printf("\nusemtl %s\n\n", modname);
163 >                putobjrow(row1, n);
164 >        }
165                                                  /* for each row */
166          for (i = 0; i < m; i++) {
167                                                  /* compute next row */
# Line 102 | Line 169 | char  *argv[];
169                  row0 = row1;
170                  row1 = row2;
171                  row2 = rp;
172 <                if (i+2 <= m) {
173 <                        comprow((double)(i+2)/m, row2, n);
174 <                        compnorms(row0, row1, row2, n);
175 <                } else
109 <                        compnorms(row0, row1, row1, n);
172 >                comprow((double)(i+2)/m, row2, n);
173 >                compnorms(row0, row1, row2, n);
174 >                if (objout)
175 >                        putobjrow(row1, n);
176  
177                  for (j = 0; j < n; j++) {
178 +                        int  orient = (j & 1);
179                                                          /* put polygons */
180 <                        if ((i+j) & 1)
180 >                        if (!(row0[j].valid && row1[j+1].valid))
181 >                                orient = 1;
182 >                        else if (!(row1[j].valid && row0[j+1].valid))
183 >                                orient = 0;
184 >                        if (orient)
185                                  putsquare(&row0[j], &row1[j],
186                                                  &row0[j+1], &row1[j+1]);
187                          else
# Line 119 | Line 190 | char  *argv[];
190                  }
191          }
192  
193 <        quit(0);
193 >        return 0;
194  
195   userror:
196          fprintf(stderr, "Usage: %s material name ", argv[0]);
197 <        fprintf(stderr, "x(s,t) y(s,t) z(s,t) m n [-s][-e expr][-f file]\n");
198 <        quit(1);
197 >        fprintf(stderr, "x(s,t) y(s,t) z(s,t) m n [-s][-o][-e expr][-f file]\n");
198 >        return 1;
199   }
200  
201  
202 < putsquare(p0, p1, p2, p3)               /* put out a square */
203 < POINT  *p0, *p1, *p2, *p3;
202 > void
203 > loaddata(               /* load point data from file */
204 >        char  *file,
205 >        int  m,
206 >        int  n,
207 >        int  pointsize
208 > )
209   {
210 +        FILE  *fp;
211 +        char  word[64];
212 +        int  size;
213 +        RREAL  *dp;
214 +
215 +        datarec.flags = HASBORDER;              /* assume border values */
216 +        datarec.m = m+1;
217 +        datarec.n = n+1;
218 +        size = datarec.m*datarec.n*pointsize;
219 +        if (pointsize == 3)
220 +                datarec.flags |= TRIPLETS;
221 +        dp = (RREAL *)malloc(size*sizeof(RREAL));
222 +        if ((datarec.data = dp) == NULL) {
223 +                fputs("Out of memory\n", stderr);
224 +                exit(1);
225 +        }
226 +        if (!strcmp(file, "-")) {
227 +                file = "<stdin>";
228 +                fp = stdin;
229 +        } else if ((fp = fopen(file, "r")) == NULL) {
230 +                fputs(file, stderr);
231 +                fputs(": cannot open\n", stderr);
232 +                exit(1);
233 +        }
234 +        while (size > 0 && fgetword(word, sizeof(word), fp) != NULL) {
235 +                if (!isflt(word)) {
236 +                        fprintf(stderr, "%s: garbled data value: %s\n",
237 +                                        file, word);
238 +                        exit(1);
239 +                }
240 +                *dp++ = atof(word);
241 +                size--;
242 +        }
243 +        if (size == (m+n+1)*pointsize) {        /* no border after all */
244 +                dp = (RREAL *)realloc(datarec.data,
245 +                                m*n*pointsize*sizeof(RREAL));
246 +                if (dp != NULL)
247 +                        datarec.data = dp;
248 +                datarec.flags &= ~HASBORDER;
249 +                datarec.m = m;
250 +                datarec.n = n;
251 +                size = 0;
252 +        }
253 +        if (datarec.m < 2 || datarec.n < 2 || size != 0 ||
254 +                        fgetword(word, sizeof(word), fp) != NULL) {
255 +                fputs(file, stderr);
256 +                fputs(": bad number of data points\n", stderr);
257 +                exit(1);
258 +        }
259 +        fclose(fp);
260 + }
261 +
262 +
263 + double
264 + l_dataval(                              /* return recorded data value */
265 +        char  *nam
266 + )
267 + {
268 +        double  u, v;
269 +        int  i, j;
270 +        RREAL  *dp;
271 +        double  d00, d01, d10, d11;
272 +                                                /* compute coordinates */
273 +        u = argument(1); v = argument(2);
274 +        if (datarec.flags & HASBORDER) {
275 +                i = u *= datarec.m-1;
276 +                j = v *= datarec.n-1;
277 +        } else {
278 +                i = u = u*datarec.m - .5;
279 +                j = v = v*datarec.n - .5;
280 +        }
281 +        if (i < 0) i = 0;
282 +        else if (i > datarec.m-2) i = datarec.m-2;
283 +        if (j < 0) j = 0;
284 +        else if (j > datarec.n-2) j = datarec.n-2;
285 +                                                /* compute value */
286 +        if (datarec.flags & TRIPLETS) {
287 +                dp = datarec.data + 3*(j*datarec.m + i);
288 +                if (nam == ZNAME)
289 +                        dp += 2;
290 +                else if (nam == YNAME)
291 +                        dp++;
292 +                d00 = dp[0]; d01 = dp[3];
293 +                dp += 3*datarec.m;
294 +                d10 = dp[0]; d11 = dp[3];
295 +        } else {
296 +                dp = datarec.data + j*datarec.m + i;
297 +                d00 = dp[0]; d01 = dp[1];
298 +                dp += datarec.m;
299 +                d10 = dp[0]; d11 = dp[1];
300 +        }
301 +                                                /* bilinear interpolation */
302 +        return((j+1-v)*((i+1-u)*d00+(u-i)*d01)+(v-j)*((i+1-u)*d10+(u-i)*d11));
303 + }
304 +
305 +
306 + void
307 + putobjrow(                      /* output vertex row to .OBJ */
308 +        POINT  *rp,
309 +        int  n
310 + )
311 + {
312 +        for ( ; n-- >= 0; rp++) {
313 +                if (!rp->valid)
314 +                        continue;
315 +                fputs("v ", stdout);
316 +                pvect(rp->p);
317 +                if (smooth && !ZEROVECT(rp->n)) {
318 +                        printf("\tvn %.9g %.9g %.9g\n",
319 +                                        rp->n[0], rp->n[1], rp->n[2]);
320 +                        rp->nvalid = ++nnorms;
321 +                } else
322 +                        rp->nvalid = 0;
323 +                printf("\tvt %.9g %.9g\n", rp->uv[0], rp->uv[1]);
324 +                rp->valid = ++nverts;
325 +        }
326 + }
327 +
328 +
329 + void
330 + putobjvert(             /* put out OBJ vertex index triplet */
331 +        POINT *p
332 + )
333 + {
334 +        int     pti = p->valid ? p->valid-nverts-1 : 0;
335 +        int     ni = p->nvalid ? p->nvalid-nnorms-1 : 0;
336 +        
337 +        printf(" %d/%d/%d", pti, pti, ni);
338 + }
339 +
340 +
341 + void
342 + putsquare(              /* put out a square */
343 +        POINT *p0,
344 +        POINT *p1,
345 +        POINT *p2,
346 +        POINT *p3
347 + )
348 + {
349          static int  nout = 0;
350          FVECT  norm[4];
351          int  axis;
352          FVECT  v1, v2, vc1, vc2;
353          int  ok1, ok2;
354                                          /* compute exact normals */
355 <        fvsum(v1, p1->p, p0->p, -1.0);
356 <        fvsum(v2, p2->p, p0->p, -1.0);
357 <        fcross(vc1, v1, v2);
358 <        ok1 = normalize(vc1) != 0.0;
359 <        fvsum(v1, p2->p, p3->p, -1.0);
360 <        fvsum(v2, p1->p, p3->p, -1.0);
361 <        fcross(vc2, v1, v2);
362 <        ok2 = normalize(vc2) != 0.0;
355 >        ok1 = (p0->valid && p1->valid && p2->valid);
356 >        if (ok1) {
357 >                VSUB(v1, p1->p, p0->p);
358 >                VSUB(v2, p2->p, p0->p);
359 >                fcross(vc1, v1, v2);
360 >                ok1 = (normalize(vc1) != 0.0);
361 >        }
362 >        ok2 = (p1->valid && p2->valid && p3->valid);
363 >        if (ok2) {
364 >                VSUB(v1, p2->p, p3->p);
365 >                VSUB(v2, p1->p, p3->p);
366 >                fcross(vc2, v1, v2);
367 >                ok2 = (normalize(vc2) != 0.0);
368 >        }
369          if (!(ok1 | ok2))
370                  return;
371 +        if (objout) {                   /* output .OBJ faces */
372 +                if (ok1 & ok2 && fdot(vc1,vc2) >= 1.0-FTINY*FTINY) {
373 +                        putc('f', stdout);
374 +                        putobjvert(p0); putobjvert(p1);
375 +                        putobjvert(p3); putobjvert(p2);
376 +                        putc('\n', stdout);
377 +                        return;
378 +                }
379 +                if (ok1) {
380 +                        putc('f', stdout);
381 +                        putobjvert(p0); putobjvert(p1); putobjvert(p2);
382 +                        putc('\n', stdout);
383 +                }
384 +                if (ok2) {
385 +                        putc('f', stdout);
386 +                        putobjvert(p2); putobjvert(p1); putobjvert(p3);
387 +                        putc('\n', stdout);
388 +                }
389 +                return;
390 +        }
391                                          /* compute normal interpolation */
392          axis = norminterp(norm, p0, p1, p2, p3);
393  
# Line 154 | Line 395 | POINT  *p0, *p1, *p2, *p3;
395          if (ok1 & ok2 && fdot(vc1,vc2) >= 1.0-FTINY*FTINY) {
396                  printf("\n%s ", modname);
397                  if (axis != -1) {
398 <                        printf("texfunc %s\n", texname);
158 <                        printf(tsargs);
398 >                        printf("texfunc %s\n%s\n", texname, tsargs);
399                          printf("0\n13\t%d\n", axis);
400                          pvect(norm[0]);
401                          pvect(norm[1]);
# Line 177 | Line 417 | POINT  *p0, *p1, *p2, *p3;
417          if (ok1) {
418                  printf("\n%s ", modname);
419                  if (axis != -1) {
420 <                        printf("texfunc %s\n", texname);
181 <                        printf(tsargs);
420 >                        printf("texfunc %s\n%s\n", texname, tsargs);
421                          printf("0\n13\t%d\n", axis);
422                          pvect(norm[0]);
423                          pvect(norm[1]);
# Line 196 | Line 435 | POINT  *p0, *p1, *p2, *p3;
435          if (ok2) {
436                  printf("\n%s ", modname);
437                  if (axis != -1) {
438 <                        printf("texfunc %s\n", texname);
200 <                        printf(tsargs);
438 >                        printf("texfunc %s\n%s\n", texname, tsargs);
439                          printf("0\n13\t%d\n", axis);
440                          pvect(norm[0]);
441                          pvect(norm[1]);
# Line 215 | Line 453 | POINT  *p0, *p1, *p2, *p3;
453   }
454  
455  
456 < comprow(s, row, siz)                    /* compute row of values */
457 < double  s;
458 < register POINT  *row;
459 < int  siz;
456 > void
457 > comprow(                        /* compute row of values */
458 >        double  s,
459 >        POINT  *row,
460 >        int  siz
461 > )
462   {
463 <        double  st[2], step;
464 <
463 >        double  st[2];
464 >        int  end;
465 >        int  checkvalid;
466 >        int  i;
467 >        
468 >        if (smooth) {
469 >                i = -1;                 /* compute one past each end */
470 >                end = siz+1;
471 >        } else {
472 >                if (s < -FTINY || s > 1.0+FTINY)
473 >                        return;
474 >                i = 0;
475 >                end = siz;
476 >        }
477          st[0] = s;
478 <        st[1] = 0.0;
479 <        step = 1.0 / siz;
480 <        while (siz-- >= 0) {
481 <                row->p[0] = funvalue(XNAME, 2, st);
482 <                row->p[1] = funvalue(YNAME, 2, st);
483 <                row->p[2] = funvalue(ZNAME, 2, st);
484 <                row++;
485 <                st[1] += step;
478 >        checkvalid = (fundefined(VNAME) == 2);
479 >        while (i <= end) {
480 >                st[1] = (double)i/siz;
481 >                if (checkvalid && funvalue(VNAME, 2, st) <= 0.0) {
482 >                        row[i].valid = 0;
483 >                        row[i].p[0] = row[i].p[1] = row[i].p[2] = 0.0;
484 >                        row[i].uv[0] = row[i].uv[1] = 0.0;
485 >                } else {
486 >                        row[i].valid = 1;
487 >                        row[i].p[0] = funvalue(XNAME, 2, st);
488 >                        row[i].p[1] = funvalue(YNAME, 2, st);
489 >                        row[i].p[2] = funvalue(ZNAME, 2, st);
490 >                        row[i].uv[0] = st[0];
491 >                        row[i].uv[1] = st[1];
492 >                }
493 >                i++;
494          }
495   }
496  
497  
498 < compnorms(r0, r1, r2, siz)              /* compute row of averaged normals */
499 < register POINT  *r0, *r1, *r2;
500 < int  siz;
498 > void
499 > compnorms(              /* compute row of averaged normals */
500 >        POINT  *r0,
501 >        POINT  *r1,
502 >        POINT  *r2,
503 >        int  siz
504 > )
505   {
506 <        FVECT  v1, v2, vc;
506 >        FVECT  v1, v2;
507  
508          if (!smooth)                    /* not needed if no smoothing */
509                  return;
510 <                                        /* compute first point */
511 <        fvsum(v1, r2[0].p, r1[0].p, -1.0);
512 <        fvsum(v2, r1[1].p, r1[0].p, -1.0);
513 <        fcross(r1[0].n, v1, v2);
514 <        fvsum(v1, r0[0].p, r1[0].p, -1.0);
515 <        fcross(vc, v2, v1);
516 <        fvsum(r1[0].n, r1[0].n, vc, 1.0);
517 <        normalize(r1[0].n);
518 <        r0++; r1++; r2++;
519 <                                        /* compute middle points */
520 <        while (--siz > 0) {
521 <                fvsum(v1, r2[0].p, r1[0].p, -1.0);
522 <                fvsum(v2, r1[1].p, r1[0].p, -1.0);
510 >                                        /* compute row 1 normals */
511 >        while (siz-- >= 0) {
512 >                if (!r1[0].valid)
513 >                        goto skip;
514 >                if (!r0[0].valid) {
515 >                        if (!r2[0].valid) {
516 >                                r1[0].n[0] = r1[0].n[1] = r1[0].n[2] = 0.0;
517 >                                goto skip;
518 >                        }
519 >                        fvsum(v1, r2[0].p, r1[0].p, -1.0);
520 >                } else if (!r2[0].valid)
521 >                        fvsum(v1, r1[0].p, r0[0].p, -1.0);
522 >                else
523 >                        fvsum(v1, r2[0].p, r0[0].p, -1.0);
524 >                if (!r1[-1].valid) {
525 >                        if (!r1[1].valid) {
526 >                                r1[0].n[0] = r1[0].n[1] = r1[0].n[2] = 0.0;
527 >                                goto skip;
528 >                        }
529 >                        fvsum(v2, r1[1].p, r1[0].p, -1.0);
530 >                } else if (!r1[1].valid)
531 >                        fvsum(v2, r1[0].p, r1[-1].p, -1.0);
532 >                else
533 >                        fvsum(v2, r1[1].p, r1[-1].p, -1.0);
534                  fcross(r1[0].n, v1, v2);
260 –                fvsum(v1, r0[0].p, r1[0].p, -1.0);
261 –                fcross(vc, v2, v1);
262 –                fvsum(r1[0].n, r1[0].n, vc, 1.0);
263 –                fvsum(v2, r1[-1].p, r1[0].p, -1.0);
264 –                fcross(vc, v1, v2);
265 –                fvsum(r1[0].n, r1[0].n, vc, 1.0);
266 –                fvsum(v1, r2[0].p, r1[0].p, -1.0);
267 –                fcross(vc, v2, v1);
268 –                fvsum(r1[0].n, r1[0].n, vc, 1.0);
535                  normalize(r1[0].n);
536 +        skip:
537                  r0++; r1++; r2++;
538          }
272 –                                        /* compute end point */
273 –        fvsum(v1, r0[0].p, r1[0].p, -1.0);
274 –        fvsum(v2, r1[-1].p, r1[0].p, -1.0);
275 –        fcross(r1[0].n, v1, v2);
276 –        fvsum(v1, r2[0].p, r1[0].p, -1.0);
277 –        fcross(vc, v2, v1);
278 –        fvsum(r1[0].n, r1[0].n, vc, 1.0);
279 –        normalize(r1[0].n);
539   }
540  
541  
542   int
543 < norminterp(resmat, p0, p1, p2, p3)      /* compute normal interpolation */
544 < register FVECT  resmat[4];
545 < POINT  *p0, *p1, *p2, *p3;
543 > norminterp(     /* compute normal interpolation */
544 >        FVECT  resmat[4],
545 >        POINT  *p0,
546 >        POINT  *p1,
547 >        POINT  *p2,
548 >        POINT  *p3
549 > )
550   {
551   #define u  ((ax+1)%3)
552   #define v  ((ax+2)%3)
553  
554 <        register int  ax;
555 <        double  eqnmat[4][4], solmat[4][4];
554 >        int  ax;
555 >        MAT4  eqnmat;
556          FVECT  v1;
557 <        register int  i, j;
557 >        int  i, j;
558  
559          if (!smooth)                    /* no interpolation if no smoothing */
560                  return(-1);
# Line 300 | Line 563 | POINT  *p0, *p1, *p2, *p3;
563          fvsum(v1, v1, p1->n, 1.0);
564          fvsum(v1, v1, p2->n, 1.0);
565          fvsum(v1, v1, p3->n, 1.0);
566 <        ax = fabs(v1[0]) > fabs(v1[1]) ? 0 : 1;
567 <        ax = fabs(v1[ax]) > fabs(v1[2]) ? ax : 2;
566 >        ax = ABS(v1[0]) > ABS(v1[1]) ? 0 : 1;
567 >        ax = ABS(v1[ax]) > ABS(v1[2]) ? ax : 2;
568                                          /* assign equation matrix */
569          eqnmat[0][0] = p0->p[u]*p0->p[v];
570          eqnmat[0][1] = p0->p[u];
# Line 320 | Line 583 | POINT  *p0, *p1, *p2, *p3;
583          eqnmat[3][2] = p3->p[v];
584          eqnmat[3][3] = 1.0;
585                                          /* invert matrix (solve system) */
586 <        if (!invmat(solmat, eqnmat))
586 >        if (!invmat4(eqnmat, eqnmat))
587                  return(-1);                     /* no solution */
588                                          /* compute result matrix */
589          for (j = 0; j < 4; j++)
590                  for (i = 0; i < 3; i++)
591 <                        resmat[j][i] =  solmat[j][0]*p0->n[i] +
592 <                                        solmat[j][1]*p1->n[i] +
593 <                                        solmat[j][2]*p2->n[i] +
594 <                                        solmat[j][3]*p3->n[i];
591 >                        resmat[j][i] =  eqnmat[j][0]*p0->n[i] +
592 >                                        eqnmat[j][1]*p1->n[i] +
593 >                                        eqnmat[j][2]*p2->n[i] +
594 >                                        eqnmat[j][3]*p3->n[i];
595          return(ax);
596  
597   #undef u
# Line 336 | Line 599 | POINT  *p0, *p1, *p2, *p3;
599   }
600  
601  
602 < static double  m4tmp[4][4];             /* for efficiency */
603 <
341 < #define  copymat4(m4a,m4b)      bcopy((char *)m4b,(char *)m4a,sizeof(m4tmp))
342 <
343 <
344 < setident4(m4)
345 < double  m4[4][4];
602 > double
603 > l_hermite(char *nm)
604   {
605 <        static double  ident[4][4] = {
606 <                1.,0.,0.,0.,
607 <                0.,1.,0.,0.,
608 <                0.,0.,1.,0.,
609 <                0.,0.,0.,1.,
610 <        };
611 <        copymat4(m4, ident);
605 >        double  t;
606 >        
607 >        t = argument(5);
608 >        return( argument(1)*((2.0*t-3.0)*t*t+1.0) +
609 >                argument(2)*(-2.0*t+3.0)*t*t +
610 >                argument(3)*((t-2.0)*t+1.0)*t +
611 >                argument(4)*(t-1.0)*t*t );
612   }
613  
356 – /*
357 – * invmat - computes the inverse of mat into inverse.  Returns 1
358 – * if there exists an inverse, 0 otherwise.  It uses Gaussian Elimination
359 – * method.
360 – */
614  
615 < invmat(inverse,mat)
616 < double mat[4][4],inverse[4][4];
615 > double
616 > l_bezier(char *nm)
617   {
618 < #define SWAP(a,b,t) (t=a,a=b,b=t)
618 >        double  t;
619  
620 <        register int i,j,k;
621 <        register double temp;
622 <
623 <        setident4(inverse);
624 <        copymat4(m4tmp, mat);
372 <
373 <        for(i = 0; i < 4; i++) {
374 <                if(m4tmp[i][i] == 0) {    /* Pivot is zero */
375 <                        /* Look for a raw with pivot != 0 and swap raws */
376 <                        for(j = i + 1; j < 4; j++)
377 <                                if(m4tmp[j][i] != 0) {
378 <                                        for( k = 0; k < 4; k++) {
379 <                                                SWAP(m4tmp[i][k],m4tmp[j][k],temp);
380 <                                                SWAP(inverse[i][k],inverse[j][k],temp);
381 <                                                }
382 <                                        break;
383 <                                        }
384 <                        if(j == 4)      /* No replacing raw -> no inverse */
385 <                                return(0);
386 <                        }
387 <
388 <                temp = m4tmp[i][i];
389 <                for(k = 0; k < 4; k++) {
390 <                        m4tmp[i][k] /= temp;
391 <                        inverse[i][k] /= temp;
392 <                        }
393 <                for(j = 0; j < 4; j++) {
394 <                        if(j != i) {
395 <                                temp = m4tmp[j][i];
396 <                                for(k = 0; k < 4; k++) {
397 <                                        m4tmp[j][k] -= m4tmp[i][k]*temp;
398 <                                        inverse[j][k] -= inverse[i][k]*temp;
399 <                                        }
400 <                                }
401 <                        }
402 <                }
403 <        return(1);
404 < #undef SWAP
620 >        t = argument(5);
621 >        return( argument(1) * (1.+t*(-3.+t*(3.-t))) +
622 >                argument(2) * 3.*t*(1.+t*(-2.+t)) +
623 >                argument(3) * 3.*t*t*(1.-t) +
624 >                argument(4) * t*t*t );
625   }
626  
627  
408 – eputs(msg)
409 – char  *msg;
410 – {
411 –        fputs(msg, stderr);
412 – }
413 –
414 –
415 – wputs(msg)
416 – char  *msg;
417 – {
418 –        eputs(msg);
419 – }
420 –
421 –
422 – quit(code)
423 – {
424 –        exit(code);
425 – }
426 –
427 –
428 – printhead(ac, av)               /* print command header */
429 – register int  ac;
430 – register char  **av;
431 – {
432 –        putchar('#');
433 –        while (ac--) {
434 –                putchar(' ');
435 –                fputs(*av++, stdout);
436 –        }
437 –        putchar('\n');
438 – }
439 –
440 –
628   double
629 < l_hermite()                    
629 > l_bspline(char *nm)
630   {
631          double  t;
632 <        
632 >
633          t = argument(5);
634 <        return( argument(1)*((2.0*t-3.0)*t*t+1.0) +
635 <                argument(2)*(-2.0*t+3.0)*t*t +
636 <                argument(3)*((t-2.0)*t+1.0)*t +
637 <                argument(4)*(t-1.0)*t*t );
634 >        return( argument(1) * (1./6.+t*(-1./2.+t*(1./2.-1./6.*t))) +
635 >                argument(2) * (2./3.+t*t*(-1.+1./2.*t)) +
636 >                argument(3) * (1./6.+t*(1./2.+t*(1./2.-1./2.*t))) +
637 >                argument(4) * (1./6.*t*t*t) );
638   }

Diff Legend

– Removed lines
+ Added lines
< Changed lines
> Changed lines