src/common/color.c

#ifndef lint
static const char       RCSid[] = "$Id: color.c,v 2.32 2023/12/07 23:16:58 greg Exp $";
#endif
/*
 *  color.c - routines for color calculations.
 *
 *  Externals declared in color.h
 */

#include "copyright.h"

#include  <stdio.h>
#include  <stdlib.h>
#include  <math.h>
#include  "color.h"

#ifdef getc_unlocked            /* avoid horrendous overhead of flockfile */
#undef getc
#undef putc
#undef ferror
#define getc    getc_unlocked
#define putc    putc_unlocked
#define ferror  ferror_unlocked
#endif

#define  MINELEN        8       /* minimum scanline length for encoding */
#define  MAXELEN        0x7fff  /* maximum scanline length for encoding */
#define  MINRUN         4       /* minimum run length */


int  CNDX[4] = {0,1,2,3};       /* RGBE indices for SCOLOR, SCOLR */
float  WLPART[4] = {780,588,480,380};   /* RGB wavelength limits+partitions (nm) */


int
setspectrsamp(                  /* assign spectral sampling, 1 if good, -1 if bad */
        int cn[4],              /* input cn[3]=nsamps */
        float wlpt[4]           /* input wlpt[0],wlpt[3]=extrema */
)
{
        static const float      PKWL[3] = {607, 553, 469};
        int                     i, j;

        if (cn[3] < 3)
                return(-1);             /* reject this */

        if (wlpt[0] < wlpt[3]) {
                float   tf = wlpt[0];
                wlpt[0] = wlpt[3]; wlpt[3] = tf;
        }
        if (wlpt[0] - wlpt[3] < 50.f)
                return(-1);             /* also reject */

        if (cn[3] > MAXCSAMP)
                cn[3] = MAXCSAMP;

        if ((wlpt[3] >= PKWL[2]) | (wlpt[0] <= PKWL[0])) {
                wlpt[1] = wlpt[0] + 0.333333f*(wlpt[3]-wlpt[0]);
                wlpt[2] = wlpt[0] + 0.666667f*(wlpt[3]-wlpt[0]);
                cn[0] = 0; cn[1] = cn[3]/3; cn[2] = cn[3]*2/3;
                return(0);              /* unhappy but non-fatal return value */
        }
        wlpt[1] = 588.f;                /* tuned for standard green channel */
        wlpt[2] = 480.f;
        if (cn[3] == 3) {               /* nothing to tune? */
                cn[0] = 0; cn[1] = 1; cn[2] = 2;
        } else {                        /* else find nearest color indices */
                double  curwl[3];
                memset(curwl, 0, sizeof(curwl));
                for (i = cn[3]; i--; ) {
                        const float     cwl = (i+.5f)/cn[3]*(wlpt[3]-wlpt[0]) + wlpt[0];
                        for (j = 3; j--; )
                                if (fabs(cwl - PKWL[j]) < fabs(curwl[j] - PKWL[j])) {
                                        curwl[j] = cwl;
                                        cn[j] = i;
                                }
                }
        }
        return(1);                      /* happy return value */
}


void
setscolor(                      /* assign spectral color from RGB */
        SCOLOR scol,
        double r,
        double g,
        double b
)
{
        const double    step = (WLPART[3] - WLPART[0])/(double)NCSAMP;
        double          cwl = WLPART[0] + .5*step;
        int             i;

        for (i = 0; i < NCSAMP; i++) {
                if (cwl >= WLPART[1])
                        scol[i] = r;
                else if (cwl >= WLPART[2])
                        scol[i] = g;
                else
                        scol[i] = b;
                cwl += step;
        }
}


void
scolor2color(                   /* assign RGB color from spectrum */
        COLOR col,
        SCOLOR scol,            /* uses average over bands */
        int ncs,
        const float wlpt[4]
)
{
        const double    step = (wlpt[3] - wlpt[0])/(double)ncs;
        double          cwl = wlpt[0] + .5*step;
        int             i, j=0, n=0;

        setcolor(col, 0, 0, 0);
        for (i = 0; i < ncs; i++) {
                if (cwl < wlpt[j+1]) {
                        if (n > 1) col[j] /= (COLORV)n;
                        j++;
                        n = 0;
                }
                col[j] += scol[i];
                n++;
                cwl += step;
        }
        if (n > 1) col[j] /= (COLORV)n;
}


void
scolor2colr(                    /* assign RGBE from spectral color */
        COLR clr,
        SCOLOR scol,            /* uses average over bands */
        int ncs,
        const float wlpt[4]
)
{
        COLOR   col;

        scolor2color(col, scol, ncs, wlpt);
        setcolr(clr, col[RED], col[GRN], col[BLU]);
}


void
scolr2color(                    /* assign RGB from common exponent */
        COLOR col,
        SCOLR sclr,
        int ncs,
        const float wlpt[4]
)
{
        SCOLOR  scol;

        scolr2scolor(scol, sclr, ncs);
        scolor2color(col, scol, ncs, wlpt);
}


void
scolor2scolr(                   /* float spectrum to common exponent */
        SCOLR sclr,
        SCOLOR scol,
        int ncs
)
{
        int     i = ncs;
        COLORV  p = scol[--i];

        while (i)
                if (scol[--i] > p)
                        p = scol[i];
        if (p <= 1e-32) {
                memset(sclr, 0, ncs+1);
                return;
        }
        p = frexp(p, &i) * 256.0 / p;
        sclr[ncs] = i + COLXS;
        for (i = ncs; i--; )
                sclr[i] = (scol[i] > 0) * (int)(scol[i]*p);
}


