src/util/cmatrix.c

#ifndef lint
static const char RCSid[] = "$Id: cmatrix.c,v 2.35 2022/04/27 01:31:56 greg Exp $";
#endif
/*
 * Color matrix routines.
 *
 *      G. Ward
 */

#include <ctype.h>
#include "platform.h"
#include "standard.h"
#include "cmatrix.h"
#include "platform.h"
#include "paths.h"
#include "resolu.h"

const char      stdin_name[] = "<stdin>";

const char      *cm_fmt_id[] = {
                        "unknown", COLRFMT, CIEFMT,
                        "float", "ascii", "double"
                };

const int       cm_elem_size[] = {
                        0, 4, 4, 3*sizeof(float), 0, 3*sizeof(double)
                };

/* Allocate a color coefficient matrix */
CMATRIX *
cm_alloc(int nrows, int ncols)
{
        CMATRIX *cm;

        if ((nrows <= 0) | (ncols <= 0))
                error(USER, "attempt to create empty matrix");
        cm = (CMATRIX *)malloc(sizeof(CMATRIX) +
                                sizeof(COLOR)*((size_t)nrows*ncols - 1));
        if (!cm)
                error(SYSTEM, "out of memory in cm_alloc()");
        cm->nrows = nrows;
        cm->ncols = ncols;
        return(cm);
}

static void
adjacent_ra_sizes(size_t bounds[2], size_t target)
{
        bounds[0] = 0; bounds[1] = 2048;
        while (bounds[1] < target) {
                bounds[0] = bounds[1];
                bounds[1] += bounds[1]>>1;
        }
}

/* Resize color coefficient matrix */
CMATRIX *
cm_resize(CMATRIX *cm, int nrows)
{
        size_t  old_size, new_size, ra_bounds[2];

        if (!cm)
                return(NULL);
        if (nrows == cm->nrows)
                return(cm);
        if (nrows <= 0) {
                cm_free(cm);
                return(NULL);
        }
        old_size = sizeof(CMATRIX) + sizeof(COLOR)*((size_t)cm->nrows*cm->ncols - 1);
        adjacent_ra_sizes(ra_bounds, old_size);
        new_size = sizeof(CMATRIX) + sizeof(COLOR)*((size_t)nrows*cm->ncols - 1);
        if (nrows < cm->nrows ? new_size <= ra_bounds[0] :
                                new_size > ra_bounds[1]) {
                adjacent_ra_sizes(ra_bounds, new_size);
                cm = (CMATRIX *)realloc(cm, ra_bounds[1]);
                if (!cm)
                        error(SYSTEM, "out of memory in cm_resize()");
        }
        cm->nrows = nrows;
        return(cm);
}

typedef struct {
        int     dtype;          /* data type */
        int     need2swap;      /* need byte swap? */
        int     nrows, ncols;   /* matrix size */
        COLOR   expos;          /* exposure value */
        char    *err;           /* error message */
} CMINFO;               /* header info record */

static int
get_cminfo(char *s, void *p)
{
        CMINFO  *ip = (CMINFO *)p;
        char    fmt[MAXFMTLEN];
        int     i;

        if (!strncmp(s, "NCOMP=", 6) && atoi(s+6) != 3) {
                ip->err = "unexpected # components (must be 3)";
                return(-1);
        }
        if (!strncmp(s, "NROWS=", 6)) {
                ip->nrows = atoi(s+6);
                return(0);
        }
        if (!strncmp(s, "NCOLS=", 6)) {
                ip->ncols = atoi(s+6);
                return(0);
        }
        if ((i = isbigendian(s)) >= 0) {
                ip->need2swap = (nativebigendian() != i);
                return(0);
        }
        if (isexpos(s)) {
                double  d = exposval(s);
                scalecolor(ip->expos, d);
                return(0);
        }
        if (iscolcor(s)) {
                COLOR   ctmp;
                colcorval(ctmp, s);
                multcolor(ip->expos, ctmp);
                return(0);
        }
        if (!formatval(fmt, s))
                return(0);
        for (i = 1; i < DTend; i++)
                if (!strcmp(fmt, cm_fmt_id[i]))
                        ip->dtype = i;
        return(0);
}

