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.11 by greg, Thu Aug 2 13:42:56 1990 UTC vs.
Revision 2.28 by greg, Sat Nov 14 00:29:51 2020 UTC

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

Diff Legend

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