void
scolr2scolor(                   /* common exponent to float spectrum */
        SCOLOR scol,
        SCOLR sclr,
        int ncs
)
{
        double  f;
        int     i;

        if (sclr[ncs] == 0) {
                memset(scol, 0, sizeof(COLORV)*ncs);
                return;
        }
        f = ldexp(1.0, (int)sclr[ncs]-(COLXS+8));

        for (i = ncs; i--; )
                scol[i] = (sclr[i] + 0.5)*f;
}


double
scolor_mean(                    /* compute average for spectral color */
        SCOLOR  scol
)
{
        int     i = NCSAMP;
        double  sum = 0;

        while (i--)
                sum += scol[i];

        return sum/(double)NCSAMP;
}


double
sintens(                        /* find maximum value from spectrum */
        SCOLOR  scol
)
{
        int     i = NCSAMP;
        COLORV  peak = scol[--i];

        while (i)
                if (scol[--i] > peak)
                        peak = scol[i];

        return peak;
}


void
convertscolor(                  /* spectrum conversion, zero-fill ends */
        SCOLOR dst,             /* destination spectrum */
        int dnc,                /* destination # of spectral samples/intervals */
        double dwl0,            /* starting destination wavelength (longer) */
        double dwl1,            /* ending destination wavelength (shorter) */
        const COLORV src[],     /* source spectrum array */
        int snc,
        double swl0,            /* long/short wavelengths may be reversed */
        double swl1
)
{
        const int       sdir = 1 - 2*(swl0 < swl1);
        const double    sstp = (swl1 - swl0)/(double)snc;
        const double    dstp = (dwl1 - dwl0)/(double)dnc;
        const double    rdstp = 1./dstp;
        int             si, ssi, di;
        double          wl;

        if ((dnc < 3) | (dwl0 <= dwl1) | (dst == src))
                return;         /* invalid destination */

        if (dnc == snc && (dwl0-swl0)*(dwl0-swl0) + (dwl1-swl1)*(dwl1-swl1) <= .5) {
                memcpy(dst, src, sizeof(COLORV)*dnc);
                return;         /* same spectral sampling */
        }
        memset(dst, 0, sizeof(COLORV)*dnc);
                                /* set starting positions */
        if ((sdir>0 ? swl0 : swl1) <= dwl0) {
                if (sdir > 0) {
                        wl = swl0;
                        ssi = 0;
                } else {
                        wl = swl1;
                        ssi = snc-1;
                }
                si = 0;
                di = (wl - dwl0)*rdstp;
        } else {
                wl = dwl0;
                if (sdir > 0) {
                        ssi = si = (wl - swl0)/sstp;
                } else {
                        si = (wl - swl1)/sstp;
                        ssi = snc-1 - si;
                }
                di = 0;
        }
        swl0 += (sdir < 0)*sstp;
                                /* step through intervals */
        while ((si < snc) & (di < dnc)) {
                double  intvl;
                if (swl0 + (ssi+sdir)*sstp < dwl0 + (di+1)*dstp) {
                        intvl = dwl0 + (di+1)*dstp - wl;
                        dst[di++] += src[ssi]*intvl*rdstp;
                } else {
                        intvl = swl0 + (ssi+sdir)*sstp - wl;
                        dst[di] += src[ssi]*intvl*rdstp;
                        ssi += sdir;
                        si++;
                }
                wl += intvl;
        }
}


void *
tempbuffer(                     /* get a temporary buffer */
        size_t  len
)
{
        static void     *tempbuf = NULL;
        static size_t   tempbuflen = 0;

        if (!len) {             /* call to free */
                if (tempbuflen) {
                        free(tempbuf);
                        tempbuf = NULL;
                        tempbuflen = 0;
                }
                return(NULL);
        }
        if (len <= tempbuflen)  /* big enough already? */
                return(tempbuf);
                                /* else free & reallocate */
        if (tempbuflen)
                free(tempbuf);
        tempbuf = malloc(len);
        tempbuflen = len*(tempbuf != NULL);
        return(tempbuf);
}


int
fwritecolrs(                    /* write out a colr scanline */
        COLR  *scanline,
        int  len,
        FILE  *fp
)
{
        int  i, j, beg, cnt = 1;
        int  c2;
        
        if ((len < MINELEN) | (len > MAXELEN))  /* OOBs, write out flat */
                return(fwrite((char *)scanline,sizeof(COLR),len,fp) - len);
                                        /* put magic header */
        putc(2, fp);
        putc(2, fp);
        putc(len>>8, fp);
        putc(len&0xff, fp);
                                        /* put components seperately */
        for (i = 0; i < 4; i++) {
            for (j = 0; j < len; j += cnt) {    /* find next run */
                for (beg = j; beg < len; beg += cnt) {
                    for (cnt = 1; (cnt < 127) & (beg+cnt < len) &&
                            scanline[beg+cnt][i] == scanline[beg][i]; cnt++)
                        ;
                    if (cnt >= MINRUN)
                        break;                  /* long enough */
                }
                if ((beg-j > 1) & (beg-j < MINRUN)) {
                    c2 = j+1;
                    while (scanline[c2++][i] == scanline[j][i])
                        if (c2 == beg) {        /* short run */
                            putc(128+beg-j, fp);
                            putc(scanline[j][i], fp);
                            j = beg;
                            break;
                        }
                }
                while (j < beg) {               /* write out non-run */
                    if ((c2 = beg-j) > 128) c2 = 128;
                    putc(c2, fp);
                    while (c2--)
                        putc(scanline[j++][i], fp);
                }
                if (cnt >= MINRUN) {            /* write out run */
                    putc(128+cnt, fp);
                    putc(scanline[beg][i], fp);
                } else
                    cnt = 0;
            }
        }
        return(ferror(fp) ? -1 : 0);
}

