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.4 by greg, Wed Oct 18 18:49:09 1989 UTC vs.
Revision 2.22 by greg, Mon Dec 9 22:08:13 2013 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();
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  
68 + void loaddata(char *file, int m, int n, int pointsize);
69 + double l_dataval(char *nam);
70 + void putobjrow(POINT *rp, int n);
71 + void putsquare(POINT *p0, POINT *p1, POINT *p2, POINT *p3);
72 + void comprow(double s, POINT *row, int siz);
73 + void compnorms(POINT *r0, POINT *r1, POINT *r2, int siz);
74 + int norminterp(FVECT resmat[4], POINT *p0, POINT *p1, POINT *p2, POINT *p3);
75 +
76 +
77 + int
78   main(argc, argv)
79   int  argc;
80   char  *argv[];
# Line 55 | Line 83 | char  *argv[];
83          int  i, j, m, n;
84          char  stmp[256];
85  
86 <        varset("PI", PI);
87 <        funset("hermite", 5, l_hermite);
86 >        varset("PI", ':', PI);
87 >        funset("hermite", 5, ':', l_hermite);
88 >        funset("bezier", 5, ':', l_bezier);
89 >        funset("bspline", 5, ':', l_bspline);
90  
91          if (argc < 8)
92                  goto userror;
93  
94          for (i = 8; i < argc; i++)
95                  if (!strcmp(argv[i], "-e"))
96 <                        scompile(NULL, argv[++i]);
96 >                        scompile(argv[++i], NULL, 0);
97                  else if (!strcmp(argv[i], "-f"))
98                          fcompile(argv[++i]);
99                  else if (!strcmp(argv[i], "-s"))
100                          smooth++;
101 +                else if (!strcmp(argv[i], "-o"))
102 +                        objout++;
103                  else
104                          goto userror;
105  
106          modname = argv[1];
107          surfname = argv[2];
76 –        sprintf(stmp, "%s(s,t)=%s;", XNAME, argv[3]);
77 –        scompile(NULL, stmp);
78 –        sprintf(stmp, "%s(s,t)=%s;", YNAME, argv[4]);
79 –        scompile(NULL, stmp);
80 –        sprintf(stmp, "%s(s,t)=%s;", ZNAME, argv[5]);
81 –        scompile(NULL, stmp);
108          m = atoi(argv[6]);
109          n = atoi(argv[7]);
110          if (m <= 0 || n <= 0)
111                  goto userror;
112 <
112 >        if (!strcmp(argv[5], "-") || access(argv[5], 4) == 0) { /* file? */
113 >                funset(ZNAME, 2, ':', l_dataval);
114 >                if (!strcmp(argv[5],argv[3]) && !strcmp(argv[5],argv[4])) {
115 >                        loaddata(argv[5], m, n, 3);
116 >                        funset(XNAME, 2, ':', l_dataval);
117 >                        funset(YNAME, 2, ':', l_dataval);
118 >                } else {
119 >                        loaddata(argv[5], m, n, 1);
120 >                        sprintf(stmp, "%s(s,t)=%s;", XNAME, argv[3]);
121 >                        scompile(stmp, NULL, 0);
122 >                        sprintf(stmp, "%s(s,t)=%s;", YNAME, argv[4]);
123 >                        scompile(stmp, NULL, 0);
124 >                }
125 >        } else {
126 >                sprintf(stmp, "%s(s,t)=%s;", XNAME, argv[3]);
127 >                scompile(stmp, NULL, 0);
128 >                sprintf(stmp, "%s(s,t)=%s;", YNAME, argv[4]);
129 >                scompile(stmp, NULL, 0);
130 >                sprintf(stmp, "%s(s,t)=%s;", ZNAME, argv[5]);
131 >                scompile(stmp, NULL, 0);
132 >        }
133          row0 = (POINT *)malloc((n+3)*sizeof(POINT));
134          row1 = (POINT *)malloc((n+3)*sizeof(POINT));
135          row2 = (POINT *)malloc((n+3)*sizeof(POINT));
# Line 93 | Line 139 | char  *argv[];
139          }
140          row0++; row1++; row2++;
141                                                  /* print header */
142 <        printhead(argc, argv);
142 >        fputs("# ", stdout);
143 >        printargs(argc, argv, stdout);
144 >        eclock = 0;
145                                                  /* initialize */
146          comprow(-1.0/m, row0, n);
147          comprow(0.0, row1, n);
148          comprow(1.0/m, row2, n);
149          compnorms(row0, row1, row2, n);
150 +        if (objout) {
151 +                printf("\nusemtl %s\n\n", modname);
152 +                putobjrow(row1, n);
153 +        }
154                                                  /* for each row */
155          for (i = 0; i < m; i++) {
156                                                  /* compute next row */
# Line 108 | Line 160 | char  *argv[];
160                  row2 = rp;
161                  comprow((double)(i+2)/m, row2, n);
162                  compnorms(row0, row1, row2, n);
163 +                if (objout)
164 +                        putobjrow(row1, n);
165  
166                  for (j = 0; j < n; j++) {
167 +                        int  orient = (j & 1);
168                                                          /* put polygons */
169 <                        if ((i+j) & 1)
169 >                        if (!(row0[j].valid && row1[j+1].valid))
170 >                                orient = 1;
171 >                        else if (!(row1[j].valid && row0[j+1].valid))
172 >                                orient = 0;
173 >                        if (orient)
174                                  putsquare(&row0[j], &row1[j],
175                                                  &row0[j+1], &row1[j+1]);
176                          else
# Line 120 | Line 179 | char  *argv[];
179                  }
180          }
181  
182 <        quit(0);
182 >        return 0;
183  
184   userror:
185          fprintf(stderr, "Usage: %s material name ", argv[0]);
186 <        fprintf(stderr, "x(s,t) y(s,t) z(s,t) m n [-s][-e expr][-f file]\n");
187 <        quit(1);
186 >        fprintf(stderr, "x(s,t) y(s,t) z(s,t) m n [-s][-o][-e expr][-f file]\n");
187 >        return 1;
188   }
189  
190  
191 < putsquare(p0, p1, p2, p3)               /* put out a square */
192 < POINT  *p0, *p1, *p2, *p3;
191 > void
192 > loaddata(               /* load point data from file */
193 >        char  *file,
194 >        int  m,
195 >        int  n,
196 >        int  pointsize
197 > )
198   {
199 +        FILE  *fp;
200 +        char  word[64];
201 +        int  size;
202 +        RREAL  *dp;
203 +
204 +        datarec.flags = HASBORDER;              /* assume border values */
205 +        datarec.m = m+1;
206 +        datarec.n = n+1;
207 +        size = datarec.m*datarec.n*pointsize;
208 +        if (pointsize == 3)
209 +                datarec.flags |= TRIPLETS;
210 +        dp = (RREAL *)malloc(size*sizeof(RREAL));
211 +        if ((datarec.data = dp) == NULL) {
212 +                fputs("Out of memory\n", stderr);
213 +                exit(1);
214 +        }
215 +        if (!strcmp(file, "-")) {
216 +                file = "<stdin>";
217 +                fp = stdin;
218 +        } else if ((fp = fopen(file, "r")) == NULL) {
219 +                fputs(file, stderr);
220 +                fputs(": cannot open\n", stderr);
221 +                exit(1);
222 +        }
223 +        while (size > 0 && fgetword(word, sizeof(word), fp) != NULL) {
224 +                if (!isflt(word)) {
225 +                        fprintf(stderr, "%s: garbled data value: %s\n",
226 +                                        file, word);
227 +                        exit(1);
228 +                }
229 +                *dp++ = atof(word);
230 +                size--;
231 +        }
232 +        if (size == (m+n+1)*pointsize) {        /* no border after all */
233 +                dp = (RREAL *)realloc(datarec.data,
234 +                                m*n*pointsize*sizeof(RREAL));
235 +                if (dp != NULL)
236 +                        datarec.data = dp;
237 +                datarec.flags &= ~HASBORDER;
238 +                datarec.m = m;
239 +                datarec.n = n;
240 +                size = 0;
241 +        }
242 +        if (datarec.m < 2 || datarec.n < 2 || size != 0 ||
243 +                        fgetword(word, sizeof(word), fp) != NULL) {
244 +                fputs(file, stderr);
245 +                fputs(": bad number of data points\n", stderr);
246 +                exit(1);
247 +        }
248 +        fclose(fp);
249 + }
250 +
251 +
252 + double
253 + l_dataval(                              /* return recorded data value */
254 +        char  *nam
255 + )
256 + {
257 +        double  u, v;
258 +        int  i, j;
259 +        RREAL  *dp;
260 +        double  d00, d01, d10, d11;
261 +                                                /* compute coordinates */
262 +        u = argument(1); v = argument(2);
263 +        if (datarec.flags & HASBORDER) {
264 +                i = u *= datarec.m-1;
265 +                j = v *= datarec.n-1;
266 +        } else {
267 +                i = u = u*datarec.m - .5;
268 +                j = v = v*datarec.n - .5;
269 +        }
270 +        if (i < 0) i = 0;
271 +        else if (i > datarec.m-2) i = datarec.m-2;
272 +        if (j < 0) j = 0;
273 +        else if (j > datarec.n-2) j = datarec.n-2;
274 +                                                /* compute value */
275 +        if (datarec.flags & TRIPLETS) {
276 +                dp = datarec.data + 3*(j*datarec.m + i);
277 +                if (nam == ZNAME)
278 +                        dp += 2;
279 +                else if (nam == YNAME)
280 +                        dp++;
281 +                d00 = dp[0]; d01 = dp[3];
282 +                dp += 3*datarec.m;
283 +                d10 = dp[0]; d11 = dp[3];
284 +        } else {
285 +                dp = datarec.data + j*datarec.m + i;
286 +                d00 = dp[0]; d01 = dp[1];
287 +                dp += datarec.m;
288 +                d10 = dp[0]; d11 = dp[1];
289 +        }
290 +                                                /* bilinear interpolation */
291 +        return((j+1-v)*((i+1-u)*d00+(u-i)*d01)+(v-j)*((i+1-u)*d10+(u-i)*d11));
292 + }
293 +
294 +
295 + void
296 + putobjrow(                      /* output vertex row to .OBJ */
297 +        POINT  *rp,
298 +        int  n
299 + )
300 + {
301 +        static int      nverts = 0;
302 +        static int      nnorms = 0;
303 +
304 +        for ( ; n-- >= 0; rp++) {
305 +                if (!rp->valid)
306 +                        continue;
307 +                fputs("v ", stdout);
308 +                pvect(rp->p);
309 +                if (smooth && !ZEROVECT(rp->n)) {
310 +                        printf("\tvn %.9g %.9g %.9g\n",
311 +                                        rp->n[0], rp->n[1], rp->n[2]);
312 +                        rp->nvalid = ++nnorms;
313 +                } else
314 +                        rp->nvalid = 0;
315 +                printf("\tvt %.9g %.9g\n", rp->uv[0], rp->uv[1]);
316 +                rp->valid = ++nverts;
317 +        }
318 + }
319 +
320 +
321 + void
322 + putsquare(              /* put out a square */
323 +        POINT *p0,
324 +        POINT *p1,
325 +        POINT *p2,
326 +        POINT *p3
327 + )
328 + {
329          static int  nout = 0;
330          FVECT  norm[4];
331          int  axis;
332          FVECT  v1, v2, vc1, vc2;
333          int  ok1, ok2;
334                                          /* compute exact normals */
335 <        fvsum(v1, p1->p, p0->p, -1.0);
336 <        fvsum(v2, p2->p, p0->p, -1.0);
337 <        fcross(vc1, v1, v2);
338 <        ok1 = normalize(vc1) != 0.0;
339 <        fvsum(v1, p2->p, p3->p, -1.0);
340 <        fvsum(v2, p1->p, p3->p, -1.0);
341 <        fcross(vc2, v1, v2);
342 <        ok2 = normalize(vc2) != 0.0;
335 >        ok1 = (p0->valid && p1->valid && p2->valid);
336 >        if (ok1) {
337 >                VSUB(v1, p1->p, p0->p);
338 >                VSUB(v2, p2->p, p0->p);
339 >                fcross(vc1, v1, v2);
340 >                ok1 = (normalize(vc1) != 0.0);
341 >        }
342 >        ok2 = (p1->valid && p2->valid && p3->valid);
343 >        if (ok2) {
344 >                VSUB(v1, p2->p, p3->p);
345 >                VSUB(v2, p1->p, p3->p);
346 >                fcross(vc2, v1, v2);
347 >                ok2 = (normalize(vc2) != 0.0);
348 >        }
349          if (!(ok1 | ok2))
350                  return;
351 +        if (objout) {                   /* output .OBJ faces */
352 +                if (ok1 & ok2 && fdot(vc1,vc2) >= 1.0-FTINY*FTINY) {
353 +                        printf("f %d/%d/%d %d/%d/%d %d/%d/%d %d/%d/%d\n",
354 +                                        p0->valid, p0->valid, p0->nvalid,
355 +                                        p1->valid, p1->valid, p1->nvalid,
356 +                                        p3->valid, p3->valid, p3->nvalid,
357 +                                        p2->valid, p2->valid, p2->nvalid);
358 +                        return;
359 +                }
360 +                if (ok1)
361 +                        printf("f %d/%d/%d %d/%d/%d %d/%d/%d\n",
362 +                                        p0->valid, p0->valid, p0->nvalid,
363 +                                        p1->valid, p1->valid, p1->nvalid,
364 +                                        p2->valid, p2->valid, p2->nvalid);
365 +                if (ok2)
366 +                        printf("f %d/%d/%d %d/%d/%d %d/%d/%d\n",
367 +                                        p2->valid, p2->valid, p2->nvalid,
368 +                                        p1->valid, p1->valid, p1->nvalid,
369 +                                        p3->valid, p3->valid, p3->nvalid);
370 +                return;
371 +        }
372                                          /* compute normal interpolation */
373          axis = norminterp(norm, p0, p1, p2, p3);
374  
# Line 155 | Line 376 | POINT  *p0, *p1, *p2, *p3;
376          if (ok1 & ok2 && fdot(vc1,vc2) >= 1.0-FTINY*FTINY) {
377                  printf("\n%s ", modname);
378                  if (axis != -1) {
379 <                        printf("texfunc %s\n", texname);
159 <                        printf(tsargs);
379 >                        printf("texfunc %s\n%s\n", texname, tsargs);
380                          printf("0\n13\t%d\n", axis);
381                          pvect(norm[0]);
382                          pvect(norm[1]);
# Line 178 | Line 398 | POINT  *p0, *p1, *p2, *p3;
398          if (ok1) {
399                  printf("\n%s ", modname);
400                  if (axis != -1) {
401 <                        printf("texfunc %s\n", texname);
182 <                        printf(tsargs);
401 >                        printf("texfunc %s\n%s\n", texname, tsargs);
402                          printf("0\n13\t%d\n", axis);
403                          pvect(norm[0]);
404                          pvect(norm[1]);
# Line 197 | Line 416 | POINT  *p0, *p1, *p2, *p3;
416          if (ok2) {
417                  printf("\n%s ", modname);
418                  if (axis != -1) {
419 <                        printf("texfunc %s\n", texname);
201 <                        printf(tsargs);
419 >                        printf("texfunc %s\n%s\n", texname, tsargs);
420                          printf("0\n13\t%d\n", axis);
421                          pvect(norm[0]);
422                          pvect(norm[1]);
# Line 216 | Line 434 | POINT  *p0, *p1, *p2, *p3;
434   }
435  
436  
437 < comprow(s, row, siz)                    /* compute row of values */
438 < double  s;
439 < register POINT  *row;
440 < int  siz;
437 > void
438 > comprow(                        /* compute row of values */
439 >        double  s,
440 >        POINT  *row,
441 >        int  siz
442 > )
443   {
444          double  st[2];
445 <        register int  i;
446 <                                        /* compute one past each end */
445 >        int  end;
446 >        int  checkvalid;
447 >        int  i;
448 >        
449 >        if (smooth) {
450 >                i = -1;                 /* compute one past each end */
451 >                end = siz+1;
452 >        } else {
453 >                if (s < -FTINY || s > 1.0+FTINY)
454 >                        return;
455 >                i = 0;
456 >                end = siz;
457 >        }
458          st[0] = s;
459 <        for (i = -1; i <= siz+1; i++) {
459 >        checkvalid = (fundefined(VNAME) == 2);
460 >        while (i <= end) {
461                  st[1] = (double)i/siz;
462 <                row[i].p[0] = funvalue(XNAME, 2, st);
463 <                row[i].p[1] = funvalue(YNAME, 2, st);
464 <                row[i].p[2] = funvalue(ZNAME, 2, st);
462 >                if (checkvalid && funvalue(VNAME, 2, st) <= 0.0) {
463 >                        row[i].valid = 0;
464 >                        row[i].p[0] = row[i].p[1] = row[i].p[2] = 0.0;
465 >                        row[i].uv[0] = row[i].uv[1] = 0.0;
466 >                } else {
467 >                        row[i].valid = 1;
468 >                        row[i].p[0] = funvalue(XNAME, 2, st);
469 >                        row[i].p[1] = funvalue(YNAME, 2, st);
470 >                        row[i].p[2] = funvalue(ZNAME, 2, st);
471 >                        row[i].uv[0] = st[0];
472 >                        row[i].uv[1] = st[1];
473 >                }
474 >                i++;
475          }
476   }
477  
478  
479 < compnorms(r0, r1, r2, siz)              /* compute row of averaged normals */
480 < register POINT  *r0, *r1, *r2;
481 < int  siz;
479 > void
480 > compnorms(              /* compute row of averaged normals */
481 >        POINT  *r0,
482 >        POINT  *r1,
483 >        POINT  *r2,
484 >        int  siz
485 > )
486   {
487 <        FVECT  v1, v2, vc;
242 <        register int  i;
487 >        FVECT  v1, v2;
488  
489          if (!smooth)                    /* not needed if no smoothing */
490                  return;
491 <                                        /* compute middle points */
491 >                                        /* compute row 1 normals */
492          while (siz-- >= 0) {
493 <                fvsum(v1, r2[0].p, r1[0].p, -1.0);
494 <                fvsum(v2, r1[1].p, r1[0].p, -1.0);
493 >                if (!r1[0].valid)
494 >                        continue;
495 >                if (!r0[0].valid) {
496 >                        if (!r2[0].valid) {
497 >                                r1[0].n[0] = r1[0].n[1] = r1[0].n[2] = 0.0;
498 >                                continue;
499 >                        }
500 >                        fvsum(v1, r2[0].p, r1[0].p, -1.0);
501 >                } else if (!r2[0].valid)
502 >                        fvsum(v1, r1[0].p, r0[0].p, -1.0);
503 >                else
504 >                        fvsum(v1, r2[0].p, r0[0].p, -1.0);
505 >                if (!r1[-1].valid) {
506 >                        if (!r1[1].valid) {
507 >                                r1[0].n[0] = r1[0].n[1] = r1[0].n[2] = 0.0;
508 >                                continue;
509 >                        }
510 >                        fvsum(v2, r1[1].p, r1[0].p, -1.0);
511 >                } else if (!r1[1].valid)
512 >                        fvsum(v2, r1[0].p, r1[-1].p, -1.0);
513 >                else
514 >                        fvsum(v2, r1[1].p, r1[-1].p, -1.0);
515                  fcross(r1[0].n, v1, v2);
251 –                fvsum(v1, r0[0].p, r1[0].p, -1.0);
252 –                fcross(vc, v2, v1);
253 –                fvsum(r1[0].n, r1[0].n, vc, 1.0);
254 –                fvsum(v2, r1[-1].p, r1[0].p, -1.0);
255 –                fcross(vc, v1, v2);
256 –                fvsum(r1[0].n, r1[0].n, vc, 1.0);
257 –                fvsum(v1, r2[0].p, r1[0].p, -1.0);
258 –                fcross(vc, v2, v1);
259 –                fvsum(r1[0].n, r1[0].n, vc, 1.0);
516                  normalize(r1[0].n);
517                  r0++; r1++; r2++;
518          }
# Line 264 | Line 520 | int  siz;
520  
521  
522   int
523 < norminterp(resmat, p0, p1, p2, p3)      /* compute normal interpolation */
524 < register FVECT  resmat[4];
525 < POINT  *p0, *p1, *p2, *p3;
523 > norminterp(     /* compute normal interpolation */
524 >        FVECT  resmat[4],
525 >        POINT  *p0,
526 >        POINT  *p1,
527 >        POINT  *p2,
528 >        POINT  *p3
529 > )
530   {
531   #define u  ((ax+1)%3)
532   #define v  ((ax+2)%3)
533  
534 <        register int  ax;
535 <        double  eqnmat[4][4];
534 >        int  ax;
535 >        MAT4  eqnmat;
536          FVECT  v1;
537 <        register int  i, j;
537 >        int  i, j;
538  
539          if (!smooth)                    /* no interpolation if no smoothing */
540                  return(-1);
# Line 303 | Line 563 | POINT  *p0, *p1, *p2, *p3;
563          eqnmat[3][2] = p3->p[v];
564          eqnmat[3][3] = 1.0;
565                                          /* invert matrix (solve system) */
566 <        if (!invmat(eqnmat, eqnmat))
566 >        if (!invmat4(eqnmat, eqnmat))
567                  return(-1);                     /* no solution */
568                                          /* compute result matrix */
569          for (j = 0; j < 4; j++)
# Line 319 | Line 579 | POINT  *p0, *p1, *p2, *p3;
579   }
580  
581  
582 < /*
583 < * invmat - computes the inverse of mat into inverse.  Returns 1
324 < * if there exists an inverse, 0 otherwise.  It uses Gaussian Elimination
325 < * method.
326 < */
327 <
328 < invmat(inverse,mat)
329 < double mat[4][4],inverse[4][4];
582 > double
583 > l_hermite(char *nm)
584   {
585 < #define SWAP(a,b,t) (t=a,a=b,b=t)
586 <
587 <        double  m4tmp[4][4];
588 <        register int i,j,k;
589 <        register double temp;
590 <
591 <        bcopy(mat, m4tmp, sizeof(m4tmp));
338 <                                        /* set inverse to identity */
339 <        for (i = 0; i < 4; i++)
340 <                for (j = 0; j < 4; j++)
341 <                        inverse[i][j] = i==j ? 1.0 : 0.0;
342 <
343 <        for(i = 0; i < 4; i++) {
344 <                /* Look for raw with largest pivot and swap raws */
345 <                temp = FTINY; j = -1;
346 <                for(k = i; k < 4; k++)
347 <                        if(ABS(m4tmp[k][i]) > temp) {
348 <                                temp = ABS(m4tmp[k][i]);
349 <                                j = k;
350 <                                }
351 <                if(j == -1)     /* No replacing raw -> no inverse */
352 <                        return(0);
353 <                if (j != i)
354 <                        for(k = 0; k < 4; k++) {
355 <                                SWAP(m4tmp[i][k],m4tmp[j][k],temp);
356 <                                SWAP(inverse[i][k],inverse[j][k],temp);
357 <                                }
358 <
359 <                temp = m4tmp[i][i];
360 <                for(k = 0; k < 4; k++) {
361 <                        m4tmp[i][k] /= temp;
362 <                        inverse[i][k] /= temp;
363 <                        }
364 <                for(j = 0; j < 4; j++) {
365 <                        if(j != i) {
366 <                                temp = m4tmp[j][i];
367 <                                for(k = 0; k < 4; k++) {
368 <                                        m4tmp[j][k] -= m4tmp[i][k]*temp;
369 <                                        inverse[j][k] -= inverse[i][k]*temp;
370 <                                        }
371 <                                }
372 <                        }
373 <                }
374 <        return(1);
375 <
376 < #undef SWAP
585 >        double  t;
586 >        
587 >        t = argument(5);
588 >        return( argument(1)*((2.0*t-3.0)*t*t+1.0) +
589 >                argument(2)*(-2.0*t+3.0)*t*t +
590 >                argument(3)*((t-2.0)*t+1.0)*t +
591 >                argument(4)*(t-1.0)*t*t );
592   }
593  
594  
595 < eputs(msg)
596 < char  *msg;
595 > double
596 > l_bezier(char *nm)
597   {
598 <        fputs(msg, stderr);
384 < }
598 >        double  t;
599  
600 <
601 < wputs(msg)
602 < char  *msg;
603 < {
604 <        eputs(msg);
600 >        t = argument(5);
601 >        return( argument(1) * (1.+t*(-3.+t*(3.-t))) +
602 >                argument(2) * 3.*t*(1.+t*(-2.+t)) +
603 >                argument(3) * 3.*t*t*(1.-t) +
604 >                argument(4) * t*t*t );
605   }
606  
607  
394 – quit(code)
395 – {
396 –        exit(code);
397 – }
398 –
399 –
400 – printhead(ac, av)               /* print command header */
401 – register int  ac;
402 – register char  **av;
403 – {
404 –        putchar('#');
405 –        while (ac--) {
406 –                putchar(' ');
407 –                fputs(*av++, stdout);
408 –        }
409 –        putchar('\n');
410 – }
411 –
412 –
608   double
609 < l_hermite()                    
609 > l_bspline(char *nm)
610   {
611          double  t;
612 <        
612 >
613          t = argument(5);
614 <        return( argument(1)*((2.0*t-3.0)*t*t+1.0) +
615 <                argument(2)*(-2.0*t+3.0)*t*t +
616 <                argument(3)*((t-2.0)*t+1.0)*t +
617 <                argument(4)*(t-1.0)*t*t );
614 >        return( argument(1) * (1./6.+t*(-1./2.+t*(1./2.-1./6.*t))) +
615 >                argument(2) * (2./3.+t*t*(-1.+1./2.*t)) +
616 >                argument(3) * (1./6.+t*(1./2.+t*(1./2.-1./2.*t))) +
617 >                argument(4) * (1./6.*t*t*t) );
618   }

Diff Legend

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