/* Load header to obtain/check data type and number of columns */
char *
cm_getheader(int *dt, int *nr, int *nc, int *swp, COLOR scale, FILE *fp)
{
        CMINFO  cmi;
                                                /* read header */
        cmi.dtype = DTfromHeader;
        cmi.need2swap = 0;
        cmi.expos[0] = cmi.expos[1] = cmi.expos[2] = 1.f;
        cmi.nrows = cmi.ncols = 0;
        cmi.err = "unexpected EOF in header";
        if (getheader(fp, get_cminfo, &cmi) < 0)
                return(cmi.err);
        if (dt) {                               /* get/check data type? */
                if (cmi.dtype == DTfromHeader) {
                        if (*dt == DTfromHeader)
                                return("missing/unknown data format in header");
                } else if (*dt == DTfromHeader)
                        *dt = cmi.dtype;
                else if (*dt != cmi.dtype)
                        return("unexpected data format in header");
        }
        if (nr) {                               /* get/check #rows? */
                if (*nr <= 0)
                        *nr = cmi.nrows;
                else if ((cmi.nrows > 0) & (*nr != cmi.nrows))
                        return("unexpected row count in header");
        }
        if (nc) {                               /* get/check #columns? */
                if (*nc <= 0)
                        *nc = cmi.ncols;
                else if ((cmi.ncols > 0) & (*nc != cmi.ncols))
                        return("unexpected column count in header");
        }
        if (swp)                                /* get/check swap? */
                *swp = cmi.need2swap;
        if (scale) {                            /* transfer exposure comp. */
                scale[0] = 1.f/cmi.expos[0];
                scale[1] = 1.f/cmi.expos[1];
                scale[2] = 1.f/cmi.expos[2];
        }
        return(NULL);
}

/* Allocate and load image data into matrix */
static CMATRIX *
cm_load_rgbe(FILE *fp, int nrows, int ncols, COLOR scale)
{
        int     doscale;
        CMATRIX *cm;
        COLORV  *mp;
                                                /* header already loaded */
        cm = cm_alloc(nrows, ncols);
        if (!cm)
                return(NULL);
        doscale = (scale[0] < .99) | (scale[0] > 1.01) |
                        (scale[1] < .99) | (scale[1] > 1.01) |
                        (scale[2] < .99) | (scale[2] > 1.01) ;
        mp = cm->cmem;
        while (nrows--) {
                if (freadscan((COLOR *)mp, ncols, fp) < 0) {
                        error(USER, "error reading color picture as matrix");
                        cm_free(cm);
                        return(NULL);
                }
                if (doscale) {
                        int     i = ncols;
                        while (i--) {
                                *mp++ *= scale[0];
                                *mp++ *= scale[1];
                                *mp++ *= scale[2];
                        }
                } else
                        mp += 3*ncols;
        }                                       /* caller closes stream */
        return(cm);
}

