src/util/rmatrix.c

#ifndef lint
static const char RCSid[] = "$Id: rmatrix.c,v 2.23 2016/08/30 14:54:08 greg Exp $";
#endif
/*
 * General matrix operations.
 */

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <fcntl.h>
#include "rtio.h"
#include "platform.h"
#include "resolu.h"
#include "paths.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) |
                        (dtyp2==DTxyze) | (dtyp2==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;

        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 (getbinary(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 (getbinary(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 *inspec)
{
        FILE            *fp = stdin;
        RMATRIX         dinfo;
        RMATRIX         *dnew;

        if (inspec == NULL) {                   /* reading from stdin? */
                inspec = "<stdin>";
                SET_FILE_BINARY(stdin);
        } else if (inspec[0] == '!') {
                if ((fp = popen(inspec+1, "r")) == NULL)
                        return(NULL);
                SET_FILE_BINARY(stdin);
        } else {
                const char      *sp = inspec;   /* check suffix */
                while (*sp)
                        ++sp;
                while (sp > inspec && sp[-1] != '.')
                        --sp;
                if (!strcasecmp(sp, "XML")) {   /* assume it's a BSDF */
                        CMATRIX *cm = cm_loadBTDF((char *)inspec);
                        if (cm == NULL)
                                return(NULL);
                        dnew = rmx_from_cmatrix(cm);
                        cm_free(cm);
                        dnew->dtype = DTascii;
                        return(dnew);
                }
                                                /* else open it ourselves */
                if ((fp = fopen(inspec, "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:
                SET_FILE_TEXT(stdin);
                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) {
                if (inspec[0] == '!')
                        pclose(fp);
                else
                        fclose(fp);
        }
#ifdef getc_unlocked
        else
                funlockfile(fp);
#endif
        return(dnew);
loaderr:                                        /* should report error? */
        if (inspec[0] == '!')
                pclose(fp);
        else
                fclose(fp);
        rmx_free(dnew);
        return(NULL);
}

static int
rmx_write_ascii(const RMATRIX *rm, FILE *fp)
{
        int     i, j, k;

        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 (putbinary(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 (putbinary(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);
#ifdef getc_unlocked
        flockfile(fp);
#endif
                                                /* 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);
#ifdef getc_unlocked
        funlockfile(fp);
#endif
        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, k;

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