/*
 * An old-format scanline is either a stream of valid RGBE or XYZE real
 * pixels or at least one real pixel followed by some number of
 * invalid real pixels of the form (1,1,1,n), where n is a count.
 * These can themselves be repeated to create a multibyte repeat
 * count, with the least significant byte first (little-endian order.)
 * Repeat counts are limited by the size of an int; if a repetition
 * leads to an overrun, the rest of the the repetition will be
 * silently ignored.
 */
static int
oldreadcolrs(                   /* read in an old-style colr scanline */
        COLR  *scanline,
        int  len,
        FILE  *fp
)
{
        int  rshift = 0;
        int  i;
        
        while (len > 0) {
                scanline[0][RED] = getc(fp);
                scanline[0][GRN] = getc(fp);
                scanline[0][BLU] = getc(fp);
                scanline[0][EXP] = i = getc(fp);
                if (i == EOF)
                        return(-1);
                if (scanline[0][GRN] == 1 &&
                                (scanline[0][RED] == 1) &
                                (scanline[0][BLU] == 1)) {
                        i = scanline[0][EXP] << rshift;
                        while (i--) {
                                copycolr(scanline[0], scanline[-1]);
                                if (--len <= 0)
                                        return(0);
                                scanline++;
                        }
                        rshift += 8;
                } else {
                        scanline++;
                        len--;
                        rshift = 0;
                }
        }
        return(0);
}

/* 
 * There are two scanline formats: old and new.  The old format
 * compresses runs of RGBE or XYZE four-byte real pixels; the new
 * format breaks the pixels into R, G, B, and E lines (or XYZE lines)
 * which are individually run-length encoded.
 *
 * An old-format scanline always begins with a valid real pixel; at
 * least one of the RGB (or XYZ) values will have its high-order bit
 * set.  A new-format scanline begins with four bytes which are not a
 * valid real pixel: (2, 2, lenhigh, lenlow) where lenhigh is always
 * less than 128 and hence never has a high-order bit set.
 *
 * A new-format scanline is broken into its RGBE or XYZE components.
 * Each is output and run-length encoded separately so that a scanline
 * is broken into four records.  In turn, each record is organized
 * into chunks of up to 128 characters, which begin with a count byte.
 * If the count byte is greater than 128, the following data byte is
 * repeated (count-128) times.  If not, the count byte is followed by
 * that many data bytes.
 */
int
freadcolrs(                     /* read in an encoded colr scanline */
        COLR  *scanline,
        int  len,
        FILE  *fp
)
{
        int  i, j;
        int  code, val;
                                        /* determine scanline type */
        if (len <= 0)
                return(0);
        if ((i = getc(fp)) == EOF)
                return(-1);
        scanline[0][RED] = i;
        scanline[0][GRN] = getc(fp);
        scanline[0][BLU] = getc(fp);
        if ((i = getc(fp)) == EOF)
                return(-1);
        if ((scanline[0][RED] != 2) | (scanline[0][GRN] != 2) |
                        (scanline[0][BLU] & 0x80)) {
                scanline[0][EXP] = i;
                return(oldreadcolrs(scanline+1, len-1, fp));
        }
        if ((scanline[0][BLU]<<8 | i) != len)
                return(-1);             /* length mismatch! */
                                        /* read each component */
        for (i = 0; i < 4; i++)
            for (j = 0; j < len; ) {
                if ((code = getc(fp)) == EOF)
                    return(-1);
                if (code > 128) {       /* run */
                    code &= 127;
                    if ((val = getc(fp)) == EOF)
                        return -1;
                    if (j + code > len)
                        return -1;      /* overrun */
                    while (code--)
                        scanline[j++][i] = val;
                } else {                /* non-run */
                    if (j + code > len)
                        return -1;      /* overrun */
                    while (code--) {
                        if ((val = getc(fp)) == EOF)
                            return -1;
                        scanline[j++][i] = val;
                    }
                }
            }
        return(0);
}


/* read an nc-component common-exponent color scanline */
int
freadscolrs(uby8 *scanline, int nc, int len, FILE *fp)
{
        if (nc < 3)
                return(-1);
        if (nc == 3)
                return(freadcolrs((COLR *)scanline, len, fp));

        if (fread(scanline, nc+1, len, fp) != len)
                return(-1);
        return(0);
}


/* write an common-exponent spectral color scanline */
int
fwritescolrs(uby8 *sscanline, int nc, int len, FILE *fp)
{
        if (nc < 3)
                return(-1);
        if (nc == 3)
                return(fwritecolrs((COLR *)sscanline, len, fp));

        if (fwrite(sscanline, nc+1, len, fp) != len)
                return(-1);
        return(0);
}


int
fwritescan(             /* write out an RGB or XYZ scanline */
        COLOR  *scanline,
        int  len,
        FILE  *fp
)
{
        COLR  *clrscan;
        int  n;
        COLR  *sp;
                                        /* get scanline buffer */
        if ((sp = (COLR *)tempbuffer(len*sizeof(COLR))) == NULL)
                return(-1);
        clrscan = sp;
                                        /* convert scanline */
        n = len;
        while (n-- > 0) {
                setcolr(sp[0], scanline[0][RED],
                                  scanline[0][GRN],
                                  scanline[0][BLU]);
                scanline++;
                sp++;
        }
        return(fwritecolrs(clrscan, len, fp));
}


int
freadscan(              /* read in an RGB or XYZ scanline */
        COLOR  *scanline,
        int  len,
        FILE  *fp
)
{
        COLR  *clrscan;

        if ((clrscan = (COLR *)tempbuffer(len*sizeof(COLR))) == NULL)
                return(-1);
        if (freadcolrs(clrscan, len, fp) < 0)
                return(-1);
                                        /* convert scanline */
        colr_color(scanline[0], clrscan[0]);
        while (--len > 0) {
                scanline++; clrscan++;
                if (clrscan[0][GRN] == clrscan[-1][GRN] &&
                            (clrscan[0][RED] == clrscan[-1][RED]) &
                            (clrscan[0][BLU] == clrscan[-1][BLU]) &
                            (clrscan[0][EXP] == clrscan[-1][EXP]))
                        copycolor(scanline[0], scanline[-1]);
                else
                        colr_color(scanline[0], clrscan[0]);
        }
        return(0);
}


