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

Comparing ray/src/util/rmatrix.c (file contents):
Revision 2.2 by greg, Sat May 31 19:21:21 2014 UTC vs.
Revision 2.32 by greg, Mon Aug 12 04:46:34 2019 UTC

# Line 9 | Line 9 | static const char RCSid[] = "$Id$";
9   #include <stdlib.h>
10   #include <string.h>
11   #include <fcntl.h>
12 + #include <errno.h>
13 + #include "rtio.h"
14 + #include "platform.h"
15   #include "resolu.h"
16 + #include "paths.h"
17   #include "rmatrix.h"
18  
19 < typedef struct {
16 <        int     nrows, ncols, ncomp;
17 <        int     dtype;
18 < } DMINFO;
19 > static char     rmx_mismatch_warn[] = "WARNING: data type mismatch\n";
20  
21   /* Allocate a nr x nc matrix with n components */
22   RMATRIX *
# Line 30 | Line 31 | rmx_alloc(int nr, int nc, int n)
31          if (dnew == NULL)
32                  return(NULL);
33          dnew->nrows = nr; dnew->ncols = nc; dnew->ncomp = n;
34 +        dnew->dtype = DTdouble;
35 +        dnew->info = NULL;
36          return(dnew);
37   }
38  
39 + /* Free a RMATRIX array */
40 + void
41 + rmx_free(RMATRIX *rm)
42 + {
43 +        if (!rm) return;
44 +        if (rm->info)
45 +                free(rm->info);
46 +        free(rm);
47 + }
48 +
49 + /* Resolve data type based on two input types (returns 0 for mismatch) */
50 + int
51 + rmx_newtype(int dtyp1, int dtyp2)
52 + {
53 +        if ((dtyp1==DTxyze) | (dtyp1==DTrgbe) |
54 +                        (dtyp2==DTxyze) | (dtyp2==DTrgbe)
55 +                        && dtyp1 != dtyp2)
56 +                return(0);
57 +        if (dtyp1 < dtyp2)
58 +                return(dtyp1);
59 +        return(dtyp2);
60 + }
61 +
62 + /* Append header information associated with matrix data */
63 + int
64 + rmx_addinfo(RMATRIX *rm, const char *info)
65 + {
66 +        if (!info || !*info)
67 +                return(0);
68 +        if (!rm->info) {
69 +                rm->info = (char *)malloc(strlen(info)+1);
70 +                if (rm->info) rm->info[0] = '\0';
71 +        } else
72 +                rm->info = (char *)realloc(rm->info,
73 +                                strlen(rm->info)+strlen(info)+1);
74 +        if (!rm->info)
75 +                return(0);
76 +        strcat(rm->info, info);
77 +        return(1);
78 + }
79 +
80   static int
81   get_dminfo(char *s, void *p)
82   {
83 <        DMINFO  *ip = (DMINFO *)p;
84 <        char    fmt[32];
83 >        RMATRIX *ip = (RMATRIX *)p;
84 >        char    fmt[MAXFMTLEN];
85          int     i;
86  
87 +        if (headidval(fmt, s))
88 +                return(0);
89          if (!strncmp(s, "NCOMP=", 6)) {
90                  ip->ncomp = atoi(s+6);
91                  return(0);
# Line 52 | Line 98 | get_dminfo(char *s, void *p)
98                  ip->ncols = atoi(s+6);
99                  return(0);
100          }
101 <        if (!formatval(fmt, s))
101 >        if (!formatval(fmt, s)) {
102 >                rmx_addinfo(ip, s);
103                  return(0);
104 +        }
105          for (i = 1; i < DTend; i++)
106                  if (!strcmp(fmt, cm_fmt_id[i])) {
107                          ip->dtype = i;
# Line 66 | Line 114 | static int
114   rmx_load_ascii(RMATRIX *rm, FILE *fp)
115   {
116          int     i, j, k;
117 < #ifdef _WIN32
70 <        _setmode(fileno(fp), _O_TEXT);
71 < #endif
117 >
118          for (i = 0; i < rm->nrows; i++)
119              for (j = 0; j < rm->ncols; j++)
120                  for (k = 0; k < rm->ncomp; k++)
# Line 89 | Line 135 | rmx_load_float(RMATRIX *rm, FILE *fp)
135          }
136          for (i = 0; i < rm->nrows; i++)
137              for (j = 0; j < rm->ncols; j++) {
138 <                if (fread(val, sizeof(val[0]), rm->ncomp, fp) != rm->ncomp)
138 >                if (getbinary(val, sizeof(val[0]), rm->ncomp, fp) != rm->ncomp)
139                      return(0);
140                  for (k = rm->ncomp; k--; )
141                       rmx_lval(rm,i,j,k) = val[k];
# Line 100 | Line 146 | rmx_load_float(RMATRIX *rm, FILE *fp)
146   static int
147   rmx_load_double(RMATRIX *rm, FILE *fp)
148   {
149 <        int     i, j, k;
104 <        double  val[100];
149 >        int     i, j;
150  
106 –        if (rm->ncomp > 100) {
107 –                fputs("Unsupported # components in rmx_load_double()\n", stderr);
108 –                exit(1);
109 –        }
151          for (i = 0; i < rm->nrows; i++)
152 <            for (j = 0; j < rm->ncols; j++) {
153 <                if (fread(val, sizeof(val[0]), rm->ncomp, fp) != rm->ncomp)
152 >            for (j = 0; j < rm->ncols; j++)
153 >                if (getbinary(&rmx_lval(rm,i,j,0), sizeof(double), rm->ncomp, fp) != rm->ncomp)
154                      return(0);
114 –                for (k = rm->ncomp; k--; )
115 –                     rmx_lval(rm,i,j,k) = val[k];
116 –            }
155          return(1);
156   }
157  
# Line 142 | Line 180 | rmx_load_rgbe(RMATRIX *rm, FILE *fp)
180  
181   /* Load matrix from supported file type */
182   RMATRIX *
183 < rmx_load(const char *fname)
183 > rmx_load(const char *inspec)
184   {
185          FILE            *fp = stdin;
186 <        DMINFO          dinfo;
186 >        RMATRIX         dinfo;
187          RMATRIX         *dnew;
188  
189 <        if (fname == NULL) {                    /* reading from stdin? */
190 <                fname = "<stdin>";
189 >        if (inspec == NULL) {                   /* reading from stdin? */
190 >                inspec = "<stdin>";
191 >                SET_FILE_BINARY(stdin);
192 >        } else if (inspec[0] == '!') {
193 >                if ((fp = popen(inspec+1, "r")) == NULL)
194 >                        return(NULL);
195 >                SET_FILE_BINARY(stdin);
196          } else {
197 <                const char      *sp = fname;    /* check suffix */
197 >                const char      *sp = inspec;   /* check suffix */
198                  while (*sp)
199                          ++sp;
200 <                while (sp > fname && sp[-1] != '.')
200 >                while (sp > inspec && sp[-1] != '.')
201                          --sp;
202                  if (!strcasecmp(sp, "XML")) {   /* assume it's a BSDF */
203 <                        CMATRIX *cm = cm_loadBTDF((char *)fname);
203 >                        CMATRIX *cm = cm_loadBTDF((char *)inspec);
204                          if (cm == NULL)
205                                  return(NULL);
206                          dnew = rmx_from_cmatrix(cm);
207                          cm_free(cm);
208 +                        dnew->dtype = DTascii;
209                          return(dnew);
210                  }
211                                                  /* else open it ourselves */
212 <                if ((fp = fopen(fname, "rb")) == NULL)
212 >                if ((fp = fopen(inspec, "rb")) == NULL)
213                          return(NULL);
214          }
215   #ifdef getc_unlocked
216          flockfile(fp);
217   #endif
218          dinfo.nrows = dinfo.ncols = dinfo.ncomp = 0;
219 <        dinfo.dtype = DTascii;
220 <        if (getheader(fp, &get_dminfo, &dinfo) < 0) {
219 >        dinfo.dtype = DTascii;                  /* assumed w/o FORMAT */
220 >        dinfo.info = NULL;
221 >        if (getheader(fp, get_dminfo, &dinfo) < 0) {
222                  fclose(fp);
223                  return(NULL);
224          }
225 <        if ((dinfo.dtype == DTrgbe) | (dinfo.dtype == DTxyze)) {
225 >        if ((dinfo.nrows <= 0) | (dinfo.ncols <= 0)) {
226                  if (!fscnresolu(&dinfo.ncols, &dinfo.nrows, fp)) {
227                          fclose(fp);
228                          return(NULL);
229                  }
230 <                dinfo.ncomp = 3;
230 >                if (dinfo.ncomp <= 0)
231 >                        dinfo.ncomp = 3;
232 >                else if ((dinfo.dtype == DTrgbe) | (dinfo.dtype == DTxyze) &&
233 >                                dinfo.ncomp != 3) {
234 >                        fclose(fp);
235 >                        return(NULL);
236 >                }
237          }
238          dnew = rmx_alloc(dinfo.nrows, dinfo.ncols, dinfo.ncomp);
239          if (dnew == NULL) {
240                  fclose(fp);
241                  return(NULL);
242          }
243 +        dnew->info = dinfo.info;
244          switch (dinfo.dtype) {
245          case DTascii:
246 +                SET_FILE_TEXT(stdin);
247                  if (!rmx_load_ascii(dnew, fp))
248                          goto loaderr;
249 +                dnew->dtype = DTascii;          /* should leave double? */
250                  break;
251          case DTfloat:
252                  if (!rmx_load_float(dnew, fp))
253                          goto loaderr;
254 +                dnew->dtype = DTfloat;
255                  break;
256          case DTdouble:
257                  if (!rmx_load_double(dnew, fp))
258                          goto loaderr;
259 +                dnew->dtype = DTdouble;
260                  break;
261          case DTrgbe:
262          case DTxyze:
263                  if (!rmx_load_rgbe(dnew, fp))
264                          goto loaderr;
265 +                dnew->dtype = dinfo.dtype;
266                  break;
267          default:
268                  goto loaderr;
269          }
270 <        if (fp != stdin)
271 <                fclose(fp);
270 >        if (fp != stdin) {
271 >                if (inspec[0] == '!')
272 >                        pclose(fp);
273 >                else
274 >                        fclose(fp);
275 >        }
276 > #ifdef getc_unlocked
277 >        else
278 >                funlockfile(fp);
279 > #endif
280          return(dnew);
281   loaderr:                                        /* should report error? */
282 <        fclose(fp);
282 >        if (inspec[0] == '!')
283 >                pclose(fp);
284 >        else
285 >                fclose(fp);
286          rmx_free(dnew);
287          return(NULL);
288   }
# Line 222 | Line 290 | loaderr:                                       /* should report error? */
290   static int
291   rmx_write_ascii(const RMATRIX *rm, FILE *fp)
292   {
293 +        const char      *fmt = (rm->dtype == DTfloat) ? " %.7e" :
294 +                        (rm->dtype == DTrgbe) | (rm->dtype == DTxyze) ? " %.3e" :
295 +                                " %.15e" ;
296          int     i, j, k;
297 < #ifdef _WIN32
227 <        _setmode(fileno(fp), _O_TEXT);
228 < #endif
297 >
298          for (i = 0; i < rm->nrows; i++) {
299              for (j = 0; j < rm->ncols; j++) {
300                  for (k = 0; k < rm->ncomp; k++)
301 <                    fprintf(fp, " %.15e", rmx_lval(rm,i,j,k));
301 >                    fprintf(fp, fmt, rmx_lval(rm,i,j,k));
302                  fputc('\t', fp);
303              }
304              fputc('\n', fp);
# Line 251 | Line 320 | rmx_write_float(const RMATRIX *rm, FILE *fp)
320              for (j = 0; j < rm->ncols; j++) {
321                  for (k = rm->ncomp; k--; )
322                      val[k] = (float)rmx_lval(rm,i,j,k);
323 <                if (fwrite(val, sizeof(val[0]), rm->ncomp, fp) != rm->ncomp)
323 >                if (putbinary(val, sizeof(val[0]), rm->ncomp, fp) != rm->ncomp)
324                          return(0);
325              }
326          return(1);
# Line 260 | Line 329 | rmx_write_float(const RMATRIX *rm, FILE *fp)
329   static int
330   rmx_write_double(const RMATRIX *rm, FILE *fp)
331   {
332 <        int     i, j, k;
264 <        double  val[100];
332 >        int     i, j;
333  
266 –        if (rm->ncomp > 100) {
267 –                fputs("Unsupported # components in rmx_write_double()\n", stderr);
268 –                exit(1);
269 –        }
334          for (i = 0; i < rm->nrows; i++)
335 <            for (j = 0; j < rm->ncols; j++) {
336 <                for (k = rm->ncomp; k--; )
273 <                    val[k] = rmx_lval(rm,i,j,k);
274 <                if (fwrite(val, sizeof(val[0]), rm->ncomp, fp) != rm->ncomp)
335 >            for (j = 0; j < rm->ncols; j++)
336 >                if (putbinary(&rmx_lval(rm,i,j,0), sizeof(double), rm->ncomp, fp) != rm->ncomp)
337                          return(0);
276 –            }
338          return(1);
339   }
340  
341   static int
342   rmx_write_rgbe(const RMATRIX *rm, FILE *fp)
343   {
344 <        COLOR   *scan = (COLOR *)malloc(sizeof(COLOR)*rm->ncols);
344 >        COLR    *scan = (COLR *)malloc(sizeof(COLR)*rm->ncols);
345          int     i, j;
346  
347          if (scan == NULL)
348                  return(0);
349          for (i = 0; i < rm->nrows; i++) {
350              for (j = rm->ncols; j--; )
351 <                setcolor(scan[j],       rmx_lval(rm,i,j,0),
351 >                setcolr(scan[j],        rmx_lval(rm,i,j,0),
352                                          rmx_lval(rm,i,j,1),
353                                          rmx_lval(rm,i,j,2)      );
354 <            if (fwritescan(scan, rm->ncols, fp) < 0) {
354 >            if (fwritecolrs(scan, rm->ncols, fp) < 0) {
355                  free(scan);
356                  return(0);
357              }
# Line 299 | Line 360 | rmx_write_rgbe(const RMATRIX *rm, FILE *fp)
360          return(1);
361   }
362  
363 < /* Write matrix to file type indicated by dt */
364 < long
363 > /* Write matrix to file type indicated by dtype */
364 > int
365   rmx_write(const RMATRIX *rm, int dtype, FILE *fp)
366   {
367          RMATRIX *mydm = NULL;
# Line 308 | Line 369 | rmx_write(const RMATRIX *rm, int dtype, FILE *fp)
369  
370          if ((rm == NULL) | (fp == NULL))
371                  return(0);
372 + #ifdef getc_unlocked
373 +        flockfile(fp);
374 + #endif
375                                                  /* complete header */
376 +        if (rm->info)
377 +                fputs(rm->info, fp);
378 +        if (dtype == DTfromHeader)
379 +                dtype = rm->dtype;
380 +        else if ((dtype == DTrgbe) & (rm->dtype == DTxyze))
381 +                dtype = DTxyze;
382 +        else if ((dtype == DTxyze) & (rm->dtype == DTrgbe))
383 +                dtype = DTrgbe;
384          if ((dtype != DTrgbe) & (dtype != DTxyze)) {
385                  fprintf(fp, "NROWS=%d\n", rm->nrows);
386                  fprintf(fp, "NCOLS=%d\n", rm->ncols);
# Line 344 | Line 416 | rmx_write(const RMATRIX *rm, int dtype, FILE *fp)
416                  return(0);
417          }
418          ok &= (fflush(fp) == 0);
419 + #ifdef getc_unlocked
420 +        funlockfile(fp);
421 + #endif
422          rmx_free(mydm);
423 <        return(ftell(fp) * ok);         /* return # bytes written */
423 >        return(ok);
424   }
425  
426   /* Allocate and assign square identity matrix with n components */
# Line 353 | Line 428 | RMATRIX *
428   rmx_identity(const int dim, const int n)
429   {
430          RMATRIX *rid = rmx_alloc(dim, dim, n);
431 <        int     i;
431 >        int     i, k;
432  
433          if (rid == NULL)
434                  return(NULL);
435 <        memset(rid->mtx, 0, sizeof(rid->mtx[0])*dim*dim);
435 >        memset(rid->mtx, 0, sizeof(rid->mtx[0])*n*dim*dim);
436          for (i = dim; i--; )
437 <                rmx_lval(rid,i,i,0) = 1;
438 <        for (i = n; --i; )
364 <                memcpy(rid->mtx+i*(dim*dim), rid->mtx,
365 <                                sizeof(rid->mtx[0])*dim*dim);
437 >            for (k = n; k--; )
438 >                rmx_lval(rid,i,i,k) = 1;
439          return(rid);
440   }
441  
# Line 377 | Line 450 | rmx_copy(const RMATRIX *rm)
450          dnew = rmx_alloc(rm->nrows, rm->ncols, rm->ncomp);
451          if (dnew == NULL)
452                  return(NULL);
453 +        rmx_addinfo(dnew, rm->info);
454 +        dnew->dtype = rm->dtype;
455          memcpy(dnew->mtx, rm->mtx,
456                  sizeof(rm->mtx[0])*rm->ncomp*rm->nrows*rm->ncols);
457          return(dnew);
# Line 391 | Line 466 | rmx_transpose(const RMATRIX *rm)
466  
467          if (rm == NULL)
468                  return(0);
469 +        if ((rm->nrows == 1) | (rm->ncols == 1)) {
470 +                dnew = rmx_copy(rm);
471 +                if (dnew == NULL)
472 +                        return(NULL);
473 +                dnew->nrows = rm->ncols;
474 +                dnew->ncols = rm->nrows;
475 +                return(dnew);
476 +        }
477          dnew = rmx_alloc(rm->ncols, rm->nrows, rm->ncomp);
478          if (dnew == NULL)
479                  return(NULL);
480 +        if (rm->info) {
481 +                rmx_addinfo(dnew, rm->info);
482 +                rmx_addinfo(dnew, "Transposed rows and columns\n");
483 +        }
484 +        dnew->dtype = rm->dtype;
485          for (i = dnew->nrows; i--; )
486              for (j = dnew->ncols; j--; )
487                  for (k = dnew->ncomp; k--; )
# Line 414 | Line 502 | rmx_multiply(const RMATRIX *m1, const RMATRIX *m2)
502          mres = rmx_alloc(m1->nrows, m2->ncols, m1->ncomp);
503          if (mres == NULL)
504                  return(NULL);
505 +        i = rmx_newtype(m1->dtype, m2->dtype);
506 +        if (i)
507 +                mres->dtype = i;
508 +        else
509 +                rmx_addinfo(mres, rmx_mismatch_warn);
510          for (i = mres->nrows; i--; )
511              for (j = mres->ncols; j--; )
512 <                for (h = m1->ncols; h--; ) {
512 >                for (k = mres->ncomp; k--; ) {
513                      long double d = 0;
514 <                    for (k = mres->ncomp; k--; )
515 <                        d += (long double)rmx_lval(m1,i,h,k) *
423 <                                (long double)rmx_lval(m2,h,j,k);
514 >                    for (h = m1->ncols; h--; )
515 >                        d += rmx_lval(m1,i,h,k) * rmx_lval(m2,h,j,k);
516                      rmx_lval(mres,i,j,k) = (double)d;
517                  }
518          return(mres);
519   }
520  
521 + /* Element-wise multiplication (or division) of m2 into m1 */
522 + int
523 + rmx_elemult(RMATRIX *m1, const RMATRIX *m2, int divide)
524 + {
525 +        int     zeroDivides = 0;
526 +        int     i, j, k;
527 +
528 +        if ((m1 == NULL) | (m2 == NULL) ||
529 +                        (m1->ncols != m2->ncols) | (m1->nrows != m2->nrows))
530 +                return(0);
531 +        if ((m2->ncomp > 1) & (m2->ncomp != m1->ncomp))
532 +                return(0);
533 +        i = rmx_newtype(m1->dtype, m2->dtype);
534 +        if (i)
535 +                m1->dtype = i;
536 +        else
537 +                rmx_addinfo(m1, rmx_mismatch_warn);
538 +        for (i = m1->nrows; i--; )
539 +            for (j = m1->ncols; j--; )
540 +                if (divide) {
541 +                    double      d;
542 +                    if (m2->ncomp == 1) {
543 +                        d = rmx_lval(m2,i,j,0);
544 +                        if (d == 0) {
545 +                            ++zeroDivides;
546 +                            for (k = m1->ncomp; k--; )
547 +                                rmx_lval(m1,i,j,k) = 0;
548 +                        } else {
549 +                            d = 1./d;
550 +                            for (k = m1->ncomp; k--; )
551 +                                rmx_lval(m1,i,j,k) *= d;
552 +                        }
553 +                    } else
554 +                        for (k = m1->ncomp; k--; ) {
555 +                            d = rmx_lval(m2,i,j,k);
556 +                            if (d == 0) {
557 +                                ++zeroDivides;
558 +                                rmx_lval(m1,i,j,k) = 0;
559 +                            } else
560 +                                rmx_lval(m1,i,j,k) /= d;
561 +                        }
562 +                } else {
563 +                    if (m2->ncomp == 1) {
564 +                        const double    d = rmx_lval(m2,i,j,0);
565 +                        for (k = m1->ncomp; k--; )
566 +                            rmx_lval(m1,i,j,k) *= d;
567 +                    } else
568 +                        for (k = m1->ncomp; k--; )
569 +                            rmx_lval(m1,i,j,k) *= rmx_lval(m2,i,j,k);
570 +                }
571 +        if (zeroDivides) {
572 +                fputs("Divide by zero in rmx_elemult()\n", stderr);
573 +                errno = ERANGE;
574 +        }
575 +        return(1);
576 + }
577 +
578   /* Sum second matrix into first, applying scale factor beforehand */
579   int
580   rmx_sum(RMATRIX *msum, const RMATRIX *madd, const double sf[])
# Line 446 | Line 595 | rmx_sum(RMATRIX *msum, const RMATRIX *madd, const doub
595                          mysf[k] = 1;
596                  sf = mysf;
597          }
598 +        i = rmx_newtype(msum->dtype, madd->dtype);
599 +        if (i)
600 +                msum->dtype = i;
601 +        else
602 +                rmx_addinfo(msum, rmx_mismatch_warn);
603          for (i = msum->nrows; i--; )
604              for (j = msum->ncols; j--; )
605                  for (k = msum->ncomp; k--; )
# Line 468 | Line 622 | rmx_scale(RMATRIX *rm, const double sf[])
622                  for (k = rm->ncomp; k--; )
623                      rmx_lval(rm,i,j,k) *= sf[k];
624  
625 +        if (rm->info)
626 +                rmx_addinfo(rm, "Applied scalar\n");
627          return(1);
628   }
629  
# Line 483 | Line 639 | rmx_transform(const RMATRIX *msrc, int n, const double
639          dnew = rmx_alloc(msrc->nrows, msrc->ncols, n);
640          if (dnew == NULL)
641                  return(NULL);
642 +        if (msrc->info) {
643 +                char    buf[128];
644 +                sprintf(buf, "Applied %dx%d matrix transform\n",
645 +                                dnew->ncomp, msrc->ncomp);
646 +                rmx_addinfo(dnew, msrc->info);
647 +                rmx_addinfo(dnew, buf);
648 +        }
649 +        dnew->dtype = msrc->dtype;
650          for (i = dnew->nrows; i--; )
651              for (j = dnew->ncols; j--; )
652                  for (kd = dnew->ncomp; kd--; ) {
# Line 506 | Line 670 | rmx_from_cmatrix(const CMATRIX *cm)
670          dnew = rmx_alloc(cm->nrows, cm->ncols, 3);
671          if (dnew == NULL)
672                  return(NULL);
673 +        dnew->dtype = DTfloat;
674          for (i = dnew->nrows; i--; )
675              for (j = dnew->ncols; j--; ) {
676                  const COLORV    *cv = cm_lval(cm,i,j);

Diff Legend

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