src/util/rmatrix.c

#ifndef lint
static const char RCSid[] = "$Id: rmatrix.c,v 2.10 2014/09/18 23:20:12 greg Exp $";
#endif
/*
 * General matrix operations.
 */

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <fcntl.h>
#include "resolu.h"
#include "rmatrix.h"

static char     rmx_mismatch_warn[] = "WARNING: data type mismatch\n";

/* Allocate a nr x nc matrix with n components */
RMATRIX *
rmx_alloc(int nr, int nc, int n)
{
        RMATRIX *dnew;

        if ((nr <= 0) | (nc <= 0) | (n <= 0))
                return(NULL);
        dnew = (RMATRIX *)malloc(sizeof(RMATRIX)-sizeof(dnew->mtx) +
                                        sizeof(dnew->mtx[0])*(n*nr*nc));
        if (dnew == NULL)
                return(NULL);
        dnew->nrows = nr; dnew->ncols = nc; dnew->ncomp = n;
        dnew->dtype = DTdouble;
        dnew->info = NULL;
        return(dnew);
}

/* Free a RMATRIX array */
void
rmx_free(RMATRIX *rm)
{
        if (!rm) return;
        if (rm->info)
                free(rm->info);
        free(rm);
}

/* Resolve data type based on two input types (returns 0 for mismatch) */
int
rmx_newtype(int dtyp1, int dtyp2)
{
        if ((dtyp1==DTxyze) | (dtyp1==DTrgbe) && dtyp1 != dtyp2)
                return(0);
        if (dtyp1 < dtyp2)
                return(dtyp1);
        return(dtyp2);
}

/* Append header information associated with matrix data */
int
rmx_addinfo(RMATRIX *rm, const char *info)
{
        if (!info || !*info)
                return(0);
        if (!rm->info) {
                rm->info = (char *)malloc(strlen(info)+1);
                if (rm->info) rm->info[0] = '\0';
        } else
                rm->info = (char *)realloc(rm->info,
                                strlen(rm->info)+strlen(info)+1);
        if (!rm->info)
                return(0);
        strcat(rm->info, info);
        return(1);
}

static int
get_dminfo(char *s, void *p)
{
        RMATRIX *ip = (RMATRIX *)p;
        char    fmt[64];
        int     i;

        if (headidval(fmt, s))
                return(0);
        if (!strncmp(s, "NCOMP=", 6)) {
                ip->ncomp = atoi(s+6);
                return(0);
        }
        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 (!formatval(fmt, s)) {
                rmx_addinfo(ip, s);
                return(0);
        }
        for (i = 1; i < DTend; i++)
                if (!strcmp(fmt, cm_fmt_id[i])) {
                        ip->dtype = i;
                        return(0);
                }
        return(-1);
}

static int
rmx_load_ascii(RMATRIX *rm, FILE *fp)
{
        int     i, j, k;
#ifdef _WIN32
        _setmode(fileno(fp), _O_TEXT);
#endif
        for (i = 0; i < rm->nrows; i++)
            for (j = 0; j < rm->ncols; j++)
                for (k = 0; k < rm->ncomp; k++)
                    if (fscanf(fp, "%lf", &rmx_lval(rm,i,j,k)) != 1)
                        return(0);
        return(1);
}

static int
rmx_load_float(RMATRIX *rm, FILE *fp)
{
        int     i, j, k;
        float   val[100];

        if (rm->ncomp > 100) {
                fputs("Unsupported # components in rmx_load_float()\n", stderr);
                exit(1);
        }
        for (i = 0; i < rm->nrows; i++)
            for (j = 0; j < rm->ncols; j++) {
                if (fread(val, sizeof(val[0]), rm->ncomp, fp) != rm->ncomp)
                    return(0);
                for (k = rm->ncomp; k--; )
                     rmx_lval(rm,i,j,k) = val[k];
            }
        return(1);
}

static int
rmx_load_double(RMATRIX *rm, FILE *fp)
{
        int     i, j, k;
        double  val[100];

        if (rm->ncomp > 100) {
                fputs("Unsupported # components in rmx_load_double()\n", stderr);
                exit(1);
        }
        for (i = 0; i < rm->nrows; i++)
            for (j = 0; j < rm->ncols; j++) {
                if (fread(val, sizeof(val[0]), rm->ncomp, fp) != rm->ncomp)
                    return(0);
                for (k = rm->ncomp; k--; )
                     rmx_lval(rm,i,j,k) = val[k];
            }
        return(1);
}