/* read an nc-component color scanline */
int
freadsscan(COLORV *sscanline, int nc, int len, FILE *fp)
{
        uby8    *tscn = (uby8 *)tempbuffer((nc+1)*len);
        int     i;

        if (tscn == NULL || freadscolrs(tscn, nc, len, fp) < 0)
                return(-1);
        for (i = len; i-- > 0; ) {
                scolr2scolor(sscanline, tscn, nc);
                sscanline += nc;
                tscn += nc+1;
        }
        return(0);
}


/* write an nc-component spectral color scanline */
int
fwritesscan(COLORV *sscanline, int nc, int len, FILE *fp)
{
        uby8    *tscn = (uby8 *)tempbuffer((nc+1)*len);
        int     i;

        if (tscn == NULL)
                return(-1);
        for (i = 0; i < len; i++) {
                scolor2scolr(tscn+i*(nc+1), sscanline, nc);
                sscanline += nc;
        }
        return(fwritescolrs(tscn, nc, len, fp));
}


void
setcolr(                        /* assign a short color value */
        COLR  clr,
        double  r,
        double  g,
        double  b
)
{
        double  d;
        int  e;
        
        d = r > g ? r : g;
        if (b > d) d = b;

        if (d <= 1e-32) {
                clr[RED] = clr[GRN] = clr[BLU] = 0;
                clr[EXP] = 0;
                return;
        }

        d = frexp(d, &e) * 256.0 / d;

        clr[RED] = (r > 0) * (int)(r*d);
        clr[GRN] = (g > 0) * (int)(g*d);
        clr[BLU] = (b > 0) * (int)(b*d);
        clr[EXP] = e + COLXS;
}


void
colr_color(                     /* convert short to float color */
        COLOR  col,
        COLR  clr
)
{
        double  f;
        
        if (clr[EXP] == 0) {
                col[RED] = col[GRN] = col[BLU] = 0.0;
                return;
        }
        f = ldexp(1.0, (int)clr[EXP]-(COLXS+8));
        col[RED] = (clr[RED] + 0.5)*f;
        col[GRN] = (clr[GRN] + 0.5)*f;
        col[BLU] = (clr[BLU] + 0.5)*f;
}


int
bigdiff(                                /* c1 delta c2 > md? */
        COLOR  c1,
        COLOR  c2,
        double  md
)
{
        int  i;

        for (i = 0; i < 3; i++)
                if ((colval(c1,i)-colval(c2,i) > md*colval(c2,i)) |
                                (colval(c2,i)-colval(c1,i) > md*colval(c1,i)))
                        return(1);
        return(0);
}


