ViewVC Help
View File | Revision Log | Show Annotations | Download File | Root Listing
root/radiance/ray/src/util/cmatrix.c
Revision: 2.22
Committed: Wed Aug 14 18:20:02 2019 UTC (4 years, 8 months ago) by greg
Content type: text/plain
Branch: MAIN
Changes since 2.21: +18 -3 lines
Log Message:
Added explicit byte-swap checks in headers using BigEndian= line

File Contents

# User Rev Content
1 greg 2.1 #ifndef lint
2 greg 2.22 static const char RCSid[] = "$Id: cmatrix.c,v 2.21 2019/08/12 18:28:37 greg Exp $";
3 greg 2.1 #endif
4     /*
5     * Color matrix routines.
6     *
7     * G. Ward
8     */
9    
10     #include <ctype.h>
11 schorsch 2.16 #include "platform.h"
12 greg 2.1 #include "standard.h"
13     #include "cmatrix.h"
14     #include "platform.h"
15 greg 2.14 #include "paths.h"
16 greg 2.2 #include "resolu.h"
17    
18     const char *cm_fmt_id[] = {
19 greg 2.8 "unknown", "ascii", COLRFMT, CIEFMT,
20     "float", "double"
21 greg 2.2 };
22    
23     const int cm_elem_size[] = {
24 greg 2.19 0, 0, 4, 4, 3*sizeof(float), 3*sizeof(double)
25 greg 2.2 };
26 greg 2.1
27     /* Allocate a color coefficient matrix */
28     CMATRIX *
29     cm_alloc(int nrows, int ncols)
30     {
31     CMATRIX *cm;
32    
33     if ((nrows <= 0) | (ncols <= 0))
34     error(USER, "attempt to create empty matrix");
35     cm = (CMATRIX *)malloc(sizeof(CMATRIX) +
36 greg 2.4 sizeof(COLOR)*(nrows*ncols - 1));
37 greg 2.21 if (!cm)
38 greg 2.1 error(SYSTEM, "out of memory in cm_alloc()");
39     cm->nrows = nrows;
40     cm->ncols = ncols;
41     return(cm);
42     }
43    
44 greg 2.6 static void
45     adjacent_ra_sizes(size_t bounds[2], size_t target)
46     {
47     bounds[0] = 0; bounds[1] = 2048;
48     while (bounds[1] < target) {
49     bounds[0] = bounds[1];
50     bounds[1] += bounds[1]>>1;
51     }
52     }
53    
54 greg 2.1 /* Resize color coefficient matrix */
55     CMATRIX *
56     cm_resize(CMATRIX *cm, int nrows)
57     {
58 greg 2.6 size_t old_size, new_size, ra_bounds[2];
59    
60 greg 2.21 if (!cm)
61     return(NULL);
62 greg 2.1 if (nrows == cm->nrows)
63     return(cm);
64     if (nrows <= 0) {
65     cm_free(cm);
66     return(NULL);
67     }
68 greg 2.6 old_size = sizeof(CMATRIX) + sizeof(COLOR)*(cm->nrows*cm->ncols - 1);
69     adjacent_ra_sizes(ra_bounds, old_size);
70     new_size = sizeof(CMATRIX) + sizeof(COLOR)*(nrows*cm->ncols - 1);
71     if (nrows < cm->nrows ? new_size <= ra_bounds[0] :
72     new_size > ra_bounds[1]) {
73     adjacent_ra_sizes(ra_bounds, new_size);
74     cm = (CMATRIX *)realloc(cm, ra_bounds[1]);
75 greg 2.21 if (!cm)
76 greg 2.6 error(SYSTEM, "out of memory in cm_resize()");
77     }
78 greg 2.1 cm->nrows = nrows;
79     return(cm);
80     }
81    
82 greg 2.5 typedef struct {
83     int dtype; /* data type */
84 greg 2.22 int need2swap; /* need byte swap? */
85 greg 2.5 int nrows, ncols; /* matrix size */
86     char *err; /* error message */
87     } CMINFO; /* header info record */
88    
89 greg 2.1 static int
90 greg 2.5 get_cminfo(char *s, void *p)
91 greg 2.1 {
92 greg 2.5 CMINFO *ip = (CMINFO *)p;
93 greg 2.20 char fmt[MAXFMTLEN];
94 greg 2.2 int i;
95 greg 2.5
96     if (!strncmp(s, "NCOMP=", 6) && atoi(s+6) != 3) {
97     ip->err = "unexpected # components (must be 3)";
98     return(-1);
99     }
100     if (!strncmp(s, "NROWS=", 6)) {
101     ip->nrows = atoi(s+6);
102     return(0);
103     }
104     if (!strncmp(s, "NCOLS=", 6)) {
105     ip->ncols = atoi(s+6);
106     return(0);
107     }
108 greg 2.22 if ((i = isbigendian(s)) >= 0) {
109     ip->need2swap = (nativebigendian() != i);
110     return(0);
111     }
112 greg 2.2 if (!formatval(fmt, s))
113     return(0);
114     for (i = 1; i < DTend; i++)
115     if (!strcmp(fmt, cm_fmt_id[i]))
116 greg 2.5 ip->dtype = i;
117 greg 2.1 return(0);
118     }
119    
120 greg 2.5 /* Load header to obtain/check data type and number of columns */
121     char *
122 greg 2.22 cm_getheader(int *dt, int *nr, int *nc, int *swp, FILE *fp)
123 greg 2.1 {
124 greg 2.5 CMINFO cmi;
125     /* read header */
126     cmi.dtype = DTfromHeader;
127 greg 2.22 cmi.need2swap = 0;
128 greg 2.5 cmi.nrows = cmi.ncols = 0;
129     cmi.err = "unexpected EOF in header";
130 greg 2.7 if (getheader(fp, get_cminfo, &cmi) < 0)
131 greg 2.5 return(cmi.err);
132 greg 2.21 if (dt) { /* get/check data type? */
133 greg 2.5 if (cmi.dtype == DTfromHeader) {
134     if (*dt == DTfromHeader)
135     return("missing/unknown data format in header");
136     } else if (*dt == DTfromHeader)
137     *dt = cmi.dtype;
138     else if (*dt != cmi.dtype)
139     return("unexpected data format in header");
140     }
141 greg 2.21 if (nr) { /* get/check #rows? */
142 greg 2.5 if (*nr <= 0)
143     *nr = cmi.nrows;
144     else if ((cmi.nrows > 0) & (*nr != cmi.nrows))
145     return("unexpected row count in header");
146     }
147 greg 2.21 if (nc) { /* get/check #columns? */
148 greg 2.5 if (*nc <= 0)
149     *nc = cmi.ncols;
150     else if ((cmi.ncols > 0) & (*nc != cmi.ncols))
151     return("unexpected column count in header");
152     }
153 greg 2.22 if (swp) /* get/check swap? */
154     *swp = cmi.need2swap;
155 greg 2.5 return(NULL);
156 greg 2.1 }
157    
158 greg 2.9 /* Allocate and load a matrix from the given input (or stdin if NULL) */
159 greg 2.1 CMATRIX *
160 greg 2.9 cm_load(const char *inspec, int nrows, int ncols, int dtype)
161 greg 2.1 {
162 greg 2.15 const int ROWINC = 2048;
163     FILE *fp = stdin;
164 greg 2.22 int swap = 0;
165 greg 2.15 CMATRIX *cm;
166 greg 2.1
167 greg 2.21 if (!inspec)
168 greg 2.9 inspec = "<stdin>";
169     else if (inspec[0] == '!') {
170     fp = popen(inspec+1, "r");
171 greg 2.21 if (!fp) {
172 greg 2.9 sprintf(errmsg, "cannot start command '%s'", inspec);
173     error(SYSTEM, errmsg);
174     }
175 greg 2.21 } else if (!(fp = fopen(inspec, "r"))) {
176 greg 2.9 sprintf(errmsg, "cannot open file '%s'", inspec);
177 greg 2.1 error(SYSTEM, errmsg);
178     }
179     #ifdef getc_unlocked
180     flockfile(fp);
181     #endif
182     if (dtype != DTascii)
183     SET_FILE_BINARY(fp); /* doesn't really work */
184 greg 2.5 if (!dtype | !ncols) { /* expecting header? */
185 greg 2.22 char *err = cm_getheader(&dtype, &nrows, &ncols, &swap, fp);
186 greg 2.21 if (err)
187 greg 2.5 error(USER, err);
188     if (ncols <= 0)
189     error(USER, "unspecified number of columns");
190     }
191 greg 2.1 switch (dtype) {
192     case DTascii:
193     case DTfloat:
194     case DTdouble:
195     break;
196     default:
197     error(USER, "unexpected data type in cm_load()");
198     }
199     if (nrows <= 0) { /* don't know length? */
200     int guessrows = 147; /* usually big enough */
201 greg 2.9 if ((dtype != DTascii) & (fp != stdin) & (inspec[0] != '!')) {
202 greg 2.1 long startpos = ftell(fp);
203     if (fseek(fp, 0L, SEEK_END) == 0) {
204     long endpos = ftell(fp);
205     long elemsiz = 3*(dtype==DTfloat ?
206     sizeof(float) : sizeof(double));
207    
208     if ((endpos - startpos) % (ncols*elemsiz)) {
209     sprintf(errmsg,
210     "improper length for binary file '%s'",
211 greg 2.9 inspec);
212 greg 2.1 error(USER, errmsg);
213     }
214     guessrows = (endpos - startpos)/(ncols*elemsiz);
215     if (fseek(fp, startpos, SEEK_SET) < 0) {
216     sprintf(errmsg,
217     "fseek() error on file '%s'",
218 greg 2.9 inspec);
219 greg 2.1 error(SYSTEM, errmsg);
220     }
221     nrows = guessrows; /* we're confident */
222     }
223     }
224     cm = cm_alloc(guessrows, ncols);
225     } else
226     cm = cm_alloc(nrows, ncols);
227 greg 2.21 if (!cm) /* XXX never happens */
228 greg 2.1 return(NULL);
229     if (dtype == DTascii) { /* read text file */
230     int maxrow = (nrows > 0 ? nrows : 32000);
231     int r, c;
232     for (r = 0; r < maxrow; r++) {
233     if (r >= cm->nrows) /* need more space? */
234 greg 2.15 cm = cm_resize(cm, cm->nrows+ROWINC);
235 greg 2.1 for (c = 0; c < ncols; c++) {
236     COLORV *cv = cm_lval(cm,r,c);
237 greg 2.13 if (fscanf(fp, COLSPEC, cv, cv+1, cv+2) != 3) {
238 greg 2.1 if ((nrows <= 0) & (r > 0) & !c) {
239     cm = cm_resize(cm, maxrow=r);
240     break;
241     } else
242     goto EOFerror;
243 greg 2.13 }
244 greg 2.1 }
245     }
246     while ((c = getc(fp)) != EOF)
247     if (!isspace(c)) {
248     sprintf(errmsg,
249 greg 2.9 "unexpected data at end of ascii input '%s'",
250     inspec);
251 greg 2.1 error(WARNING, errmsg);
252     break;
253     }
254     } else { /* read binary file */
255 greg 2.2 if (sizeof(COLOR) == cm_elem_size[dtype]) {
256 greg 2.1 int nread = 0;
257     do { /* read all we can */
258 greg 2.17 nread += getbinary(cm->cmem + 3*nread,
259 greg 2.4 sizeof(COLOR),
260 greg 2.1 cm->nrows*cm->ncols - nread,
261     fp);
262     if (nrows <= 0) { /* unknown length */
263     if (nread == cm->nrows*cm->ncols)
264     /* need more space? */
265 greg 2.15 cm = cm_resize(cm, cm->nrows+ROWINC);
266 greg 2.1 else if (nread && !(nread % cm->ncols))
267     /* seem to be done */
268     cm = cm_resize(cm, nread/cm->ncols);
269     else /* ended mid-row */
270     goto EOFerror;
271     } else if (nread < cm->nrows*cm->ncols)
272     goto EOFerror;
273     } while (nread < cm->nrows*cm->ncols);
274    
275     } else if (dtype == DTdouble) {
276     double dc[3]; /* load from double */
277     COLORV *cvp = cm->cmem;
278     int n = nrows*ncols;
279    
280     if (n <= 0)
281     goto not_handled;
282     while (n--) {
283 greg 2.17 if (getbinary(dc, sizeof(double), 3, fp) != 3)
284 greg 2.1 goto EOFerror;
285     copycolor(cvp, dc);
286     cvp += 3;
287     }
288     } else /* dtype == DTfloat */ {
289     float fc[3]; /* load from float */
290     COLORV *cvp = cm->cmem;
291     int n = nrows*ncols;
292    
293     if (n <= 0)
294     goto not_handled;
295     while (n--) {
296 greg 2.17 if (getbinary(fc, sizeof(float), 3, fp) != 3)
297 greg 2.1 goto EOFerror;
298     copycolor(cvp, fc);
299     cvp += 3;
300     }
301     }
302     if (fgetc(fp) != EOF) {
303     sprintf(errmsg,
304 greg 2.9 "unexpected data at end of binary input '%s'",
305     inspec);
306 greg 2.1 error(WARNING, errmsg);
307     }
308     }
309 greg 2.22 if (swap) {
310     if (dtype == DTfloat)
311     swap32((char *)cm->cmem, 3*cm->nrows*cm->ncols);
312     else if (dtype == DTdouble)
313     swap64((char *)cm->cmem, 3*cm->nrows*cm->ncols);
314     }
315 greg 2.9 if (fp != stdin) {
316     if (inspec[0] != '!')
317     fclose(fp);
318     else if (pclose(fp)) {
319     sprintf(errmsg, "error running command '%s'", inspec);
320     error(WARNING, errmsg);
321     }
322     }
323 greg 2.1 #ifdef getc_unlocked
324     else
325     funlockfile(fp);
326     #endif
327     return(cm);
328     EOFerror:
329 greg 2.9 sprintf(errmsg, "unexpected EOF reading %s", inspec);
330 greg 2.1 error(USER, errmsg);
331     not_handled:
332     error(INTERNAL, "unhandled data size or length in cm_load()");
333     return(NULL); /* gratis return */
334     }
335    
336     /* Extract a column vector from a matrix */
337     CMATRIX *
338     cm_column(const CMATRIX *cm, int c)
339     {
340     CMATRIX *cvr;
341     int dr;
342    
343 greg 2.21 if (!cm)
344     return(NULL);
345 greg 2.1 if ((c < 0) | (c >= cm->ncols))
346     error(INTERNAL, "column requested outside matrix");
347     cvr = cm_alloc(cm->nrows, 1);
348 greg 2.21 if (!cvr)
349 greg 2.1 return(NULL);
350     for (dr = 0; dr < cm->nrows; dr++) {
351     const COLORV *sp = cm_lval(cm,dr,c);
352     COLORV *dp = cv_lval(cvr,dr);
353     dp[0] = sp[0];
354     dp[1] = sp[1];
355     dp[2] = sp[2];
356     }
357     return(cvr);
358     }
359    
360     /* Multiply two matrices (or a matrix and a vector) and allocate the result */
361     CMATRIX *
362     cm_multiply(const CMATRIX *cm1, const CMATRIX *cm2)
363     {
364     char *rowcheck=NULL, *colcheck=NULL;
365     CMATRIX *cmr;
366     int dr, dc, i;
367    
368 greg 2.21 if (!cm1 | !cm2)
369     return(NULL);
370 greg 2.1 if ((cm1->ncols <= 0) | (cm1->ncols != cm2->nrows))
371     error(INTERNAL, "matrix dimension mismatch in cm_multiply()");
372     cmr = cm_alloc(cm1->nrows, cm2->ncols);
373 greg 2.21 if (!cmr)
374 greg 2.1 return(NULL);
375     /* optimization: check for zero rows & cols */
376     if (((cm1->nrows > 5) | (cm2->ncols > 5)) & (cm1->ncols > 5)) {
377     static const COLOR czero;
378     rowcheck = (char *)calloc(cmr->nrows, 1);
379     for (dr = cm1->nrows*(rowcheck != NULL); dr--; )
380     for (dc = cm1->ncols; dc--; )
381     if (memcmp(cm_lval(cm1,dr,dc), czero, sizeof(COLOR))) {
382     rowcheck[dr] = 1;
383     break;
384     }
385     colcheck = (char *)calloc(cmr->ncols, 1);
386     for (dc = cm2->ncols*(colcheck != NULL); dc--; )
387     for (dr = cm2->nrows; dr--; )
388     if (memcmp(cm_lval(cm2,dr,dc), czero, sizeof(COLOR))) {
389     colcheck[dc] = 1;
390     break;
391     }
392     }
393     for (dr = 0; dr < cmr->nrows; dr++)
394     for (dc = 0; dc < cmr->ncols; dc++) {
395     COLORV *dp = cm_lval(cmr,dr,dc);
396 greg 2.4 double res[3];
397 greg 2.1 dp[0] = dp[1] = dp[2] = 0;
398 greg 2.21 if (rowcheck && !rowcheck[dr])
399 greg 2.1 continue;
400 greg 2.21 if (colcheck && !colcheck[dc])
401 greg 2.1 continue;
402 greg 2.4 res[0] = res[1] = res[2] = 0;
403 greg 2.1 for (i = 0; i < cm1->ncols; i++) {
404     const COLORV *cp1 = cm_lval(cm1,dr,i);
405     const COLORV *cp2 = cm_lval(cm2,i,dc);
406 greg 2.18 res[0] += (double)cp1[0] * cp2[0];
407     res[1] += (double)cp1[1] * cp2[1];
408     res[2] += (double)cp1[2] * cp2[2];
409 greg 2.1 }
410 greg 2.4 copycolor(dp, res);
411 greg 2.1 }
412 greg 2.21 if (rowcheck) free(rowcheck);
413     if (colcheck) free(colcheck);
414 greg 2.1 return(cmr);
415     }
416    
417 greg 2.2 /* write out matrix to file (precede by resolution string if picture) */
418     int
419     cm_write(const CMATRIX *cm, int dtype, FILE *fp)
420 greg 2.1 {
421 greg 2.3 static const char tabEOL[2] = {'\t','\n'};
422 greg 2.21 const COLORV *mp;
423 greg 2.3 int r, c;
424 greg 2.2
425 greg 2.21 if (!cm)
426     return(0);
427     mp = cm->cmem;
428 greg 2.2 switch (dtype) {
429     case DTascii:
430 greg 2.3 for (r = 0; r < cm->nrows; r++)
431 greg 2.2 for (c = 0; c < cm->ncols; c++, mp += 3)
432 greg 2.3 fprintf(fp, "%.6e %.6e %.6e%c",
433     mp[0], mp[1], mp[2],
434     tabEOL[c >= cm->ncols-1]);
435 greg 2.2 break;
436     case DTfloat:
437     case DTdouble:
438     if (sizeof(COLOR) == cm_elem_size[dtype]) {
439     r = cm->ncols*cm->nrows;
440     while (r > 0) {
441 greg 2.17 c = putbinary(mp, sizeof(COLOR), r, fp);
442 greg 2.2 if (c <= 0)
443     return(0);
444     mp += 3*c;
445     r -= c;
446     }
447     } else if (dtype == DTdouble) {
448     double dc[3];
449     r = cm->ncols*cm->nrows;
450     while (r--) {
451     copycolor(dc, mp);
452 greg 2.17 if (putbinary(dc, sizeof(double), 3, fp) != 3)
453 greg 2.2 return(0);
454     mp += 3;
455     }
456     } else /* dtype == DTfloat */ {
457     float fc[3];
458     r = cm->ncols*cm->nrows;
459     while (r--) {
460     copycolor(fc, mp);
461 greg 2.17 if (putbinary(fc, sizeof(float), 3, fp) != 3)
462 greg 2.2 return(0);
463     mp += 3;
464     }
465     }
466     break;
467     case DTrgbe:
468     case DTxyze:
469     fprtresolu(cm->ncols, cm->nrows, fp);
470     for (r = 0; r < cm->nrows; r++, mp += 3*cm->ncols)
471     if (fwritescan((COLOR *)mp, cm->ncols, fp) < 0)
472     return(0);
473     break;
474     default:
475     fputs("Unsupported data type in cm_write()!\n", stderr);
476     return(0);
477 greg 2.1 }
478 greg 2.2 return(fflush(fp) == 0);
479 greg 2.1 }