static int
rmx_load_rgbe(RMATRIX *rm, FILE *fp)
{
        COLOR   *scan = (COLOR *)malloc(sizeof(COLOR)*rm->ncols);
        int     i, j;

        if (scan == NULL)
                return(0);
        for (i = 0; i < rm->nrows; i++) {
            if (freadscan(scan, rm->ncols, fp) < 0) {
                free(scan);
                return(0);
            }
            for (j = rm->ncols; j--; ) {
                rmx_lval(rm,i,j,0) = colval(scan[j],RED);
                rmx_lval(rm,i,j,1) = colval(scan[j],GRN);
                rmx_lval(rm,i,j,2) = colval(scan[j],BLU);
            }
        }
        free(scan);
        return(1);
}

/* Load matrix from supported file type */
RMATRIX *
rmx_load(const char *fname)
{
        FILE            *fp = stdin;
        RMATRIX         dinfo;
        RMATRIX         *dnew;

        if (fname == NULL) {                    /* reading from stdin? */
                fname = "<stdin>";
#ifdef _WIN32
                _setmode(fileno(stdin), _O_BINARY);
#endif
        } else {
                const char      *sp = fname;    /* check suffix */
                while (*sp)
                        ++sp;
                while (sp > fname && sp[-1] != '.')
                        --sp;
                if (!strcasecmp(sp, "XML")) {   /* assume it's a BSDF */
                        CMATRIX *cm = cm_loadBTDF((char *)fname);
                        if (cm == NULL)
                                return(NULL);
                        dnew = rmx_from_cmatrix(cm);
                        cm_free(cm);
                        return(dnew);
                }
                                                /* else open it ourselves */
                if ((fp = fopen(fname, "rb")) == NULL)
                        return(NULL);
        }
#ifdef getc_unlocked
        flockfile(fp);
#endif
        dinfo.nrows = dinfo.ncols = dinfo.ncomp = 0;
        dinfo.dtype = DTascii;                  /* assumed w/o FORMAT */
        dinfo.info = NULL;
        if (getheader(fp, get_dminfo, &dinfo) < 0) {
                fclose(fp);
                return(NULL);
        }
        if ((dinfo.nrows <= 0) | (dinfo.ncols <= 0)) {
                if (!fscnresolu(&dinfo.ncols, &dinfo.nrows, fp)) {
                        fclose(fp);
                        return(NULL);
                }
                if (dinfo.ncomp <= 0)
                        dinfo.ncomp = 3;
                else if ((dinfo.dtype == DTrgbe) | (dinfo.dtype == DTxyze) &&
                                dinfo.ncomp != 3) {
                        fclose(fp);
                        return(NULL);
                }
        }
        dnew = rmx_alloc(dinfo.nrows, dinfo.ncols, dinfo.ncomp);
        if (dnew == NULL) {
                fclose(fp);
                return(NULL);
        }
        dnew->info = dinfo.info;
        switch (dinfo.dtype) {
        case DTascii:
                if (!rmx_load_ascii(dnew, fp))
                        goto loaderr;
                dnew->dtype = DTascii;          /* should leave double? */
                break;
        case DTfloat:
                if (!rmx_load_float(dnew, fp))
                        goto loaderr;
                dnew->dtype = DTfloat;
                break;
        case DTdouble:
                if (!rmx_load_double(dnew, fp))
                        goto loaderr;
                dnew->dtype = DTdouble;
                break;
        case DTrgbe:
        case DTxyze:
                if (!rmx_load_rgbe(dnew, fp))
                        goto loaderr;
                dnew->dtype = dinfo.dtype;
                break;
        default:
                goto loaderr;
        }
        if (fp != stdin)
                fclose(fp);
        return(dnew);
loaderr:                                        /* should report error? */
        fclose(fp);
        rmx_free(dnew);
        return(NULL);
}

static int
rmx_write_ascii(const RMATRIX *rm, FILE *fp)
{
        int     i, j, k;
#ifdef _WIN32
        _setmode(fileno(fp), _O_TEXT);
#endif
        for (i = 0; i < rm->nrows; i++) {
            for (j = 0; j < rm->ncols; j++) {
                for (k = 0; k < rm->ncomp; k++)
                    fprintf(fp, " %.15e", rmx_lval(rm,i,j,k));
                fputc('\t', fp);
            }
            fputc('\n', fp);
        }
        return(1);
}

static int
rmx_write_float(const RMATRIX *rm, FILE *fp)
{
        int     i, j, k;
        float   val[100];

        if (rm->ncomp > 100) {
                fputs("Unsupported # components in rmx_write_float()\n", stderr);
                exit(1);
        }
        for (i = 0; i < rm->nrows; i++)
            for (j = 0; j < rm->ncols; j++) {
                for (k = rm->ncomp; k--; )
                    val[k] = (float)rmx_lval(rm,i,j,k);
                if (fwrite(val, sizeof(val[0]), rm->ncomp, fp) != rm->ncomp)
                        return(0);
            }
        return(1);
}

