ViewVC Help
View File | Revision Log | Show Annotations | Download File | Root Listing
root/radiance/ray/src/util/rmatrix.c
Revision: 2.13
Committed: Mon May 4 20:53:21 2015 UTC (8 years, 11 months ago) by greg
Content type: text/plain
Branch: MAIN
Changes since 2.12: +28 -11 lines
Log Message:
Added the ability to read matrix inputs from commands as well as files

File Contents

# User Rev Content
1 greg 2.1 #ifndef lint
2 greg 2.13 static const char RCSid[] = "$Id: rmatrix.c,v 2.12 2015/01/23 01:14:20 greg Exp $";
3 greg 2.1 #endif
4     /*
5     * General matrix operations.
6     */
7    
8     #include <stdio.h>
9     #include <stdlib.h>
10     #include <string.h>
11     #include <fcntl.h>
12     #include "resolu.h"
13     #include "rmatrix.h"
14    
15 greg 2.6 static char rmx_mismatch_warn[] = "WARNING: data type mismatch\n";
16 greg 2.1
17     /* Allocate a nr x nc matrix with n components */
18     RMATRIX *
19     rmx_alloc(int nr, int nc, int n)
20     {
21     RMATRIX *dnew;
22    
23     if ((nr <= 0) | (nc <= 0) | (n <= 0))
24     return(NULL);
25     dnew = (RMATRIX *)malloc(sizeof(RMATRIX)-sizeof(dnew->mtx) +
26     sizeof(dnew->mtx[0])*(n*nr*nc));
27     if (dnew == NULL)
28     return(NULL);
29     dnew->nrows = nr; dnew->ncols = nc; dnew->ncomp = n;
30 greg 2.6 dnew->dtype = DTdouble;
31 greg 2.5 dnew->info = NULL;
32 greg 2.1 return(dnew);
33     }
34    
35 greg 2.6 /* Free a RMATRIX array */
36     void
37     rmx_free(RMATRIX *rm)
38     {
39     if (!rm) return;
40     if (rm->info)
41     free(rm->info);
42     free(rm);
43     }
44    
45     /* Resolve data type based on two input types (returns 0 for mismatch) */
46     int
47     rmx_newtype(int dtyp1, int dtyp2)
48     {
49     if ((dtyp1==DTxyze) | (dtyp1==DTrgbe) && dtyp1 != dtyp2)
50     return(0);
51     if (dtyp1 < dtyp2)
52     return(dtyp1);
53     return(dtyp2);
54     }
55    
56 greg 2.5 /* Append header information associated with matrix data */
57     int
58     rmx_addinfo(RMATRIX *rm, const char *info)
59     {
60     if (!info || !*info)
61     return(0);
62 greg 2.8 if (!rm->info) {
63 greg 2.5 rm->info = (char *)malloc(strlen(info)+1);
64 greg 2.8 if (rm->info) rm->info[0] = '\0';
65     } else
66 greg 2.5 rm->info = (char *)realloc(rm->info,
67     strlen(rm->info)+strlen(info)+1);
68     if (!rm->info)
69     return(0);
70     strcat(rm->info, info);
71     return(1);
72     }
73    
74 greg 2.1 static int
75     get_dminfo(char *s, void *p)
76     {
77 greg 2.6 RMATRIX *ip = (RMATRIX *)p;
78 greg 2.5 char fmt[64];
79 greg 2.1 int i;
80    
81 greg 2.6 if (headidval(fmt, s))
82     return(0);
83 greg 2.1 if (!strncmp(s, "NCOMP=", 6)) {
84     ip->ncomp = atoi(s+6);
85     return(0);
86     }
87     if (!strncmp(s, "NROWS=", 6)) {
88     ip->nrows = atoi(s+6);
89     return(0);
90     }
91     if (!strncmp(s, "NCOLS=", 6)) {
92     ip->ncols = atoi(s+6);
93     return(0);
94     }
95 greg 2.5 if (!formatval(fmt, s)) {
96 greg 2.6 rmx_addinfo(ip, s);
97 greg 2.1 return(0);
98 greg 2.5 }
99 greg 2.1 for (i = 1; i < DTend; i++)
100     if (!strcmp(fmt, cm_fmt_id[i])) {
101     ip->dtype = i;
102     return(0);
103     }
104     return(-1);
105     }
106    
107     static int
108     rmx_load_ascii(RMATRIX *rm, FILE *fp)
109     {
110     int i, j, k;
111     #ifdef _WIN32
112     _setmode(fileno(fp), _O_TEXT);
113     #endif
114     for (i = 0; i < rm->nrows; i++)
115     for (j = 0; j < rm->ncols; j++)
116     for (k = 0; k < rm->ncomp; k++)
117     if (fscanf(fp, "%lf", &rmx_lval(rm,i,j,k)) != 1)
118     return(0);
119     return(1);
120     }
121    
122     static int
123     rmx_load_float(RMATRIX *rm, FILE *fp)
124     {
125     int i, j, k;
126     float val[100];
127    
128     if (rm->ncomp > 100) {
129     fputs("Unsupported # components in rmx_load_float()\n", stderr);
130     exit(1);
131     }
132     for (i = 0; i < rm->nrows; i++)
133     for (j = 0; j < rm->ncols; j++) {
134     if (fread(val, sizeof(val[0]), rm->ncomp, fp) != rm->ncomp)
135     return(0);
136     for (k = rm->ncomp; k--; )
137     rmx_lval(rm,i,j,k) = val[k];
138     }
139     return(1);
140     }
141    
142     static int
143     rmx_load_double(RMATRIX *rm, FILE *fp)
144     {
145     int i, j, k;
146     double val[100];
147    
148     if (rm->ncomp > 100) {
149     fputs("Unsupported # components in rmx_load_double()\n", stderr);
150     exit(1);
151     }
152     for (i = 0; i < rm->nrows; i++)
153     for (j = 0; j < rm->ncols; j++) {
154     if (fread(val, sizeof(val[0]), rm->ncomp, fp) != rm->ncomp)
155     return(0);
156     for (k = rm->ncomp; k--; )
157     rmx_lval(rm,i,j,k) = val[k];
158     }
159     return(1);
160     }
161    
162     static int
163     rmx_load_rgbe(RMATRIX *rm, FILE *fp)
164     {
165     COLOR *scan = (COLOR *)malloc(sizeof(COLOR)*rm->ncols);
166     int i, j;
167    
168     if (scan == NULL)
169     return(0);
170     for (i = 0; i < rm->nrows; i++) {
171     if (freadscan(scan, rm->ncols, fp) < 0) {
172     free(scan);
173     return(0);
174     }
175     for (j = rm->ncols; j--; ) {
176     rmx_lval(rm,i,j,0) = colval(scan[j],RED);
177     rmx_lval(rm,i,j,1) = colval(scan[j],GRN);
178     rmx_lval(rm,i,j,2) = colval(scan[j],BLU);
179     }
180     }
181     free(scan);
182     return(1);
183     }
184    
185     /* Load matrix from supported file type */
186     RMATRIX *
187 greg 2.13 rmx_load(const char *inspec)
188 greg 2.1 {
189     FILE *fp = stdin;
190 greg 2.6 RMATRIX dinfo;
191 greg 2.1 RMATRIX *dnew;
192    
193 greg 2.13 if (inspec == NULL) { /* reading from stdin? */
194     inspec = "<stdin>";
195 greg 2.7 #ifdef _WIN32
196     _setmode(fileno(stdin), _O_BINARY);
197     #endif
198 greg 2.13 } else if (inspec[0] == '!') {
199     if ((fp = popen(inspec+1, "r")) == NULL)
200     return(NULL);
201     #ifdef _WIN32
202     _setmode(fileno(fp), _O_BINARY);
203     #endif
204 greg 2.1 } else {
205 greg 2.13 const char *sp = inspec; /* check suffix */
206 greg 2.1 while (*sp)
207     ++sp;
208 greg 2.13 while (sp > inspec && sp[-1] != '.')
209 greg 2.1 --sp;
210     if (!strcasecmp(sp, "XML")) { /* assume it's a BSDF */
211 greg 2.13 CMATRIX *cm = cm_loadBTDF((char *)inspec);
212 greg 2.1 if (cm == NULL)
213     return(NULL);
214     dnew = rmx_from_cmatrix(cm);
215     cm_free(cm);
216     return(dnew);
217     }
218     /* else open it ourselves */
219 greg 2.13 if ((fp = fopen(inspec, "rb")) == NULL)
220 greg 2.1 return(NULL);
221     }
222     #ifdef getc_unlocked
223     flockfile(fp);
224     #endif
225     dinfo.nrows = dinfo.ncols = dinfo.ncomp = 0;
226 greg 2.6 dinfo.dtype = DTascii; /* assumed w/o FORMAT */
227     dinfo.info = NULL;
228 greg 2.3 if (getheader(fp, get_dminfo, &dinfo) < 0) {
229 greg 2.1 fclose(fp);
230     return(NULL);
231     }
232 greg 2.4 if ((dinfo.nrows <= 0) | (dinfo.ncols <= 0)) {
233 greg 2.1 if (!fscnresolu(&dinfo.ncols, &dinfo.nrows, fp)) {
234     fclose(fp);
235     return(NULL);
236     }
237 greg 2.4 if (dinfo.ncomp <= 0)
238     dinfo.ncomp = 3;
239     else if ((dinfo.dtype == DTrgbe) | (dinfo.dtype == DTxyze) &&
240     dinfo.ncomp != 3) {
241     fclose(fp);
242     return(NULL);
243     }
244 greg 2.1 }
245     dnew = rmx_alloc(dinfo.nrows, dinfo.ncols, dinfo.ncomp);
246     if (dnew == NULL) {
247     fclose(fp);
248     return(NULL);
249     }
250 greg 2.6 dnew->info = dinfo.info;
251 greg 2.1 switch (dinfo.dtype) {
252     case DTascii:
253     if (!rmx_load_ascii(dnew, fp))
254     goto loaderr;
255 greg 2.11 dnew->dtype = DTascii; /* should leave double? */
256 greg 2.1 break;
257     case DTfloat:
258     if (!rmx_load_float(dnew, fp))
259     goto loaderr;
260 greg 2.6 dnew->dtype = DTfloat;
261 greg 2.1 break;
262     case DTdouble:
263     if (!rmx_load_double(dnew, fp))
264     goto loaderr;
265 greg 2.6 dnew->dtype = DTdouble;
266 greg 2.1 break;
267     case DTrgbe:
268     case DTxyze:
269     if (!rmx_load_rgbe(dnew, fp))
270     goto loaderr;
271 greg 2.6 dnew->dtype = dinfo.dtype;
272 greg 2.1 break;
273     default:
274     goto loaderr;
275     }
276 greg 2.13 if (fp != stdin) {
277     if (inspec[0] == '!')
278     pclose(fp);
279     else
280     fclose(fp);
281     }
282     #ifdef getc_unlocked
283     else
284     funlockfile(fp);
285     #endif
286 greg 2.1 return(dnew);
287     loaderr: /* should report error? */
288 greg 2.13 if (inspec[0] == '!')
289     pclose(fp);
290     else
291     fclose(fp);
292 greg 2.1 rmx_free(dnew);
293     return(NULL);
294     }
295    
296     static int
297     rmx_write_ascii(const RMATRIX *rm, FILE *fp)
298     {
299     int i, j, k;
300     #ifdef _WIN32
301     _setmode(fileno(fp), _O_TEXT);
302     #endif
303     for (i = 0; i < rm->nrows; i++) {
304     for (j = 0; j < rm->ncols; j++) {
305     for (k = 0; k < rm->ncomp; k++)
306     fprintf(fp, " %.15e", rmx_lval(rm,i,j,k));
307     fputc('\t', fp);
308     }
309     fputc('\n', fp);
310     }
311     return(1);
312     }
313    
314     static int
315     rmx_write_float(const RMATRIX *rm, FILE *fp)
316     {
317     int i, j, k;
318     float val[100];
319    
320     if (rm->ncomp > 100) {
321     fputs("Unsupported # components in rmx_write_float()\n", stderr);
322     exit(1);
323     }
324     for (i = 0; i < rm->nrows; i++)
325     for (j = 0; j < rm->ncols; j++) {
326     for (k = rm->ncomp; k--; )
327     val[k] = (float)rmx_lval(rm,i,j,k);
328     if (fwrite(val, sizeof(val[0]), rm->ncomp, fp) != rm->ncomp)
329     return(0);
330     }
331     return(1);
332     }
333    
334     static int
335     rmx_write_double(const RMATRIX *rm, FILE *fp)
336     {
337     int i, j, k;
338     double val[100];
339    
340     if (rm->ncomp > 100) {
341     fputs("Unsupported # components in rmx_write_double()\n", stderr);
342     exit(1);
343     }
344     for (i = 0; i < rm->nrows; i++)
345     for (j = 0; j < rm->ncols; j++) {
346     for (k = rm->ncomp; k--; )
347     val[k] = rmx_lval(rm,i,j,k);
348     if (fwrite(val, sizeof(val[0]), rm->ncomp, fp) != rm->ncomp)
349     return(0);
350     }
351     return(1);
352     }
353    
354     static int
355     rmx_write_rgbe(const RMATRIX *rm, FILE *fp)
356     {
357     COLOR *scan = (COLOR *)malloc(sizeof(COLOR)*rm->ncols);
358     int i, j;
359    
360     if (scan == NULL)
361     return(0);
362     for (i = 0; i < rm->nrows; i++) {
363     for (j = rm->ncols; j--; )
364     setcolor(scan[j], rmx_lval(rm,i,j,0),
365     rmx_lval(rm,i,j,1),
366     rmx_lval(rm,i,j,2) );
367     if (fwritescan(scan, rm->ncols, fp) < 0) {
368     free(scan);
369     return(0);
370     }
371     }
372     free(scan);
373     return(1);
374     }
375    
376 greg 2.6 /* Write matrix to file type indicated by dtype */
377 greg 2.10 int
378 greg 2.1 rmx_write(const RMATRIX *rm, int dtype, FILE *fp)
379     {
380     RMATRIX *mydm = NULL;
381     int ok = 1;
382    
383     if ((rm == NULL) | (fp == NULL))
384     return(0);
385     /* complete header */
386 greg 2.5 if (rm->info)
387     fputs(rm->info, fp);
388 greg 2.6 if (dtype == DTfromHeader)
389     dtype = rm->dtype;
390     else if ((dtype == DTrgbe) & (rm->dtype == DTxyze))
391     dtype = DTxyze;
392 greg 2.9 else if ((dtype == DTxyze) & (rm->dtype == DTrgbe))
393 greg 2.6 dtype = DTrgbe;
394 greg 2.1 if ((dtype != DTrgbe) & (dtype != DTxyze)) {
395     fprintf(fp, "NROWS=%d\n", rm->nrows);
396     fprintf(fp, "NCOLS=%d\n", rm->ncols);
397     fprintf(fp, "NCOMP=%d\n", rm->ncomp);
398     } else if (rm->ncomp != 3) { /* wrong # components? */
399     double cmtx[3];
400     if (rm->ncomp != 1) /* only convert grayscale */
401     return(0);
402     cmtx[0] = cmtx[1] = cmtx[2] = 1;
403     mydm = rmx_transform(rm, 3, cmtx);
404     if (mydm == NULL)
405     return(0);
406     rm = mydm;
407     }
408     fputformat((char *)cm_fmt_id[dtype], fp);
409     fputc('\n', fp);
410     switch (dtype) { /* write data */
411     case DTascii:
412     ok = rmx_write_ascii(rm, fp);
413     break;
414     case DTfloat:
415     ok = rmx_write_float(rm, fp);
416     break;
417     case DTdouble:
418     ok = rmx_write_double(rm, fp);
419     break;
420     case DTrgbe:
421     case DTxyze:
422     fprtresolu(rm->ncols, rm->nrows, fp);
423     ok = rmx_write_rgbe(rm, fp);
424     break;
425     default:
426     return(0);
427     }
428     ok &= (fflush(fp) == 0);
429     rmx_free(mydm);
430 greg 2.10 return(ok);
431 greg 2.1 }
432    
433     /* Allocate and assign square identity matrix with n components */
434     RMATRIX *
435     rmx_identity(const int dim, const int n)
436     {
437     RMATRIX *rid = rmx_alloc(dim, dim, n);
438 greg 2.12 int i, k;
439 greg 2.1
440     if (rid == NULL)
441     return(NULL);
442 greg 2.12 memset(rid->mtx, 0, sizeof(rid->mtx[0])*n*dim*dim);
443 greg 2.1 for (i = dim; i--; )
444 greg 2.12 for (k = n; k--; )
445     rmx_lval(rid,i,i,k) = 1;
446 greg 2.1 return(rid);
447     }
448    
449     /* Duplicate the given matrix */
450     RMATRIX *
451     rmx_copy(const RMATRIX *rm)
452     {
453     RMATRIX *dnew;
454    
455     if (rm == NULL)
456     return(NULL);
457     dnew = rmx_alloc(rm->nrows, rm->ncols, rm->ncomp);
458     if (dnew == NULL)
459     return(NULL);
460 greg 2.5 rmx_addinfo(dnew, rm->info);
461 greg 2.6 dnew->dtype = rm->dtype;
462 greg 2.1 memcpy(dnew->mtx, rm->mtx,
463     sizeof(rm->mtx[0])*rm->ncomp*rm->nrows*rm->ncols);
464     return(dnew);
465     }
466    
467 greg 2.2 /* Allocate and assign transposed matrix */
468     RMATRIX *
469     rmx_transpose(const RMATRIX *rm)
470 greg 2.1 {
471 greg 2.2 RMATRIX *dnew;
472 greg 2.1 int i, j, k;
473    
474     if (rm == NULL)
475     return(0);
476 greg 2.2 dnew = rmx_alloc(rm->ncols, rm->nrows, rm->ncomp);
477     if (dnew == NULL)
478     return(NULL);
479 greg 2.5 if (rm->info) {
480     rmx_addinfo(dnew, rm->info);
481     rmx_addinfo(dnew, "Transposed rows and columns\n");
482     }
483 greg 2.6 dnew->dtype = rm->dtype;
484 greg 2.2 for (i = dnew->nrows; i--; )
485     for (j = dnew->ncols; j--; )
486     for (k = dnew->ncomp; k--; )
487     rmx_lval(dnew,i,j,k) = rmx_lval(rm,j,i,k);
488     return(dnew);
489 greg 2.1 }
490    
491     /* Multiply (concatenate) two matrices and allocate the result */
492     RMATRIX *
493     rmx_multiply(const RMATRIX *m1, const RMATRIX *m2)
494     {
495     RMATRIX *mres;
496     int i, j, k, h;
497    
498     if ((m1 == NULL) | (m2 == NULL) ||
499     (m1->ncomp != m2->ncomp) | (m1->ncols != m2->nrows))
500     return(NULL);
501     mres = rmx_alloc(m1->nrows, m2->ncols, m1->ncomp);
502     if (mres == NULL)
503     return(NULL);
504 greg 2.6 i = rmx_newtype(m1->dtype, m2->dtype);
505     if (i)
506     mres->dtype = i;
507     else
508     rmx_addinfo(mres, rmx_mismatch_warn);
509 greg 2.1 for (i = mres->nrows; i--; )
510     for (j = mres->ncols; j--; )
511 greg 2.8 for (k = mres->ncomp; k--; ) {
512 greg 2.1 long double d = 0;
513 greg 2.8 for (h = m1->ncols; h--; )
514 greg 2.1 d += (long double)rmx_lval(m1,i,h,k) *
515     (long double)rmx_lval(m2,h,j,k);
516     rmx_lval(mres,i,j,k) = (double)d;
517     }
518     return(mres);
519     }
520    
521     /* Sum second matrix into first, applying scale factor beforehand */
522     int
523     rmx_sum(RMATRIX *msum, const RMATRIX *madd, const double sf[])
524     {
525     double *mysf = NULL;
526     int i, j, k;
527    
528     if ((msum == NULL) | (madd == NULL) ||
529     (msum->nrows != madd->nrows) |
530     (msum->ncols != madd->ncols) |
531     (msum->ncomp != madd->ncomp))
532     return(0);
533     if (sf == NULL) {
534     mysf = (double *)malloc(sizeof(double)*msum->ncomp);
535     if (mysf == NULL)
536     return(0);
537     for (k = msum->ncomp; k--; )
538     mysf[k] = 1;
539     sf = mysf;
540     }
541 greg 2.6 i = rmx_newtype(msum->dtype, madd->dtype);
542     if (i)
543     msum->dtype = i;
544     else
545     rmx_addinfo(msum, rmx_mismatch_warn);
546 greg 2.1 for (i = msum->nrows; i--; )
547     for (j = msum->ncols; j--; )
548     for (k = msum->ncomp; k--; )
549     rmx_lval(msum,i,j,k) += sf[k] * rmx_lval(madd,i,j,k);
550    
551     free(mysf);
552     return(1);
553     }
554    
555     /* Scale the given matrix by the indicated scalar component vector */
556     int
557     rmx_scale(RMATRIX *rm, const double sf[])
558     {
559     int i, j, k;
560    
561     if ((rm == NULL) | (sf == NULL))
562     return(0);
563     for (i = rm->nrows; i--; )
564     for (j = rm->ncols; j--; )
565     for (k = rm->ncomp; k--; )
566     rmx_lval(rm,i,j,k) *= sf[k];
567    
568     return(1);
569     }
570    
571     /* Allocate new matrix and apply component transformation */
572     RMATRIX *
573     rmx_transform(const RMATRIX *msrc, int n, const double cmat[])
574     {
575     int i, j, ks, kd;
576     RMATRIX *dnew;
577    
578     if ((msrc == NULL) | (n <= 0) | (cmat == NULL))
579     return(NULL);
580     dnew = rmx_alloc(msrc->nrows, msrc->ncols, n);
581     if (dnew == NULL)
582     return(NULL);
583 greg 2.6 dnew->dtype = msrc->dtype;
584 greg 2.1 for (i = dnew->nrows; i--; )
585     for (j = dnew->ncols; j--; )
586     for (kd = dnew->ncomp; kd--; ) {
587     double d = 0;
588     for (ks = msrc->ncomp; ks--; )
589     d += cmat[kd*msrc->ncomp + ks] * rmx_lval(msrc,i,j,ks);
590     rmx_lval(dnew,i,j,kd) = d;
591     }
592     return(dnew);
593     }
594    
595     /* Convert a color matrix to newly allocated RMATRIX buffer */
596     RMATRIX *
597     rmx_from_cmatrix(const CMATRIX *cm)
598     {
599     int i, j;
600     RMATRIX *dnew;
601    
602     if (cm == NULL)
603     return(NULL);
604     dnew = rmx_alloc(cm->nrows, cm->ncols, 3);
605     if (dnew == NULL)
606     return(NULL);
607 greg 2.6 dnew->dtype = DTfloat;
608 greg 2.1 for (i = dnew->nrows; i--; )
609     for (j = dnew->ncols; j--; ) {
610     const COLORV *cv = cm_lval(cm,i,j);
611     rmx_lval(dnew,i,j,0) = cv[0];
612     rmx_lval(dnew,i,j,1) = cv[1];
613     rmx_lval(dnew,i,j,2) = cv[2];
614     }
615     return(dnew);
616     }
617    
618     /* Convert general matrix to newly allocated CMATRIX buffer */
619     CMATRIX *
620     cm_from_rmatrix(const RMATRIX *rm)
621     {
622     int i, j;
623     CMATRIX *cnew;
624    
625     if (rm == NULL || rm->ncomp != 3)
626     return(NULL);
627     cnew = cm_alloc(rm->nrows, rm->ncols);
628     if (cnew == NULL)
629     return(NULL);
630     for (i = cnew->nrows; i--; )
631     for (j = cnew->ncols; j--; ) {
632     COLORV *cv = cm_lval(cnew,i,j);
633     cv[0] = (COLORV)rmx_lval(rm,i,j,0);
634     cv[1] = (COLORV)rmx_lval(rm,i,j,1);
635     cv[2] = (COLORV)rmx_lval(rm,i,j,2);
636     }
637     return(cnew);
638     }