/* Allocate and load a matrix from the given input (or stdin if NULL) */
CMATRIX *
cm_load(const char *inspec, int nrows, int ncols, int dtype)
{
        const int       ROWINC = 2048;
        int             dimsOK = (dtype == DTascii) | (nrows > 0) && ncols;
        int             swap = 0;
        FILE            *fp;
        COLOR           scale;
        CMATRIX         *cm;

        if (!inspec)
                inspec = stdin_name;
        else if (!*inspec)
                return(NULL);
        if (inspec == stdin_name) {             /* reading from stdin? */
                fp = stdin;
        } else if (inspec[0] == '!') {
                fp = popen(inspec+1, "r");
                if (!fp) {
                        sprintf(errmsg, "cannot start command '%s'", inspec);
                        error(SYSTEM, errmsg);
                }
        } else if (!(fp = fopen(inspec, "r"))) {
                sprintf(errmsg, "cannot open file '%s'", inspec);
                error(SYSTEM, errmsg);
        }
#ifdef getc_unlocked
        flockfile(fp);
#endif
        if (dtype != DTascii)
                SET_FILE_BINARY(fp);            /* doesn't really work */
        if (!dtype | !dimsOK) {                 /* expecting header? */
                char    *err = cm_getheader(&dtype, &nrows, &ncols, &swap, scale, fp);
                if (err)
                        error(USER, err);
                dimsOK = ncols > 0 && ( nrows > 0 ||
                                (dtype != DTrgbe) & (dtype != DTxyze) );
        }
        if (!dimsOK && !fscnresolu(&ncols, &nrows, fp))
                error(USER, "unspecified matrix size");
        switch (dtype) {
        case DTascii:
        case DTfloat:
        case DTdouble:
                break;
        case DTrgbe:
        case DTxyze:
                cm = cm_load_rgbe(fp, nrows, ncols, scale);
                goto cleanup;
        default:
                error(USER, "unexpected data type in cm_load()");
        }
        if (nrows <= 0) {                       /* don't know length? */
                int     guessrows = 147;        /* usually big enough */
                if (cm_elem_size[dtype] && (fp != stdin) & (inspec[0] != '!')) {
                        long    startpos = ftell(fp);
                        if (fseek(fp, 0L, SEEK_END) == 0) {
                                long    rowsiz = (long)ncols*cm_elem_size[dtype];
                                long    endpos = ftell(fp);

                                if ((endpos - startpos) % rowsiz) {
                                        sprintf(errmsg,
                                        "improper length for binary file '%s'",
                                                        inspec);
                                        error(USER, errmsg);
                                }
                                guessrows = (endpos - startpos)/rowsiz;
                                if (fseek(fp, startpos, SEEK_SET) < 0) {
                                        sprintf(errmsg,
                                                "fseek() error on file '%s'",
                                                        inspec);
                                        error(SYSTEM, errmsg);
                                }
                                nrows = guessrows;      /* we're confident */
                        }
                }
                cm = cm_alloc(guessrows, ncols);
        } else
                cm = cm_alloc(nrows, ncols);
        if (!cm)                                        /* XXX never happens */
                return(NULL);
        if (dtype == DTascii) {                         /* read text file */
                int     maxrow = (nrows > 0 ? nrows : 32000);
                int     r, c;
                for (r = 0; r < maxrow; r++) {
                    if (r >= cm->nrows)                 /* need more space? */
                        cm = cm_resize(cm, cm->nrows+ROWINC);
                    for (c = 0; c < ncols; c++) {
                        COLORV  *cv = cm_lval(cm,r,c);
                        if (fscanf(fp, COLSPEC, cv, cv+1, cv+2) != 3) {
                                if ((nrows <= 0) & (r > 0) & !c) {
                                        cm = cm_resize(cm, maxrow=r);
                                        break;
                                } else
                                        goto EOFerror;
                        }
                    }
                }
                while ((c = getc(fp)) != EOF)
                        if (!isspace(c)) {
                                sprintf(errmsg,
                                "unexpected data at end of ascii input '%s'",
                                                inspec);
                                error(WARNING, errmsg);
                                break;
                        }
        } else {                                        /* read binary file */
                if (sizeof(COLOR) == cm_elem_size[dtype]) {
                        size_t  nread = 0;
                        do {                            /* read all we can */
                                nread += getbinary(cm->cmem + 3*nread,
                                                sizeof(COLOR),
                                                (size_t)cm->nrows*cm->ncols - nread,
                                                fp);
                                if (nrows <= 0) {       /* unknown length */
                                        if (nread == (size_t)cm->nrows*cm->ncols)
                                                        /* need more space? */
                                                cm = cm_resize(cm, cm->nrows+ROWINC);
                                        else if (nread && !(nread % cm->ncols))
                                                        /* seem to be  done */
                                                cm = cm_resize(cm, nread/cm->ncols);
                                        else            /* ended mid-row */
                                                goto EOFerror;
                                } else if (nread < (size_t)cm->nrows*cm->ncols)
                                        goto EOFerror;
                        } while (nread < (size_t)cm->nrows*cm->ncols);

                        if (swap) {
                                if (sizeof(COLORV) == 4)
                                        swap32((char *)cm->cmem,
                                                        3*(size_t)cm->nrows*cm->ncols);
                                else /* sizeof(COLORV) == 8 */
                                        swap64((char *)cm->cmem,
                                                        3*(size_t)cm->nrows*cm->ncols);
                        }
                } else if (dtype == DTdouble) {
                        double  dc[3];                  /* load from double */
                        COLORV  *cvp = cm->cmem;
                        size_t  n = (size_t)nrows*ncols;

                        if (n <= 0)
                                goto not_handled;
                        while (n--) {
                                if (getbinary(dc, sizeof(double), 3, fp) != 3)
                                        goto EOFerror;
                                if (swap) swap64((char *)dc, 3);
                                copycolor(cvp, dc);
                                cvp += 3;
                        }
                } else /* dtype == DTfloat */ {
                        float   fc[3];                  /* load from float */
                        COLORV  *cvp = cm->cmem;
                        size_t  n = (size_t)nrows*ncols;

                        if (n <= 0)
                                goto not_handled;
                        while (n--) {
                                if (getbinary(fc, sizeof(float), 3, fp) != 3)
                                        goto EOFerror;
                                if (swap) swap32((char *)fc, 3);
                                copycolor(cvp, fc);
                                cvp += 3;
                        }
                }
                if (fgetc(fp) != EOF) {
                                sprintf(errmsg,
                                "unexpected data at end of binary input '%s'",
                                                inspec);
                                error(WARNING, errmsg);
                }
        }
cleanup:
        if (fp != stdin) {
                if (inspec[0] != '!')
                        fclose(fp);
                else if (pclose(fp)) {
                        sprintf(errmsg, "error running command '%s'", inspec);
                        error(WARNING, errmsg);
                }
        }
#ifdef getc_unlocked
        else
                funlockfile(fp);
#endif
        return(cm);
EOFerror:
        sprintf(errmsg, "unexpected EOF reading %s", inspec);
        error(USER, errmsg);
        return(NULL);
not_handled:
        error(INTERNAL, "unhandled data size or length in cm_load()");
        return(NULL);   /* gratis return */
}