static int
rmx_write_double(const RMATRIX *rm, FILE *fp)
{
        int     i, j, k;
        double  val[100];

        if (rm->ncomp > 100) {
                fputs("Unsupported # components in rmx_write_double()\n", stderr);
                exit(1);
        }
        for (i = 0; i < rm->nrows; i++)
            for (j = 0; j < rm->ncols; j++) {
                for (k = rm->ncomp; k--; )
                    val[k] = rmx_lval(rm,i,j,k);
                if (fwrite(val, sizeof(val[0]), rm->ncomp, fp) != rm->ncomp)
                        return(0);
            }
        return(1);
}

static int
rmx_write_rgbe(const RMATRIX *rm, FILE *fp)
{
        COLOR   *scan = (COLOR *)malloc(sizeof(COLOR)*rm->ncols);
        int     i, j;

        if (scan == NULL)
                return(0);
        for (i = 0; i < rm->nrows; i++) {
            for (j = rm->ncols; j--; )
                setcolor(scan[j],       rmx_lval(rm,i,j,0),
                                        rmx_lval(rm,i,j,1),
                                        rmx_lval(rm,i,j,2)      );
            if (fwritescan(scan, rm->ncols, fp) < 0) {
                free(scan);
                return(0);
            }
        }
        free(scan);
        return(1);
}

/* Write matrix to file type indicated by dtype */
int
rmx_write(const RMATRIX *rm, int dtype, FILE *fp)
{
        RMATRIX *mydm = NULL;
        int     ok = 1;

        if ((rm == NULL) | (fp == NULL))
                return(0);
                                                /* complete header */
        if (rm->info)
                fputs(rm->info, fp);
        if (dtype == DTfromHeader)
                dtype = rm->dtype;
        else if ((dtype == DTrgbe) & (rm->dtype == DTxyze))
                dtype = DTxyze;
        else if ((dtype == DTxyze) & (rm->dtype == DTrgbe))
                dtype = DTrgbe;
        if ((dtype != DTrgbe) & (dtype != DTxyze)) {
                fprintf(fp, "NROWS=%d\n", rm->nrows);
                fprintf(fp, "NCOLS=%d\n", rm->ncols);
                fprintf(fp, "NCOMP=%d\n", rm->ncomp);
        } else if (rm->ncomp != 3) {            /* wrong # components? */
                double  cmtx[3];
                if (rm->ncomp != 1)             /* only convert grayscale */
                        return(0);
                cmtx[0] = cmtx[1] = cmtx[2] = 1;
                mydm = rmx_transform(rm, 3, cmtx);
                if (mydm == NULL)
                        return(0);
                rm = mydm;
        }
        fputformat((char *)cm_fmt_id[dtype], fp);
        fputc('\n', fp);
        switch (dtype) {                        /* write data */
        case DTascii:
                ok = rmx_write_ascii(rm, fp);
                break;
        case DTfloat:
                ok = rmx_write_float(rm, fp);
                break;
        case DTdouble:
                ok = rmx_write_double(rm, fp);
                break;
        case DTrgbe:
        case DTxyze:
                fprtresolu(rm->ncols, rm->nrows, fp);
                ok = rmx_write_rgbe(rm, fp);
                break;
        default:
                return(0);
        }
        ok &= (fflush(fp) == 0);
        rmx_free(mydm);
        return(ok);
}

/* Allocate and assign square identity matrix with n components */
RMATRIX *
rmx_identity(const int dim, const int n)
{
        RMATRIX *rid = rmx_alloc(dim, dim, n);
        int     i;

        if (rid == NULL)
                return(NULL);
        memset(rid->mtx, 0, sizeof(rid->mtx[0])*dim*dim);
        for (i = dim; i--; )
                rmx_lval(rid,i,i,0) = 1;
        for (i = n; --i; )
                memcpy(rid->mtx+i*(dim*dim), rid->mtx,
                                sizeof(rid->mtx[0])*dim*dim);
        return(rid);
}

/* Duplicate the given matrix */
RMATRIX *
rmx_copy(const RMATRIX *rm)
{
        RMATRIX *dnew;

        if (rm == NULL)
                return(NULL);
        dnew = rmx_alloc(rm->nrows, rm->ncols, rm->ncomp);
        if (dnew == NULL)
                return(NULL);
        rmx_addinfo(dnew, rm->info);
        dnew->dtype = rm->dtype;
        memcpy(dnew->mtx, rm->mtx,
                sizeof(rm->mtx[0])*rm->ncomp*rm->nrows*rm->ncols);
        return(dnew);
}