int
sbigsdiff(                              /* sc1 delta sc2 > md? */
        SCOLOR  c1,
        SCOLOR  c2,
        double  md
)
{
        int  i = NCSAMP;

        while (i--)
                if ((c1[i]-c2[i] > md*c2[i]) | (c2[i]-c1[i] > md*c1[i]))
                        return(1);
        return(0);
}
Revision:	2.33
Committed:	Wed Jan 17 16:06:56 2024 UTC (3 months, 3 weeks ago) by greg
Content type:	text/plain
Branch:	MAIN
CVS Tags:	HEAD
Changes since 2.32:	+16 -1 lines
Log Message:	feat: added missing call for scolr2color()
#	User	Rev	Content
1	greg	1.1	#ifndef lint
2	greg	2.33	static const char RCSid[] = "$Id: color.c,v 2.32 2023/12/07 23:16:58 greg Exp $";
3	greg	1.1	#endif
4			/*
5			* color.c - routines for color calculations.
6			*
7	greg	2.9	* Externals declared in color.h
8			*/
9
10	greg	2.10	#include "copyright.h"
11	greg	1.1
12			#include <stdio.h>
13	greg	2.9	#include <stdlib.h>
14	greg	2.7	#include <math.h>
15	greg	1.1	#include "color.h"
16	greg	2.14
17			#ifdef getc_unlocked /* avoid horrendous overhead of flockfile */
18	greg	2.15	#undef getc
19			#undef putc
20	greg	2.19	#undef ferror
21	greg	2.14	#define getc getc_unlocked
22			#define putc putc_unlocked
23	greg	2.18	#define ferror ferror_unlocked
24	greg	2.14	#endif
25	greg	1.1
26	greg	1.14	#define MINELEN 8 /* minimum scanline length for encoding */
27	greg	2.6	#define MAXELEN 0x7fff /* maximum scanline length for encoding */
28	greg	1.14	#define MINRUN 4 /* minimum run length */
29
30	greg	2.4
31	greg	2.27	int CNDX[4] = {0,1,2,3}; /* RGBE indices for SCOLOR, SCOLR */
32			float WLPART[4] = {780,588,480,380}; /* RGB wavelength limits+partitions (nm) */
33
34
35			int
36			setspectrsamp( /* assign spectral sampling, 1 if good, -1 if bad */
37			int cn[4], /* input cn[3]=nsamps */
38			float wlpt[4] /* input wlpt[0],wlpt[3]=extrema */
39			)
40			{
41			static const float PKWL[3] = {607, 553, 469};
42			int i, j;
43
44			if (cn[3] < 3)
45			return(-1); /* reject this */
46
47			if (wlpt[0] < wlpt[3]) {
48			float tf = wlpt[0];
49			wlpt[0] = wlpt[3]; wlpt[3] = tf;
50			}
51			if (wlpt[0] - wlpt[3] < 50.f)
52			return(-1); /* also reject */
53
54			if (cn[3] > MAXCSAMP)
55			cn[3] = MAXCSAMP;
56
57			if ((wlpt[3] >= PKWL[2]) \| (wlpt[0] <= PKWL[0])) {
58			wlpt[1] = wlpt[0] + 0.333333f*(wlpt[3]-wlpt[0]);
59			wlpt[2] = wlpt[0] + 0.666667f*(wlpt[3]-wlpt[0]);
60			cn[0] = 0; cn[1] = cn[3]/3; cn[2] = cn[3]*2/3;
61			return(0); /* unhappy but non-fatal return value */
62			}
63			wlpt[1] = 588.f; /* tuned for standard green channel */
64			wlpt[2] = 480.f;
65			if (cn[3] == 3) { /* nothing to tune? */
66			cn[0] = 0; cn[1] = 1; cn[2] = 2;
67			} else { /* else find nearest color indices */
68			double curwl[3];
69			memset(curwl, 0, sizeof(curwl));
70			for (i = cn[3]; i--; ) {
71			const float cwl = (i+.5f)/cn[3]*(wlpt[3]-wlpt[0]) + wlpt[0];
72			for (j = 3; j--; )
73			if (fabs(cwl - PKWL[j]) < fabs(curwl[j] - PKWL[j])) {
74			curwl[j] = cwl;
75			cn[j] = i;
76			}
77			}
78			}
79			return(1); /* happy return value */
80			}
81
82
83			void
84			setscolor( /* assign spectral color from RGB */
85			SCOLOR scol,
86			double r,
87			double g,
88			double b
89			)
90			{
91			const double step = (WLPART[3] - WLPART[0])/(double)NCSAMP;
92			double cwl = WLPART[0] + .5*step;
93			int i;
94
95			for (i = 0; i < NCSAMP; i++) {
96			if (cwl >= WLPART[1])
97			scol[i] = r;
98			else if (cwl >= WLPART[2])
99			scol[i] = g;
100			else
101			scol[i] = b;
102			cwl += step;
103			}
104			}
105
106
107			void
108			scolor2color( /* assign RGB color from spectrum */
109			COLOR col,
110			SCOLOR scol, /* uses average over bands */
111			int ncs,
112	greg	2.30	const float wlpt[4]
113	greg	2.27	)
114			{
115			const double step = (wlpt[3] - wlpt[0])/(double)ncs;
116			double cwl = wlpt[0] + .5*step;
117			int i, j=0, n=0;
118
119			setcolor(col, 0, 0, 0);
120			for (i = 0; i < ncs; i++) {
121			if (cwl < wlpt[j+1]) {
122			if (n > 1) col[j] /= (COLORV)n;
123			j++;
124			n = 0;
125			}
126			col[j] += scol[i];
127			n++;
128			cwl += step;
129			}
130			if (n > 1) col[j] /= (COLORV)n;
131			}
132
133
134			void
135			scolor2colr( /* assign RGBE from spectral color */
136			COLR clr,
137			SCOLOR scol, /* uses average over bands */
138			int ncs,
139	greg	2.30	const float wlpt[4]
140	greg	2.27	)
141			{
142			COLOR col;
143
144			scolor2color(col, scol, ncs, wlpt);
145			setcolr(clr, col[RED], col[GRN], col[BLU]);
146			}
147
148
149			void
150	greg	2.33	scolr2color( /* assign RGB from common exponent */
151			COLOR col,
152			SCOLR sclr,
153			int ncs,
154			const float wlpt[4]
155			)
156			{
157			SCOLOR scol;
158
159			scolr2scolor(scol, sclr, ncs);
160			scolor2color(col, scol, ncs, wlpt);
161			}
162
163
164			void
165	greg	2.27	scolor2scolr( /* float spectrum to common exponent */
166			SCOLR sclr,
167			SCOLOR scol,
168			int ncs
169			)
170			{
171			int i = ncs;
172			COLORV p = scol[--i];
173
174			while (i)
175			if (scol[--i] > p)
176			p = scol[i];
177			if (p <= 1e-32) {
178			memset(sclr, 0, ncs+1);
179			return;
180			}
181			p = frexp(p, &i) * 256.0 / p;
182			sclr[ncs] = i + COLXS;
183			for (i = ncs; i--; )
184			sclr[i] = (scol[i] > 0) * (int)(scol[i]*p);
185			}
186
187
188			void
189			scolr2scolor( /* common exponent to float spectrum */
190			SCOLOR scol,
191			SCOLR sclr,
192			int ncs
193			)
194			{
195			double f;
196			int i;
197
198			if (sclr[ncs] == 0) {
199			memset(scol, 0, sizeof(COLORV)*ncs);
200			return;
201			}
202			f = ldexp(1.0, (int)sclr[ncs]-(COLXS+8));
203
204			for (i = ncs; i--; )
205			scol[i] = (sclr[i] + 0.5)*f;
206			}
207
208
209			double
210			scolor_mean( /* compute average for spectral color */
211			SCOLOR scol
212			)
213			{
214			int i = NCSAMP;
215			double sum = 0;
216
217			while (i--)
218			sum += scol[i];
219
220			return sum/(double)NCSAMP;
221			}
222
223
224			double
225			sintens( /* find maximum value from spectrum */
226			SCOLOR scol
227			)
228			{
229			int i = NCSAMP;
230			COLORV peak = scol[--i];
231
232			while (i)
233			if (scol[--i] > peak)
234			peak = scol[i];
235
236			return peak;
237			}
238
239
240			void
241			convertscolor( /* spectrum conversion, zero-fill ends */
242			SCOLOR dst, /* destination spectrum */
243			int dnc, /* destination # of spectral samples/intervals */
244			double dwl0, /* starting destination wavelength (longer) */
245			double dwl1, /* ending destination wavelength (shorter) */
246			const COLORV src[], /* source spectrum array */
247			int snc,
248			double swl0, /* long/short wavelengths may be reversed */
249			double swl1
250			)
251			{
252			const int sdir = 1 - 2*(swl0 < swl1);
253			const double sstp = (swl1 - swl0)/(double)snc;
254			const double dstp = (dwl1 - dwl0)/(double)dnc;
255			const double rdstp = 1./dstp;
256			int si, ssi, di;
257			double wl;
258
259			if ((dnc < 3) \| (dwl0 <= dwl1) \| (dst == src))
260			return; /* invalid destination */
261
262			if (dnc == snc && (dwl0-swl0)(dwl0-swl0) + (dwl1-swl1)(dwl1-swl1) <= .5) {
263			memcpy(dst, src, sizeof(COLORV)*dnc);
264			return; /* same spectral sampling */
265			}
266			memset(dst, 0, sizeof(COLORV)*dnc);
267			/* set starting positions */
268			if ((sdir>0 ? swl0 : swl1) <= dwl0) {
269			if (sdir > 0) {
270			wl = swl0;
271			ssi = 0;
272			} else {
273			wl = swl1;
274			ssi = snc-1;
275			}
276			si = 0;
277			di = (wl - dwl0)*rdstp;
278			} else {
279			wl = dwl0;
280	greg	2.29	if (sdir > 0) {
281			ssi = si = (wl - swl0)/sstp;
282			} else {
283			si = (wl - swl1)/sstp;
284			ssi = snc-1 - si;
285			}
286	greg	2.27	di = 0;
287			}
288			swl0 += (sdir < 0)*sstp;
289			/* step through intervals */
290			while ((si < snc) & (di < dnc)) {
291			double intvl;
292			if (swl0 + (ssi+sdir)sstp < dwl0 + (di+1)dstp) {
293			intvl = dwl0 + (di+1)*dstp - wl;
294			dst[di++] += src[ssi]intvlrdstp;
295			} else {
296			intvl = swl0 + (ssi+sdir)*sstp - wl;
297			dst[di] += src[ssi]intvlrdstp;
298			ssi += sdir;
299			si++;
300			}
301			wl += intvl;
302			}
303			}
304
305
306	greg	2.22	void *
307	greg	2.17	tempbuffer( /* get a temporary buffer */
308	greg	2.27	size_t len
309	greg	2.17	)
310	greg	1.14	{
311	greg	2.27	static void *tempbuf = NULL;
312			static size_t tempbuflen = 0;
313	greg	1.14
314	greg	2.22	if (!len) { /* call to free */
315			if (tempbuflen) {
316	greg	2.20	free(tempbuf);
317	greg	2.22	tempbuf = NULL;
318			tempbuflen = 0;
319			}
320			return(NULL);
321	greg	1.14	}
322	greg	2.22	if (len <= tempbuflen) /* big enough already? */
323			return(tempbuf);
324			/* else free & reallocate */
325			if (tempbuflen)
326			free(tempbuf);
327			tempbuf = malloc(len);
328			tempbuflen = len*(tempbuf != NULL);
329	greg	1.14	return(tempbuf);
330			}
331
332
333	greg	2.9	int
334	greg	2.17	fwritecolrs( /* write out a colr scanline */
335			COLR *scanline,
336			int len,
337			FILE *fp
338			)
339	greg	1.1	{
340	greg	2.17	int i, j, beg, cnt = 1;
341	greg	1.14	int c2;
342	greg	1.1
343	schorsch	2.13	if ((len < MINELEN) \| (len > MAXELEN)) /* OOBs, write out flat */
344	greg	1.14	return(fwrite((char *)scanline,sizeof(COLR),len,fp) - len);
345	greg	2.2	/* put magic header */
346			putc(2, fp);
347	greg	1.14	putc(2, fp);
348			putc(len>>8, fp);
349	greg	2.21	putc(len&0xff, fp);
350	greg	1.14	/* put components seperately */
351			for (i = 0; i < 4; i++) {
352			for (j = 0; j < len; j += cnt) { /* find next run */
353			for (beg = j; beg < len; beg += cnt) {
354	greg	2.20	for (cnt = 1; (cnt < 127) & (beg+cnt < len) &&
355	greg	1.14	scanline[beg+cnt][i] == scanline[beg][i]; cnt++)
356			;
357			if (cnt >= MINRUN)
358			break; /* long enough */
359	greg	1.1	}
360	greg	2.20	if ((beg-j > 1) & (beg-j < MINRUN)) {
361	greg	1.15	c2 = j+1;
362			while (scanline[c2++][i] == scanline[j][i])
363			if (c2 == beg) { /* short run */
364			putc(128+beg-j, fp);
365			putc(scanline[j][i], fp);
366			j = beg;
367			break;
368			}
369			}
370			while (j < beg) { /* write out non-run */
371	greg	1.14	if ((c2 = beg-j) > 128) c2 = 128;
372			putc(c2, fp);
373			while (c2--)
374			putc(scanline[j++][i], fp);
375			}
376			if (cnt >= MINRUN) { /* write out run */
377			putc(128+cnt, fp);
378			putc(scanline[beg][i], fp);
379			} else
380			cnt = 0;
381			}
382	greg	1.1	}
383			return(ferror(fp) ? -1 : 0);
384			}
385
386	greg	2.23	/*
387			* An old-format scanline is either a stream of valid RGBE or XYZE real
388			* pixels or at least one real pixel followed by some number of
389			* invalid real pixels of the form (1,1,1,n), where n is a count.
390			* These can themselves be repeated to create a multibyte repeat
391			* count, with the least significant byte first (little-endian order.)
392			* Repeat counts are limited by the size of an int; if a repetition
393			* leads to an overrun, the rest of the the repetition will be
394			* silently ignored.
395			*/
396	greg	2.9	static int
397	greg	2.19	oldreadcolrs( /* read in an old-style colr scanline */
398	greg	2.17	COLR *scanline,
399			int len,
400			FILE *fp
401			)
402	greg	2.9	{
403	greg	2.25	int rshift = 0;
404	greg	2.17	int i;
405	greg	2.9
406			while (len > 0) {
407			scanline[0][RED] = getc(fp);
408			scanline[0][GRN] = getc(fp);
409			scanline[0][BLU] = getc(fp);
410	greg	2.18	scanline[0][EXP] = i = getc(fp);
411			if (i == EOF)
412	greg	2.9	return(-1);
413	greg	2.20	if (scanline[0][GRN] == 1 &&
414			(scanline[0][RED] == 1) &
415	greg	2.25	(scanline[0][BLU] == 1)) {
416	greg	2.20	i = scanline[0][EXP] << rshift;
417			while (i--) {
418	greg	2.9	copycolr(scanline[0], scanline[-1]);
419	greg	2.20	if (--len <= 0)
420			return(0);
421	greg	2.9	scanline++;
422			}
423			rshift += 8;
424			} else {
425			scanline++;
426			len--;
427			rshift = 0;
428			}
429			}
430			return(0);
431			}
432
433	greg	2.23	/*
434			* There are two scanline formats: old and new. The old format
435			* compresses runs of RGBE or XYZE four-byte real pixels; the new
436			* format breaks the pixels into R, G, B, and E lines (or XYZE lines)
437			* which are individually run-length encoded.
438			*
439			* An old-format scanline always begins with a valid real pixel; at
440			* least one of the RGB (or XYZ) values will have its high-order bit
441			* set. A new-format scanline begins with four bytes which are not a
442			* valid real pixel: (2, 2, lenhigh, lenlow) where lenhigh is always
443			* less than 128 and hence never has a high-order bit set.
444			*
445			* A new-format scanline is broken into its RGBE or XYZE components.
446			* Each is output and run-length encoded separately so that a scanline
447			* is broken into four records. In turn, each record is organized
448			* into chunks of up to 128 characters, which begin with a count byte.
449			* If the count byte is greater than 128, the following data byte is
450			* repeated (count-128) times. If not, the count byte is followed by
451			* that many data bytes.
452			*/
453	greg	2.9	int
454	greg	2.17	freadcolrs( /* read in an encoded colr scanline */
455			COLR *scanline,
456			int len,
457			FILE *fp
458			)
459	greg	1.1	{
460	greg	2.17	int i, j;
461	greg	2.6	int code, val;
462	greg	1.14	/* determine scanline type */
463	greg	2.26	if (len <= 0)
464			return(0);
465	greg	1.14	if ((i = getc(fp)) == EOF)
466			return(-1);
467	greg	2.26	scanline[0][RED] = i;
468	greg	1.14	scanline[0][GRN] = getc(fp);
469			scanline[0][BLU] = getc(fp);
470			if ((i = getc(fp)) == EOF)
471			return(-1);
472	greg	2.26	if ((scanline[0][RED] != 2) \| (scanline[0][GRN] != 2) \|
473			(scanline[0][BLU] & 0x80)) {
474	greg	1.14	scanline[0][EXP] = i;
475			return(oldreadcolrs(scanline+1, len-1, fp));
476			}
477			if ((scanline[0][BLU]<<8 \| i) != len)
478			return(-1); /* length mismatch! */
479			/* read each component */
480			for (i = 0; i < 4; i++)
481			for (j = 0; j < len; ) {
482			if ((code = getc(fp)) == EOF)
483			return(-1);
484			if (code > 128) { /* run */
485	greg	2.6	code &= 127;
486	greg	2.9	if ((val = getc(fp)) == EOF)
487			return -1;
488	greg	2.16	if (j + code > len)
489			return -1; /* overrun */
490	greg	2.6	while (code--)
491			scanline[j++][i] = val;
492	greg	2.16	} else { /* non-run */
493			if (j + code > len)
494			return -1; /* overrun */
495	greg	2.9	while (code--) {
496			if ((val = getc(fp)) == EOF)
497			return -1;
498			scanline[j++][i] = val;
499			}
500	greg	2.16	}
501	greg	1.14	}
502	greg	1.1	return(0);
503			}
504
505
506	greg	2.30	/* read an nc-component common-exponent color scanline */
507			int
508			freadscolrs(uby8 scanline, int nc, int len, FILE fp)
509			{
510	greg	2.32	if (nc < 3)
511			return(-1);
512			if (nc == 3)
513			return(freadcolrs((COLR *)scanline, len, fp));
514
515	greg	2.30	if (fread(scanline, nc+1, len, fp) != len)
516			return(-1);
517			return(0);
518			}
519
520
521	greg	2.31	/* write an common-exponent spectral color scanline */
522	greg	2.30	int
523	greg	2.31	fwritescolrs(uby8 sscanline, int nc, int len, FILE fp)
524	greg	2.30	{
525	greg	2.32	if (nc < 3)
526			return(-1);
527			if (nc == 3)
528			return(fwritecolrs((COLR *)sscanline, len, fp));
529
530	greg	2.31	if (fwrite(sscanline, nc+1, len, fp) != len)
531	greg	2.30	return(-1);
532			return(0);
533			}
534
535
536	greg	2.9	int
537	greg	2.32	fwritescan( /* write out an RGB or XYZ scanline */
538	greg	2.17	COLOR *scanline,
539			int len,
540			FILE *fp
541			)
542	greg	1.1	{
543	greg	1.14	COLR *clrscan;
544			int n;
545	greg	2.17	COLR *sp;
546	greg	1.14	/* get scanline buffer */
547			if ((sp = (COLR )tempbuffer(lensizeof(COLR))) == NULL)
548			return(-1);
549			clrscan = sp;
550			/* convert scanline */
551			n = len;
552			while (n-- > 0) {
553			setcolr(sp[0], scanline[0][RED],
554	greg	1.1	scanline[0][GRN],
555			scanline[0][BLU]);
556			scanline++;
557	greg	1.14	sp++;
558	greg	1.1	}
559	greg	1.14	return(fwritecolrs(clrscan, len, fp));
560	greg	1.1	}
561
562
563	greg	2.9	int
564	greg	2.32	freadscan( /* read in an RGB or XYZ scanline */
565	greg	2.17	COLOR *scanline,
566			int len,
567			FILE *fp
568			)
569	greg	1.1	{
570	greg	2.17	COLR *clrscan;
571	greg	1.14
572			if ((clrscan = (COLR )tempbuffer(lensizeof(COLR))) == NULL)
573			return(-1);
574			if (freadcolrs(clrscan, len, fp) < 0)
575			return(-1);
576			/* convert scanline */
577			colr_color(scanline[0], clrscan[0]);
578			while (--len > 0) {
579			scanline++; clrscan++;
580	greg	2.20	if (clrscan[0][GRN] == clrscan[-1][GRN] &&
581			(clrscan[0][RED] == clrscan[-1][RED]) &
582			(clrscan[0][BLU] == clrscan[-1][BLU]) &
583			(clrscan[0][EXP] == clrscan[-1][EXP]))
584	greg	1.14	copycolor(scanline[0], scanline[-1]);
585			else
586			colr_color(scanline[0], clrscan[0]);
587	greg	1.1	}
588			return(0);
589			}
590
591
592	greg	2.30	/* read an nc-component color scanline */
593			int
594			freadsscan(COLORV sscanline, int nc, int len, FILE fp)
595			{
596			uby8 tscn = (uby8 )tempbuffer((nc+1)*len);
597			int i;
598
599			if (tscn == NULL \|\| freadscolrs(tscn, nc, len, fp) < 0)
600			return(-1);
601			for (i = len; i-- > 0; ) {
602			scolr2scolor(sscanline, tscn, nc);
603			sscanline += nc;
604			tscn += nc+1;
605			}
606			return(0);
607			}
608
609
610	greg	2.32	/* write an nc-component spectral color scanline */
611	greg	2.30	int
612	greg	2.31	fwritesscan(COLORV sscanline, int nc, int len, FILE fp)
613	greg	2.30	{
614	greg	2.31	uby8 tscn = (uby8 )tempbuffer((nc+1)*len);
615	greg	2.30	int i;
616
617			if (tscn == NULL)
618			return(-1);
619			for (i = 0; i < len; i++) {
620	greg	2.31	scolor2scolr(tscn+i*(nc+1), sscanline, nc);
621			sscanline += nc;
622	greg	2.30	}
623	greg	2.31	return(fwritescolrs(tscn, nc, len, fp));
624	greg	2.30	}
625
626
627	greg	2.9	void
628	greg	2.17	setcolr( /* assign a short color value */
629			COLR clr,
630			double r,
631			double g,
632			double b
633			)
634	greg	1.1	{
635			double d;
636			int e;
637
638			d = r > g ? r : g;
639			if (b > d) d = b;
640
641	greg	1.4	if (d <= 1e-32) {
642	greg	1.1	clr[RED] = clr[GRN] = clr[BLU] = 0;
643			clr[EXP] = 0;
644			return;
645			}
646
647	greg	2.21	d = frexp(d, &e) * 256.0 / d;
648	greg	1.1
649	greg	2.27	clr[RED] = (r > 0) * (int)(r*d);
650			clr[GRN] = (g > 0) * (int)(g*d);
651			clr[BLU] = (b > 0) * (int)(b*d);
652	greg	1.1	clr[EXP] = e + COLXS;
653			}
654
655
656	greg	2.9	void
657	greg	2.17	colr_color( /* convert short to float color */
658			COLOR col,
659			COLR clr
660			)
661	greg	1.1	{
662	greg	1.6	double f;
663	greg	1.1
664	greg	2.27	if (clr[EXP] == 0) {
665	greg	1.1	col[RED] = col[GRN] = col[BLU] = 0.0;
666	greg	2.27	return;
667	greg	1.1	}
668	greg	2.27	f = ldexp(1.0, (int)clr[EXP]-(COLXS+8));
669			col[RED] = (clr[RED] + 0.5)*f;
670			col[GRN] = (clr[GRN] + 0.5)*f;
671			col[BLU] = (clr[BLU] + 0.5)*f;
672	greg	1.6	}
673
674
675	greg	2.9	int
676	greg	2.17	bigdiff( /* c1 delta c2 > md? */
677			COLOR c1,
678			COLOR c2,
679			double md
680			)
681	greg	1.7	{
682	greg	2.17	int i;
683	greg	1.7
684			for (i = 0; i < 3; i++)
685	greg	2.27	if ((colval(c1,i)-colval(c2,i) > md*colval(c2,i)) \|
686			(colval(c2,i)-colval(c1,i) > md*colval(c1,i)))
687			return(1);
688			return(0);
689			}
690
691
692			int
693			sbigsdiff( /* sc1 delta sc2 > md? */
694			SCOLOR c1,
695			SCOLOR c2,
696			double md
697			)
698			{
699			int i = NCSAMP;
700
701			while (i--)
702			if ((c1[i]-c2[i] > mdc2[i]) \| (c2[i]-c1[i] > mdc1[i]))
703	greg	1.7	return(1);
704			return(0);
705			}