/* Extract a column vector from a matrix */
CMATRIX *
cm_column(const CMATRIX *cm, int c)
{
        CMATRIX *cvr;
        int     dr;

        if (!cm)
                return(NULL);
        if ((c < 0) | (c >= cm->ncols))
                error(INTERNAL, "column requested outside matrix");
        cvr = cm_alloc(cm->nrows, 1);
        if (!cvr)
                return(NULL);
        for (dr = 0; dr < cm->nrows; dr++) {
                const COLORV    *sp = cm_lval(cm,dr,c);
                COLORV          *dp = cv_lval(cvr,dr);
                dp[0] = sp[0];
                dp[1] = sp[1];
                dp[2] = sp[2];
        }
        return(cvr);
}

/* Multiply two matrices (or a matrix and a vector) and allocate the result */
CMATRIX *
cm_multiply(const CMATRIX *cm1, const CMATRIX *cm2)
{
        char    *rowcheck=NULL, *colcheck=NULL;
        CMATRIX *cmr;
        int     dr, dc, i;

        if (!cm1 | !cm2)
                return(NULL);
        if ((cm1->ncols <= 0) | (cm1->ncols != cm2->nrows))
                error(INTERNAL, "matrix dimension mismatch in cm_multiply()");
        cmr = cm_alloc(cm1->nrows, cm2->ncols);
        if (!cmr)
                return(NULL);
                                /* optimization: check for zero rows & cols */
        if (((cm1->nrows > 5) | (cm2->ncols > 5)) & (cm1->ncols > 5)) {
                static const COLOR      czero;
                rowcheck = (char *)calloc(cmr->nrows, 1);
                for (dr = cm1->nrows*(rowcheck != NULL); dr--; )
                    for (dc = cm1->ncols; dc--; )
                        if (memcmp(cm_lval(cm1,dr,dc), czero, sizeof(COLOR))) {
                                rowcheck[dr] = 1;
                                break;
                        }
                colcheck = (char *)calloc(cmr->ncols, 1);
                for (dc = cm2->ncols*(colcheck != NULL); dc--; )
                    for (dr = cm2->nrows; dr--; )
                        if (memcmp(cm_lval(cm2,dr,dc), czero, sizeof(COLOR))) {
                                colcheck[dc] = 1;
                                break;
                        }
        }
        for (dr = 0; dr < cmr->nrows; dr++)
            for (dc = 0; dc < cmr->ncols; dc++) {
                COLORV  *dp = cm_lval(cmr,dr,dc);
                double  res[3];
                dp[0] = dp[1] = dp[2] = 0;
                if (rowcheck && !rowcheck[dr])
                        continue;
                if (colcheck && !colcheck[dc])
                        continue;
                res[0] = res[1] = res[2] = 0;
                for (i = 0; i < cm1->ncols; i++) {
                    const COLORV        *cp1 = cm_lval(cm1,dr,i);
                    const COLORV        *cp2 = cm_lval(cm2,i,dc);
                    res[0] += (double)cp1[0] * cp2[0];
                    res[1] += (double)cp1[1] * cp2[1];
                    res[2] += (double)cp1[2] * cp2[2];
                }
                copycolor(dp, res);
            }
        if (rowcheck) free(rowcheck);
        if (colcheck) free(colcheck);
        return(cmr);
}

/* write out matrix to file (precede by resolution string if picture) */
int
cm_write(const CMATRIX *cm, int dtype, FILE *fp)
{
        static const char       tabEOL[2] = {'\t','\n'};
        const COLORV            *mp;
        int                     r, c;
        size_t                  n, rv;

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