/* Allocate and assign transposed matrix */
RMATRIX *
rmx_transpose(const RMATRIX *rm)
{
        RMATRIX *dnew;
        int     i, j, k;

        if (rm == NULL)
                return(0);
        dnew = rmx_alloc(rm->ncols, rm->nrows, rm->ncomp);
        if (dnew == NULL)
                return(NULL);
        if (rm->info) {
                rmx_addinfo(dnew, rm->info);
                rmx_addinfo(dnew, "Transposed rows and columns\n");
        }
        dnew->dtype = rm->dtype;
        for (i = dnew->nrows; i--; )
            for (j = dnew->ncols; j--; )
                for (k = dnew->ncomp; k--; )
                        rmx_lval(dnew,i,j,k) = rmx_lval(rm,j,i,k);
        return(dnew);
}

/* Multiply (concatenate) two matrices and allocate the result */
RMATRIX *
rmx_multiply(const RMATRIX *m1, const RMATRIX *m2)
{
        RMATRIX *mres;
        int     i, j, k, h;

        if ((m1 == NULL) | (m2 == NULL) ||
                        (m1->ncomp != m2->ncomp) | (m1->ncols != m2->nrows))
                return(NULL);
        mres = rmx_alloc(m1->nrows, m2->ncols, m1->ncomp);
        if (mres == NULL)
                return(NULL);
        i = rmx_newtype(m1->dtype, m2->dtype);
        if (i)
                mres->dtype = i;
        else
                rmx_addinfo(mres, rmx_mismatch_warn);
        for (i = mres->nrows; i--; )
            for (j = mres->ncols; j--; )
                for (k = mres->ncomp; k--; ) {
                    long double d = 0;
                    for (h = m1->ncols; h--; )
                        d += (long double)rmx_lval(m1,i,h,k) *
                                (long double)rmx_lval(m2,h,j,k);
                    rmx_lval(mres,i,j,k) = (double)d;
                }
        return(mres);
}

/* Sum second matrix into first, applying scale factor beforehand */
int
rmx_sum(RMATRIX *msum, const RMATRIX *madd, const double sf[])
{
        double  *mysf = NULL;
        int     i, j, k;

        if ((msum == NULL) | (madd == NULL) ||
                        (msum->nrows != madd->nrows) |
                        (msum->ncols != madd->ncols) |
                        (msum->ncomp != madd->ncomp))
                return(0);
        if (sf == NULL) {
                mysf = (double *)malloc(sizeof(double)*msum->ncomp);
                if (mysf == NULL)
                        return(0);
                for (k = msum->ncomp; k--; )
                        mysf[k] = 1;
                sf = mysf;
        }
        i = rmx_newtype(msum->dtype, madd->dtype);
        if (i)
                msum->dtype = i;
        else
                rmx_addinfo(msum, rmx_mismatch_warn);
        for (i = msum->nrows; i--; )
            for (j = msum->ncols; j--; )
                for (k = msum->ncomp; k--; )
                     rmx_lval(msum,i,j,k) += sf[k] * rmx_lval(madd,i,j,k);

        free(mysf);
        return(1);
}

/* Scale the given matrix by the indicated scalar component vector */
int
rmx_scale(RMATRIX *rm, const double sf[])
{
        int     i, j, k;

        if ((rm == NULL) | (sf == NULL))
                return(0);
        for (i = rm->nrows; i--; )
            for (j = rm->ncols; j--; )
                for (k = rm->ncomp; k--; )
                    rmx_lval(rm,i,j,k) *= sf[k];

        return(1);
}

/* Allocate new matrix and apply component transformation */
RMATRIX *
rmx_transform(const RMATRIX *msrc, int n, const double cmat[])
{
        int     i, j, ks, kd;
        RMATRIX *dnew;

        if ((msrc == NULL) | (n <= 0) | (cmat == NULL))
                return(NULL);
        dnew = rmx_alloc(msrc->nrows, msrc->ncols, n);
        if (dnew == NULL)
                return(NULL);
        dnew->dtype = msrc->dtype;
        for (i = dnew->nrows; i--; )
            for (j = dnew->ncols; j--; )
                for (kd = dnew->ncomp; kd--; ) {
                    double      d = 0;
                    for (ks = msrc->ncomp; ks--; )
                        d += cmat[kd*msrc->ncomp + ks] * rmx_lval(msrc,i,j,ks);
                    rmx_lval(dnew,i,j,kd) = d;
                }
        return(dnew);
}

