ViewVC Help
View File | Revision Log | Show Annotations | Download File | Root Listing
root/radiance/ray/src/util/rmatrix.c
Revision: 2.20
Committed: Sun Mar 6 01:13:18 2016 UTC (8 years, 1 month ago) by schorsch
Content type: text/plain
Branch: MAIN
Changes since 2.19: +5 -4 lines
Log Message:
Prepare for SCons build on Win32 and Win64

File Contents

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