/* Convert a color matrix to newly allocated RMATRIX buffer */
RMATRIX *
rmx_from_cmatrix(const CMATRIX *cm)
{
        int     i, j;
        RMATRIX *dnew;

        if (cm == NULL)
                return(NULL);
        dnew = rmx_alloc(cm->nrows, cm->ncols, 3);
        if (dnew == NULL)
                return(NULL);
        dnew->dtype = DTfloat;
        for (i = dnew->nrows; i--; )
            for (j = dnew->ncols; j--; ) {
                const COLORV    *cv = cm_lval(cm,i,j);
                rmx_lval(dnew,i,j,0) = cv[0];
                rmx_lval(dnew,i,j,1) = cv[1];
                rmx_lval(dnew,i,j,2) = cv[2];
            }
        return(dnew);
}

/* Convert general matrix to newly allocated CMATRIX buffer */
CMATRIX *
cm_from_rmatrix(const RMATRIX *rm)
{
        int     i, j;
        CMATRIX *cnew;

        if (rm == NULL || rm->ncomp != 3)
                return(NULL);
        cnew = cm_alloc(rm->nrows, rm->ncols);
        if (cnew == NULL)
                return(NULL);
        for (i = cnew->nrows; i--; )
            for (j = cnew->ncols; j--; ) {
                COLORV  *cv = cm_lval(cnew,i,j);
                cv[0] = (COLORV)rmx_lval(rm,i,j,0);
                cv[1] = (COLORV)rmx_lval(rm,i,j,1);
                cv[2] = (COLORV)rmx_lval(rm,i,j,2);
            }
        return(cnew);
}
Revision:	2.11
Committed:	Tue Dec 16 20:21:46 2014 UTC (9 years, 4 months ago) by greg
Content type:	text/plain
Branch:	MAIN
Changes since 2.10:	+2 -1 lines
Log Message:	Fixed output format for ASCII from ASCII inputs
#	User	Rev	Content
1	greg	2.1	#ifndef lint
2	greg	2.11	static const char RCSid[] = "$Id: rmatrix.c,v 2.10 2014/09/18 23:20:12 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])(nnr*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			rmx_load(const char *fname)
188			{
189			FILE *fp = stdin;
190	greg	2.6	RMATRIX dinfo;
191	greg	2.1	RMATRIX *dnew;
192
193			if (fname == NULL) { /* reading from stdin? */
194			fname = "<stdin>";
195	greg	2.7	#ifdef _WIN32
196			_setmode(fileno(stdin), _O_BINARY);
197			#endif
198	greg	2.1	} else {
199			const char sp = fname; / check suffix */
200			while (*sp)
201			++sp;
202			while (sp > fname && sp[-1] != '.')
203			--sp;
204			if (!strcasecmp(sp, "XML")) { /* assume it's a BSDF */
205			CMATRIX cm = cm_loadBTDF((char )fname);
206			if (cm == NULL)
207			return(NULL);
208			dnew = rmx_from_cmatrix(cm);
209			cm_free(cm);
210			return(dnew);
211			}
212			/* else open it ourselves */
213			if ((fp = fopen(fname, "rb")) == NULL)
214			return(NULL);
215			}
216			#ifdef getc_unlocked
217			flockfile(fp);
218			#endif
219			dinfo.nrows = dinfo.ncols = dinfo.ncomp = 0;
220	greg	2.6	dinfo.dtype = DTascii; /* assumed w/o FORMAT */
221			dinfo.info = NULL;
222	greg	2.3	if (getheader(fp, get_dminfo, &dinfo) < 0) {
223	greg	2.1	fclose(fp);
224			return(NULL);
225			}
226	greg	2.4	if ((dinfo.nrows <= 0) \| (dinfo.ncols <= 0)) {
227	greg	2.1	if (!fscnresolu(&dinfo.ncols, &dinfo.nrows, fp)) {
228			fclose(fp);
229			return(NULL);
230			}
231	greg	2.4	if (dinfo.ncomp <= 0)
232			dinfo.ncomp = 3;
233			else if ((dinfo.dtype == DTrgbe) \| (dinfo.dtype == DTxyze) &&
234			dinfo.ncomp != 3) {
235			fclose(fp);
236			return(NULL);
237			}
238	greg	2.1	}
239			dnew = rmx_alloc(dinfo.nrows, dinfo.ncols, dinfo.ncomp);
240			if (dnew == NULL) {
241			fclose(fp);
242			return(NULL);
243			}
244	greg	2.6	dnew->info = dinfo.info;
245	greg	2.1	switch (dinfo.dtype) {
246			case DTascii:
247			if (!rmx_load_ascii(dnew, fp))
248			goto loaderr;
249	greg	2.11	dnew->dtype = DTascii; /* should leave double? */
250	greg	2.1	break;
251			case DTfloat:
252			if (!rmx_load_float(dnew, fp))
253			goto loaderr;
254	greg	2.6	dnew->dtype = DTfloat;
255	greg	2.1	break;
256			case DTdouble:
257			if (!rmx_load_double(dnew, fp))
258			goto loaderr;
259	greg	2.6	dnew->dtype = DTdouble;
260	greg	2.1	break;
261			case DTrgbe:
262			case DTxyze:
263			if (!rmx_load_rgbe(dnew, fp))
264			goto loaderr;
265	greg	2.6	dnew->dtype = dinfo.dtype;
266	greg	2.1	break;
267			default:
268			goto loaderr;
269			}
270			if (fp != stdin)
271			fclose(fp);
272			return(dnew);
273			loaderr: /* should report error? */
274			fclose(fp);
275			rmx_free(dnew);
276			return(NULL);
277			}
278
279			static int
280			rmx_write_ascii(const RMATRIX rm, FILE fp)
281			{
282			int i, j, k;
283			#ifdef _WIN32
284			_setmode(fileno(fp), _O_TEXT);
285			#endif
286			for (i = 0; i < rm->nrows; i++) {
287			for (j = 0; j < rm->ncols; j++) {
288			for (k = 0; k < rm->ncomp; k++)
289			fprintf(fp, " %.15e", rmx_lval(rm,i,j,k));
290			fputc('\t', fp);
291			}
292			fputc('\n', fp);
293			}
294			return(1);
295			}
296
297			static int
298			rmx_write_float(const RMATRIX rm, FILE fp)
299			{
300			int i, j, k;
301			float val[100];
302
303			if (rm->ncomp > 100) {
304			fputs("Unsupported # components in rmx_write_float()\n", stderr);
305			exit(1);
306			}
307			for (i = 0; i < rm->nrows; i++)
308			for (j = 0; j < rm->ncols; j++) {
309			for (k = rm->ncomp; k--; )
310			val[k] = (float)rmx_lval(rm,i,j,k);
311			if (fwrite(val, sizeof(val[0]), rm->ncomp, fp) != rm->ncomp)
312			return(0);
313			}
314			return(1);
315			}
316
317			static int
318			rmx_write_double(const RMATRIX rm, FILE fp)
319			{
320			int i, j, k;
321			double val[100];
322
323			if (rm->ncomp > 100) {
324			fputs("Unsupported # components in rmx_write_double()\n", stderr);
325			exit(1);
326			}
327			for (i = 0; i < rm->nrows; i++)
328			for (j = 0; j < rm->ncols; j++) {
329			for (k = rm->ncomp; k--; )
330			val[k] = rmx_lval(rm,i,j,k);
331			if (fwrite(val, sizeof(val[0]), rm->ncomp, fp) != rm->ncomp)
332			return(0);
333			}
334			return(1);
335			}
336
337			static int
338			rmx_write_rgbe(const RMATRIX rm, FILE fp)
339			{
340			COLOR scan = (COLOR )malloc(sizeof(COLOR)*rm->ncols);
341			int i, j;
342
343			if (scan == NULL)
344			return(0);
345			for (i = 0; i < rm->nrows; i++) {
346			for (j = rm->ncols; j--; )
347			setcolor(scan[j], rmx_lval(rm,i,j,0),
348			rmx_lval(rm,i,j,1),
349			rmx_lval(rm,i,j,2) );
350			if (fwritescan(scan, rm->ncols, fp) < 0) {
351			free(scan);
352			return(0);
353			}
354			}
355			free(scan);
356			return(1);
357			}
358
359	greg	2.6	/* Write matrix to file type indicated by dtype */
360	greg	2.10	int
361	greg	2.1	rmx_write(const RMATRIX rm, int dtype, FILE fp)
362			{
363			RMATRIX *mydm = NULL;
364			int ok = 1;
365
366			if ((rm == NULL) \| (fp == NULL))
367			return(0);
368			/* complete header */
369	greg	2.5	if (rm->info)
370			fputs(rm->info, fp);
371	greg	2.6	if (dtype == DTfromHeader)
372			dtype = rm->dtype;
373			else if ((dtype == DTrgbe) & (rm->dtype == DTxyze))
374			dtype = DTxyze;
375	greg	2.9	else if ((dtype == DTxyze) & (rm->dtype == DTrgbe))
376	greg	2.6	dtype = DTrgbe;
377	greg	2.1	if ((dtype != DTrgbe) & (dtype != DTxyze)) {
378			fprintf(fp, "NROWS=%d\n", rm->nrows);
379			fprintf(fp, "NCOLS=%d\n", rm->ncols);
380			fprintf(fp, "NCOMP=%d\n", rm->ncomp);
381			} else if (rm->ncomp != 3) { /* wrong # components? */
382			double cmtx[3];
383			if (rm->ncomp != 1) /* only convert grayscale */
384			return(0);
385			cmtx[0] = cmtx[1] = cmtx[2] = 1;
386			mydm = rmx_transform(rm, 3, cmtx);
387			if (mydm == NULL)
388			return(0);
389			rm = mydm;
390			}
391			fputformat((char *)cm_fmt_id[dtype], fp);
392			fputc('\n', fp);
393			switch (dtype) { /* write data */
394			case DTascii:
395			ok = rmx_write_ascii(rm, fp);
396			break;
397			case DTfloat:
398			ok = rmx_write_float(rm, fp);
399			break;
400			case DTdouble:
401			ok = rmx_write_double(rm, fp);
402			break;
403			case DTrgbe:
404			case DTxyze:
405			fprtresolu(rm->ncols, rm->nrows, fp);
406			ok = rmx_write_rgbe(rm, fp);
407			break;
408			default:
409			return(0);
410			}
411			ok &= (fflush(fp) == 0);
412			rmx_free(mydm);
413	greg	2.10	return(ok);
414	greg	2.1	}
415
416			/* Allocate and assign square identity matrix with n components */
417			RMATRIX *
418			rmx_identity(const int dim, const int n)
419			{
420			RMATRIX *rid = rmx_alloc(dim, dim, n);
421			int i;
422
423			if (rid == NULL)
424			return(NULL);
425			memset(rid->mtx, 0, sizeof(rid->mtx[0])dimdim);
426			for (i = dim; i--; )
427			rmx_lval(rid,i,i,0) = 1;
428			for (i = n; --i; )
429			memcpy(rid->mtx+i(dimdim), rid->mtx,
430			sizeof(rid->mtx[0])dimdim);
431			return(rid);
432			}
433
434			/* Duplicate the given matrix */
435			RMATRIX *
436			rmx_copy(const RMATRIX *rm)
437			{
438			RMATRIX *dnew;
439
440			if (rm == NULL)
441			return(NULL);
442			dnew = rmx_alloc(rm->nrows, rm->ncols, rm->ncomp);
443			if (dnew == NULL)
444			return(NULL);
445	greg	2.5	rmx_addinfo(dnew, rm->info);
446	greg	2.6	dnew->dtype = rm->dtype;
447	greg	2.1	memcpy(dnew->mtx, rm->mtx,
448			sizeof(rm->mtx[0])rm->ncomprm->nrows*rm->ncols);
449			return(dnew);
450			}
451
452	greg	2.2	/* Allocate and assign transposed matrix */
453			RMATRIX *
454			rmx_transpose(const RMATRIX *rm)
455	greg	2.1	{
456	greg	2.2	RMATRIX *dnew;
457	greg	2.1	int i, j, k;
458
459			if (rm == NULL)
460			return(0);
461	greg	2.2	dnew = rmx_alloc(rm->ncols, rm->nrows, rm->ncomp);
462			if (dnew == NULL)
463			return(NULL);
464	greg	2.5	if (rm->info) {
465			rmx_addinfo(dnew, rm->info);
466			rmx_addinfo(dnew, "Transposed rows and columns\n");
467			}
468	greg	2.6	dnew->dtype = rm->dtype;
469	greg	2.2	for (i = dnew->nrows; i--; )
470			for (j = dnew->ncols; j--; )
471			for (k = dnew->ncomp; k--; )
472			rmx_lval(dnew,i,j,k) = rmx_lval(rm,j,i,k);
473			return(dnew);
474	greg	2.1	}
475
476			/* Multiply (concatenate) two matrices and allocate the result */
477			RMATRIX *
478			rmx_multiply(const RMATRIX m1, const RMATRIX m2)
479			{
480			RMATRIX *mres;
481			int i, j, k, h;
482
483			if ((m1 == NULL) \| (m2 == NULL) \|\|
484			(m1->ncomp != m2->ncomp) \| (m1->ncols != m2->nrows))
485			return(NULL);
486			mres = rmx_alloc(m1->nrows, m2->ncols, m1->ncomp);
487			if (mres == NULL)
488			return(NULL);
489	greg	2.6	i = rmx_newtype(m1->dtype, m2->dtype);
490			if (i)
491			mres->dtype = i;
492			else
493			rmx_addinfo(mres, rmx_mismatch_warn);
494	greg	2.1	for (i = mres->nrows; i--; )
495			for (j = mres->ncols; j--; )
496	greg	2.8	for (k = mres->ncomp; k--; ) {
497	greg	2.1	long double d = 0;
498	greg	2.8	for (h = m1->ncols; h--; )
499	greg	2.1	d += (long double)rmx_lval(m1,i,h,k) *
500			(long double)rmx_lval(m2,h,j,k);
501			rmx_lval(mres,i,j,k) = (double)d;
502			}
503			return(mres);
504			}
505
506			/* Sum second matrix into first, applying scale factor beforehand */
507			int
508			rmx_sum(RMATRIX msum, const RMATRIX madd, const double sf[])
509			{
510			double *mysf = NULL;
511			int i, j, k;
512
513			if ((msum == NULL) \| (madd == NULL) \|\|
514			(msum->nrows != madd->nrows) \|
515			(msum->ncols != madd->ncols) \|
516			(msum->ncomp != madd->ncomp))
517			return(0);
518			if (sf == NULL) {
519			mysf = (double )malloc(sizeof(double)msum->ncomp);
520			if (mysf == NULL)
521			return(0);
522			for (k = msum->ncomp; k--; )
523			mysf[k] = 1;
524			sf = mysf;
525			}
526	greg	2.6	i = rmx_newtype(msum->dtype, madd->dtype);
527			if (i)
528			msum->dtype = i;
529			else
530			rmx_addinfo(msum, rmx_mismatch_warn);
531	greg	2.1	for (i = msum->nrows; i--; )
532			for (j = msum->ncols; j--; )
533			for (k = msum->ncomp; k--; )
534			rmx_lval(msum,i,j,k) += sf[k] * rmx_lval(madd,i,j,k);
535
536			free(mysf);
537			return(1);
538			}
539
540			/* Scale the given matrix by the indicated scalar component vector */
541			int
542			rmx_scale(RMATRIX *rm, const double sf[])
543			{
544			int i, j, k;
545
546			if ((rm == NULL) \| (sf == NULL))
547			return(0);
548			for (i = rm->nrows; i--; )
549			for (j = rm->ncols; j--; )
550			for (k = rm->ncomp; k--; )
551			rmx_lval(rm,i,j,k) *= sf[k];
552
553			return(1);
554			}
555
556			/* Allocate new matrix and apply component transformation */
557			RMATRIX *
558			rmx_transform(const RMATRIX *msrc, int n, const double cmat[])
559			{
560			int i, j, ks, kd;
561			RMATRIX *dnew;
562
563			if ((msrc == NULL) \| (n <= 0) \| (cmat == NULL))
564			return(NULL);
565			dnew = rmx_alloc(msrc->nrows, msrc->ncols, n);
566			if (dnew == NULL)
567			return(NULL);
568	greg	2.6	dnew->dtype = msrc->dtype;
569	greg	2.1	for (i = dnew->nrows; i--; )
570			for (j = dnew->ncols; j--; )
571			for (kd = dnew->ncomp; kd--; ) {
572			double d = 0;
573			for (ks = msrc->ncomp; ks--; )
574			d += cmat[kdmsrc->ncomp + ks] rmx_lval(msrc,i,j,ks);
575			rmx_lval(dnew,i,j,kd) = d;
576			}
577			return(dnew);
578			}
579
580			/* Convert a color matrix to newly allocated RMATRIX buffer */
581			RMATRIX *
582			rmx_from_cmatrix(const CMATRIX *cm)
583			{
584			int i, j;
585			RMATRIX *dnew;
586
587			if (cm == NULL)
588			return(NULL);
589			dnew = rmx_alloc(cm->nrows, cm->ncols, 3);
590			if (dnew == NULL)
591			return(NULL);
592	greg	2.6	dnew->dtype = DTfloat;
593	greg	2.1	for (i = dnew->nrows; i--; )
594			for (j = dnew->ncols; j--; ) {
595			const COLORV *cv = cm_lval(cm,i,j);
596			rmx_lval(dnew,i,j,0) = cv[0];
597			rmx_lval(dnew,i,j,1) = cv[1];
598			rmx_lval(dnew,i,j,2) = cv[2];
599			}
600			return(dnew);
601			}
602
603			/* Convert general matrix to newly allocated CMATRIX buffer */
604			CMATRIX *
605			cm_from_rmatrix(const RMATRIX *rm)
606			{
607			int i, j;
608			CMATRIX *cnew;
609
610			if (rm == NULL \|\| rm->ncomp != 3)
611			return(NULL);
612			cnew = cm_alloc(rm->nrows, rm->ncols);
613			if (cnew == NULL)
614			return(NULL);
615			for (i = cnew->nrows; i--; )
616			for (j = cnew->ncols; j--; ) {
617			COLORV *cv = cm_lval(cnew,i,j);
618			cv[0] = (COLORV)rmx_lval(rm,i,j,0);
619			cv[1] = (COLORV)rmx_lval(rm,i,j,1);
620			cv[2] = (COLORV)rmx_lval(rm,i,j,2);
621			}
622			return(cnew);
623			}