src/px/neuclrtab.c

#ifndef lint
static const char       RCSid[] = "$Id: neuclrtab.c,v 2.13 2007/09/08 19:17:52 greg Exp $";
#endif
/*
 * Neural-Net quantization algorithm based on work of Anthony Dekker
 */

#include "copyright.h"

#include <string.h>

#include "standard.h"
#include "color.h"
#include "random.h"
#include "clrtab.h"

#ifdef COMPAT_MODE
#define neu_init        new_histo
#define neu_pixel       cnt_pixel
#define neu_colrs       cnt_colrs
#define neu_clrtab      new_clrtab
#define neu_map_pixel   map_pixel
#define neu_map_colrs   map_colrs
#define neu_dith_colrs  dith_colrs
#endif
                                /* our color table (global) */
extern uby8     clrtab[256][3];
static int      clrtabsiz;

#ifndef DEFSMPFAC
#define DEFSMPFAC       3
#endif

int     samplefac = DEFSMPFAC;  /* sampling factor */

                /* Samples array starts off holding spacing between adjacent
                 * samples, and ends up holding actual BGR sample values.
                 */
static uby8     *thesamples;
static int      nsamples;
static uby8     *cursamp;
static long     skipcount;

#define MAXSKIP         (1<<24-1)

#define nskip(sp)       ((long)(sp)[0]<<16|(long)(sp)[1]<<8|(long)(sp)[2])

#define setskip(sp,n)   ((sp)[0]=(n)>>16,(sp)[1]=((n)>>8)&255,(sp)[2]=(n)&255)

static void initnet(void);
static void inxbuild(void);
static int inxsearch(int b, int g, int r);
static int contest(int b, int g, int r);
static void altersingle(int alpha, int i, int b, int g, int r);
static void alterneigh(int rad, int i, int b, int g, int r);
static void learn(void);
static void unbiasnet(void);
static void cpyclrtab(void);


extern int
neu_init(               /* initialize our sample array */
        long    npixels
)
{
        register int    nsleft;
        register long   sv;
        double  rval, cumprob;
        long    npleft;

        nsamples = npixels/samplefac;
        if (nsamples < 600)
                return(-1);
        thesamples = (uby8 *)malloc(nsamples*3);
        if (thesamples == NULL)
                return(-1);
        cursamp = thesamples;
        npleft = npixels;
        nsleft = nsamples;
        while (nsleft) {
                rval = frandom();       /* random distance to next sample */
                sv = 0;
                cumprob = 0.;
                while ((cumprob += (1.-cumprob)*nsleft/(npleft-sv)) < rval)
                        sv++;
                if (nsleft == nsamples)
                        skipcount = sv;
                else {
                        setskip(cursamp, sv);
                        cursamp += 3;
                }
                npleft -= sv+1;
                nsleft--;
        }
        setskip(cursamp, npleft);       /* tag on end to skip the rest */
        cursamp = thesamples;
        return(0);
}


extern void
neu_pixel(                      /* add pixel to our samples */
        register uby8   col[]
)
{
        if (!skipcount--) {
                skipcount = nskip(cursamp);
                cursamp[0] = col[BLU];
                cursamp[1] = col[GRN];
                cursamp[2] = col[RED];
                cursamp += 3;
        }
}


extern void
neu_colrs(              /* add a scanline to our samples */
        register COLR   *cs,
        register int    n
)
{
        while (n > skipcount) {
                cs += skipcount;
                n -= skipcount+1;
                skipcount = nskip(cursamp);
                cursamp[0] = cs[0][BLU];
                cursamp[1] = cs[0][GRN];
                cursamp[2] = cs[0][RED];
                cs++;
                cursamp += 3;
        }
        skipcount -= n;
}


extern int
neu_clrtab(             /* make new color table using ncolors */
        int     ncolors
)
{
        clrtabsiz = ncolors;
        if (clrtabsiz > 256) clrtabsiz = 256;
        initnet();
        learn();
        unbiasnet();
        cpyclrtab();
        inxbuild();
                                /* we're done with our samples */
        free((void *)thesamples);
                                /* reset dithering function */
        neu_dith_colrs((uby8 *)NULL, (COLR *)NULL, 0);
                                /* return new color table size */
        return(clrtabsiz);
}


extern int
neu_map_pixel(          /* get pixel for color */
        register uby8   col[]
)
{
        return(inxsearch(col[BLU],col[GRN],col[RED]));
}


extern void
neu_map_colrs(  /* convert a scanline to color index values */
        register uby8   *bs,
        register COLR   *cs,
        register int    n
)
{
        while (n-- > 0) {
                *bs++ = inxsearch(cs[0][BLU],cs[0][GRN],cs[0][RED]);
                cs++;
        }
}


extern void
neu_dith_colrs( /* convert scanline to dithered index values */
        register uby8   *bs,
        register COLR   *cs,
        int     n
)
{
        static short    (*cerr)[3] = NULL;
        static int      N = 0;
        int     err[3], errp[3];
        register int    x, i;

        if (n != N) {           /* get error propogation array */
                if (N) {
                        free((void *)cerr);
                        cerr = NULL;
                }
                if (n)
                        cerr = (short (*)[3])malloc(3*n*sizeof(short));
                if (cerr == NULL) {
                        N = 0;
                        map_colrs(bs, cs, n);
                        return;
                }
                N = n;
                memset((char *)cerr, '\0', 3*N*sizeof(short));
        }
        err[0] = err[1] = err[2] = 0;
        for (x = 0; x < n; x++) {
                for (i = 0; i < 3; i++) {       /* dither value */
                        errp[i] = err[i];
                        err[i] += cerr[x][i];
#ifdef MAXERR
                        if (err[i] > MAXERR) err[i] = MAXERR;
                        else if (err[i] < -MAXERR) err[i] = -MAXERR;
#endif
                        err[i] += cs[x][i];
                        if (err[i] < 0) err[i] = 0;
                        else if (err[i] > 255) err[i] = 255;
                }
                bs[x] = inxsearch(err[BLU],err[GRN],err[RED]);
                for (i = 0; i < 3; i++) {       /* propagate error */
                        err[i] -= clrtab[bs[x]][i];
                        err[i] /= 3;
                        cerr[x][i] = err[i] + errp[i];
                }
        }
}

/* The following was adapted and modified from the original (GW)        */

/* cheater definitions (GW) */
#define thepicture      thesamples
#define lengthcount     (nsamples*3)
#define samplefac       1

/* NeuQuant Neural-Net Quantization Algorithm Interface
 * ----------------------------------------------------
 *
 * Copyright (c) 1994 Anthony Dekker
 *
 * NEUQUANT Neural-Net quantization algorithm by Anthony Dekker, 1994.
 * See "Kohonen neural networks for optimal colour quantization"
 * in "Network: Computation in Neural Systems" Vol. 5 (1994) pp 351-367.
 * for a discussion of the algorithm.
 * See also  http://members.ozemail.com.au/~dekker/NEUQUANT.HTML
 *
 * Any party obtaining a copy of these files from the author, directly or
 * indirectly, is granted, free of charge, a full and unrestricted irrevocable,
 * world-wide, paid up, royalty-free, nonexclusive right and license to deal
 * in this software and documentation files (the "Software"), including without
 * limitation the rights to use, copy, modify, merge, publish, distribute, sublicense,
 * and/or sell copies of the Software, and to permit persons who receive
 * copies from any such party to do so, with the only requirement being
 * that this copyright notice remain intact.
 */

#define bool            int
#define false           0
#define true            1

/* network defs */
#define netsize         clrtabsiz               /* number of colours - can change this */
#define maxnetpos       (netsize-1)
#define netbiasshift    4                       /* bias for colour values */
#define ncycles         100                     /* no. of learning cycles */

/* defs for freq and bias */
#define intbiasshift    16                      /* bias for fractions */
#define intbias         (((int) 1)<<intbiasshift)
#define gammashift      10                      /* gamma = 1024 */
#define gamma           (((int) 1)<<gammashift)
#define betashift       10
#define beta            (intbias>>betashift)    /* beta = 1/1024 */
#define betagamma       (intbias<<(gammashift-betashift))

/* defs for decreasing radius factor */
#define initrad         (256>>3)                /* for 256 cols, radius starts */
#define radiusbiasshift 6                       /* at 32.0 biased by 6 bits */
#define radiusbias      (((int) 1)<<radiusbiasshift)
#define initradius      (initrad*radiusbias)    /* and decreases by a */
#define radiusdec       30                      /* factor of 1/30 each cycle */ 

/* defs for decreasing alpha factor */
#define alphabiasshift  10                      /* alpha starts at 1.0 */
#define initalpha       (((int) 1)<<alphabiasshift)
int alphadec;                                   /* biased by 10 bits */

/* radbias and alpharadbias used for radpower calculation */
#define radbiasshift    8
#define radbias         (((int) 1)<<radbiasshift)
#define alpharadbshift  (alphabiasshift+radbiasshift)
#define alpharadbias    (((int) 1)<<alpharadbshift)

/* four primes near 500 - assume no image has a length so large */
/* that it is divisible by all four primes */
#define prime1          499
#define prime2          491
#define prime3          487
#define prime4          503

typedef int pixel[4];  /* BGRc */
pixel network[256];

int netindex[256];      /* for network lookup - really 256 */

int bias [256];         /* bias and freq arrays for learning */
int freq [256];
int radpower[initrad];  /* radpower for precomputation */


/* initialise network in range (0,0,0) to (255,255,255) */

static void
initnet(void)   
{
        register int i;
        register int *p;
        
        for (i=0; i<netsize; i++) {
                p = network[i];
                p[0] = p[1] = p[2] = (i << (netbiasshift+8))/netsize;
                freq[i] = intbias/netsize;  /* 1/netsize */
                bias[i] = 0;
        }
}


/* do after unbias - insertion sort of network and build netindex[0..255] */

static void
inxbuild(void)
{
        register int i,j,smallpos,smallval;
        register int *p,*q;
        int previouscol,startpos;

        previouscol = 0;
        startpos = 0;
        for (i=0; i<netsize; i++) {
                p = network[i];
                smallpos = i;
                smallval = p[1];        /* index on g */
                /* find smallest in i..netsize-1 */
                for (j=i+1; j<netsize; j++) {
                        q = network[j];
                        if (q[1] < smallval) {  /* index on g */
                                smallpos = j;
                                smallval = q[1]; /* index on g */
                        }
                }
                q = network[smallpos];
                /* swap p (i) and q (smallpos) entries */
                if (i != smallpos) {
                        j = q[0];   q[0] = p[0];   p[0] = j;
                        j = q[1];   q[1] = p[1];   p[1] = j;
                        j = q[2];   q[2] = p[2];   p[2] = j;
                        j = q[3];   q[3] = p[3];   p[3] = j;
                }
                /* smallval entry is now in position i */
                if (smallval != previouscol) {
                        netindex[previouscol] = (startpos+i)>>1;
                        for (j=previouscol+1; j<smallval; j++) netindex[j] = i;
                        previouscol = smallval;
                        startpos = i;
                }
        }
        netindex[previouscol] = (startpos+maxnetpos)>>1;
        for (j=previouscol+1; j<256; j++) netindex[j] = maxnetpos; /* really 256 */
}


static int
inxsearch(  /* accepts real BGR values after net is unbiased */
        register int b,
        register int g,
        register int r
)
{
        register int i,j,dist,a,bestd;
        register int *p;
        int best;

        bestd = 1000;   /* biggest possible dist is 256*3 */
        best = -1;
        i = netindex[g]; /* index on g */
        j = i-1;         /* start at netindex[g] and work outwards */

        while ((i<netsize) || (j>=0)) {
                if (i<netsize) {
                        p = network[i];
                        dist = p[1] - g;        /* inx key */
                        if (dist >= bestd) i = netsize; /* stop iter */
                        else {
                                i++;
                                if (dist<0) dist = -dist;
                                a = p[0] - b;   if (a<0) a = -a;
                                dist += a;
                                if (dist<bestd) {
                                        a = p[2] - r;   if (a<0) a = -a;
                                        dist += a;
                                        if (dist<bestd) {bestd=dist; best=p[3];}
                                }
                        }
                }
                if (j>=0) {
                        p = network[j];
                        dist = g - p[1]; /* inx key - reverse dif */
                        if (dist >= bestd) j = -1; /* stop iter */
                        else {
                                j--;
                                if (dist<0) dist = -dist;
                                a = p[0] - b;   if (a<0) a = -a;
                                dist += a;
                                if (dist<bestd) {
                                        a = p[2] - r;   if (a<0) a = -a;
                                        dist += a;
                                        if (dist<bestd) {bestd=dist; best=p[3];}
                                }
                        }
                }
        }
        return(best);
}


/* finds closest neuron (min dist) and updates freq */
/* finds best neuron (min dist-bias) and returns position */
/* for frequently chosen neurons, freq[i] is high and bias[i] is negative */
/* bias[i] = gamma*((1/netsize)-freq[i]) */

static int
contest(        /* accepts biased BGR values */
        register int b,
        register int g,
        register int r
)
{
        register int i,dist,a,biasdist,betafreq;
        int bestpos,bestbiaspos,bestd,bestbiasd;
        register int *p,*f, *n;

        bestd = ~(((int) 1)<<31);
        bestbiasd = bestd;
        bestpos = -1;
        bestbiaspos = bestpos;
        p = bias;
        f = freq;

        for (i=0; i<netsize; i++) {
                n = network[i];
                dist = n[0] - b;   if (dist<0) dist = -dist;
                a = n[1] - g;   if (a<0) a = -a;
                dist += a;
                a = n[2] - r;   if (a<0) a = -a;
                dist += a;
                if (dist<bestd) {bestd=dist; bestpos=i;}
                biasdist = dist - ((*p)>>(intbiasshift-netbiasshift));
                if (biasdist<bestbiasd) {bestbiasd=biasdist; bestbiaspos=i;}
                betafreq = (*f >> betashift);
                *f++ -= betafreq;
                *p++ += (betafreq<<gammashift);
        }
        freq[bestpos] += beta;
        bias[bestpos] -= betagamma;
        return(bestbiaspos);
}


/* move neuron i towards (b,g,r) by factor alpha */

static void
altersingle(    /* accepts biased BGR values */
        register int alpha,
        register int i,
        register int b,
        register int g,
        register int r
)
{
        register int *n;

        n = network[i];         /* alter hit neuron */
        *n -= (alpha*(*n - b)) / initalpha;
        n++;
        *n -= (alpha*(*n - g)) / initalpha;
        n++;
        *n -= (alpha*(*n - r)) / initalpha;
}


/* move neurons adjacent to i towards (b,g,r) by factor */
/* alpha*(1-((i-j)^2/[r]^2)) precomputed as radpower[|i-j|]*/

static void
alterneigh(     /* accents biased BGR values */
        int rad,
        int i,
        register int b,
        register int g,
        register int r
)
{
        register int j,k,lo,hi,a;
        register int *p, *q;

        lo = i-rad;   if (lo<-1) lo= -1;
        hi = i+rad;   if (hi>netsize) hi=netsize;

        j = i+1;
        k = i-1;
        q = radpower;
        while ((j<hi) || (k>lo)) {
                a = (*(++q));
                if (j<hi) {
                        p = network[j];
                        *p -= (a*(*p - b)) / alpharadbias;
                        p++;
                        *p -= (a*(*p - g)) / alpharadbias;
                        p++;
                        *p -= (a*(*p - r)) / alpharadbias;
                        j++;
                }
                if (k>lo) {
                        p = network[k];
                        *p -= (a*(*p - b)) / alpharadbias;
                        p++;
                        *p -= (a*(*p - g)) / alpharadbias;
                        p++;
                        *p -= (a*(*p - r)) / alpharadbias;
                        k--;
                }
        }
}


static void
learn(void)
{
        register int i,j,b,g,r;
        int radius,rad,alpha,step,delta,samplepixels;
        register unsigned char *p;
        unsigned char *lim;

        alphadec = 30 + ((samplefac-1)/3);
        p = thepicture;
        lim = thepicture + lengthcount;
        samplepixels = lengthcount/(3*samplefac);
        delta = samplepixels/ncycles;
        alpha = initalpha;
        radius = initradius;
        
        rad = radius >> radiusbiasshift;
        if (rad <= 1) rad = 0;
        for (i=0; i<rad; i++) 
                radpower[i] = alpha*(((rad*rad - i*i)*radbias)/(rad*rad));
        
        if ((lengthcount%prime1) != 0) step = 3*prime1;
        else {
                if ((lengthcount%prime2) !=0) step = 3*prime2;
                else {
                        if ((lengthcount%prime3) !=0) step = 3*prime3;
                        else step = 3*prime4;
                }
        }
        
        i = 0;
        while (i < samplepixels) {
                b = p[0] << netbiasshift;
                g = p[1] << netbiasshift;
                r = p[2] << netbiasshift;
                j = contest(b,g,r);

                altersingle(alpha,j,b,g,r);
                if (rad) alterneigh(rad,j,b,g,r);   /* alter neighbours */

                p += step;
                if (p >= lim) p -= lengthcount;
        
                i++;
                if (i%delta == 0) {     
                        alpha -= alpha / alphadec;
                        radius -= radius / radiusdec;
                        rad = radius >> radiusbiasshift;
                        if (rad <= 1) rad = 0;
                        for (j=0; j<rad; j++) 
                                radpower[j] = alpha*(((rad*rad - j*j)*radbias)/(rad*rad));
                }
        }
}
        
/* unbias network to give 0..255 entries */
/* which can then be used for colour map */
/* and record position i to prepare for sort */

static void
unbiasnet(void)
{
        int i,j;

        for (i=0; i<netsize; i++) {
                for (j=0; j<3; j++)
                        network[i][j] >>= netbiasshift;
                network[i][3] = i; /* record colour no */
        }
}


/* Don't do this until the network has been unbiased (GW) */
                
static void
cpyclrtab(void)
{
        register int i,j,k;
        
        for (j=0; j<netsize; j++) {
                k = network[j][3];
                for (i = 0; i < 3; i++)
                        clrtab[k][i] = network[j][2-i];
        }
}
Revision:	2.14
Committed:	Fri May 20 02:06:39 2011 UTC (12 years, 11 months ago) by greg
Content type:	text/plain
Branch:	MAIN
CVS Tags:	rad5R4, rad5R2, rad4R2P2, rad5R0, rad5R1, rad4R2, rad4R1, rad4R2P1, rad5R3, HEAD
Changes since 2.13:	+10 -10 lines
Log Message:	Changed every instance of BYTE to uby8 to avoid conflicts
#	User	Rev	Content
1	greg	2.1	#ifndef lint
2	greg	2.14	static const char RCSid[] = "$Id: neuclrtab.c,v 2.13 2007/09/08 19:17:52 greg Exp $";
3	greg	2.1	#endif
4			/*
5			* Neural-Net quantization algorithm based on work of Anthony Dekker
6			*/
7
8	schorsch	2.10	#include "copyright.h"
9
10			#include <string.h>
11
12	greg	2.1	#include "standard.h"
13			#include "color.h"
14			#include "random.h"
15	schorsch	2.11	#include "clrtab.h"
16	greg	2.1
17			#ifdef COMPAT_MODE
18			#define neu_init new_histo
19			#define neu_pixel cnt_pixel
20			#define neu_colrs cnt_colrs
21			#define neu_clrtab new_clrtab
22			#define neu_map_pixel map_pixel
23			#define neu_map_colrs map_colrs
24			#define neu_dith_colrs dith_colrs
25			#endif
26			/* our color table (global) */
27	greg	2.14	extern uby8 clrtab[256][3];
28	greg	2.1	static int clrtabsiz;
29
30			#ifndef DEFSMPFAC
31	greg	2.12	#define DEFSMPFAC 3
32	greg	2.1	#endif
33
34			int samplefac = DEFSMPFAC; /* sampling factor */
35
36			/* Samples array starts off holding spacing between adjacent
37			* samples, and ends up holding actual BGR sample values.
38			*/
39	greg	2.14	static uby8 *thesamples;
40	greg	2.1	static int nsamples;
41	greg	2.14	static uby8 *cursamp;
42	greg	2.1	static long skipcount;
43
44			#define MAXSKIP (1<<24-1)
45
46			#define nskip(sp) ((long)(sp)[0]<<16\|(long)(sp)[1]<<8\|(long)(sp)[2])
47
48			#define setskip(sp,n) ((sp)[0]=(n)>>16,(sp)[1]=((n)>>8)&255,(sp)[2]=(n)&255)
49
50	schorsch	2.11	static void initnet(void);
51			static void inxbuild(void);
52			static int inxsearch(int b, int g, int r);
53			static int contest(int b, int g, int r);
54			static void altersingle(int alpha, int i, int b, int g, int r);
55			static void alterneigh(int rad, int i, int b, int g, int r);
56			static void learn(void);
57			static void unbiasnet(void);
58			static void cpyclrtab(void);
59	greg	2.8
60	greg	2.1
61	schorsch	2.11	extern int
62			neu_init( /* initialize our sample array */
63			long npixels
64			)
65	greg	2.1	{
66			register int nsleft;
67			register long sv;
68			double rval, cumprob;
69			long npleft;
70
71			nsamples = npixels/samplefac;
72			if (nsamples < 600)
73			return(-1);
74	greg	2.14	thesamples = (uby8 )malloc(nsamples3);
75	greg	2.1	if (thesamples == NULL)
76			return(-1);
77			cursamp = thesamples;
78			npleft = npixels;
79			nsleft = nsamples;
80			while (nsleft) {
81			rval = frandom(); /* random distance to next sample */
82			sv = 0;
83			cumprob = 0.;
84			while ((cumprob += (1.-cumprob)*nsleft/(npleft-sv)) < rval)
85			sv++;
86	greg	2.2	if (nsleft == nsamples)
87			skipcount = sv;
88			else {
89			setskip(cursamp, sv);
90			cursamp += 3;
91			}
92			npleft -= sv+1;
93	greg	2.1	nsleft--;
94			}
95	greg	2.2	setskip(cursamp, npleft); /* tag on end to skip the rest */
96	greg	2.1	cursamp = thesamples;
97			return(0);
98			}
99
100
101	schorsch	2.11	extern void
102			neu_pixel( /* add pixel to our samples */
103	greg	2.14	register uby8 col[]
104	schorsch	2.11	)
105	greg	2.1	{
106			if (!skipcount--) {
107	greg	2.2	skipcount = nskip(cursamp);
108	greg	2.1	cursamp[0] = col[BLU];
109			cursamp[1] = col[GRN];
110			cursamp[2] = col[RED];
111			cursamp += 3;
112			}
113			}
114
115
116	schorsch	2.11	extern void
117			neu_colrs( /* add a scanline to our samples */
118			register COLR *cs,
119			register int n
120			)
121	greg	2.1	{
122			while (n > skipcount) {
123			cs += skipcount;
124	greg	2.2	n -= skipcount+1;
125			skipcount = nskip(cursamp);
126	greg	2.1	cursamp[0] = cs[0][BLU];
127			cursamp[1] = cs[0][GRN];
128			cursamp[2] = cs[0][RED];
129			cs++;
130			cursamp += 3;
131			}
132			skipcount -= n;
133			}
134
135
136	schorsch	2.11	extern int
137			neu_clrtab( /* make new color table using ncolors */
138			int ncolors
139			)
140	greg	2.1	{
141			clrtabsiz = ncolors;
142			if (clrtabsiz > 256) clrtabsiz = 256;
143			initnet();
144			learn();
145			unbiasnet();
146			cpyclrtab();
147			inxbuild();
148			/* we're done with our samples */
149	greg	2.9	free((void *)thesamples);
150	greg	2.1	/* reset dithering function */
151	greg	2.14	neu_dith_colrs((uby8 )NULL, (COLR )NULL, 0);
152	greg	2.1	/* return new color table size */
153			return(clrtabsiz);
154			}
155
156
157	schorsch	2.11	extern int
158			neu_map_pixel( /* get pixel for color */
159	greg	2.14	register uby8 col[]
160	schorsch	2.11	)
161	greg	2.1	{
162			return(inxsearch(col[BLU],col[GRN],col[RED]));
163			}
164
165
166	schorsch	2.11	extern void
167			neu_map_colrs( /* convert a scanline to color index values */
168	greg	2.14	register uby8 *bs,
169	schorsch	2.11	register COLR *cs,
170			register int n
171			)
172	greg	2.1	{
173			while (n-- > 0) {
174			*bs++ = inxsearch(cs[0][BLU],cs[0][GRN],cs[0][RED]);
175			cs++;
176			}
177			}
178
179
180	schorsch	2.11	extern void
181			neu_dith_colrs( /* convert scanline to dithered index values */
182	greg	2.14	register uby8 *bs,
183	schorsch	2.11	register COLR *cs,
184			int n
185			)
186	greg	2.1	{
187			static short (*cerr)[3] = NULL;
188			static int N = 0;
189			int err[3], errp[3];
190			register int x, i;
191
192			if (n != N) { /* get error propogation array */
193			if (N) {
194	greg	2.9	free((void *)cerr);
195	greg	2.1	cerr = NULL;
196			}
197			if (n)
198			cerr = (short ()[3])malloc(3n*sizeof(short));
199			if (cerr == NULL) {
200			N = 0;
201			map_colrs(bs, cs, n);
202			return;
203			}
204			N = n;
205	schorsch	2.10	memset((char )cerr, '\0', 3N*sizeof(short));
206	greg	2.1	}
207			err[0] = err[1] = err[2] = 0;
208			for (x = 0; x < n; x++) {
209			for (i = 0; i < 3; i++) { /* dither value */
210			errp[i] = err[i];
211			err[i] += cerr[x][i];
212			#ifdef MAXERR
213			if (err[i] > MAXERR) err[i] = MAXERR;
214			else if (err[i] < -MAXERR) err[i] = -MAXERR;
215			#endif
216			err[i] += cs[x][i];
217			if (err[i] < 0) err[i] = 0;
218			else if (err[i] > 255) err[i] = 255;
219			}
220			bs[x] = inxsearch(err[BLU],err[GRN],err[RED]);
221			for (i = 0; i < 3; i++) { /* propagate error */
222			err[i] -= clrtab[bs[x]][i];
223			err[i] /= 3;
224			cerr[x][i] = err[i] + errp[i];
225			}
226			}
227			}
228
229			/* The following was adapted and modified from the original (GW) */
230	greg	2.6
231			/* cheater definitions (GW) */
232			#define thepicture thesamples
233			#define lengthcount (nsamples*3)
234			#define samplefac 1
235
236	greg	2.13	/* NeuQuant Neural-Net Quantization Algorithm Interface
237			* ----------------------------------------------------
238			*
239			* Copyright (c) 1994 Anthony Dekker
240			*
241			* NEUQUANT Neural-Net quantization algorithm by Anthony Dekker, 1994.
242			* See "Kohonen neural networks for optimal colour quantization"
243			* in "Network: Computation in Neural Systems" Vol. 5 (1994) pp 351-367.
244			* for a discussion of the algorithm.
245			* See also http://members.ozemail.com.au/~dekker/NEUQUANT.HTML
246			*
247			* Any party obtaining a copy of these files from the author, directly or
248			* indirectly, is granted, free of charge, a full and unrestricted irrevocable,
249			* world-wide, paid up, royalty-free, nonexclusive right and license to deal
250			* in this software and documentation files (the "Software"), including without
251			* limitation the rights to use, copy, modify, merge, publish, distribute, sublicense,
252			* and/or sell copies of the Software, and to permit persons who receive
253			* copies from any such party to do so, with the only requirement being
254			* that this copyright notice remain intact.
255			*/
256	greg	2.1
257	greg	2.6	#define bool int
258			#define false 0
259			#define true 1
260	greg	2.1
261	greg	2.6	/* network defs */
262	greg	2.7	#define netsize clrtabsiz /* number of colours - can change this */
263	greg	2.6	#define maxnetpos (netsize-1)
264			#define netbiasshift 4 /* bias for colour values */
265			#define ncycles 100 /* no. of learning cycles */
266	greg	2.1
267			/* defs for freq and bias */
268	greg	2.6	#define intbiasshift 16 /* bias for fractions */
269			#define intbias (((int) 1)<<intbiasshift)
270			#define gammashift 10 /* gamma = 1024 */
271			#define gamma (((int) 1)<<gammashift)
272			#define betashift 10
273			#define beta (intbias>>betashift) /* beta = 1/1024 */
274	greg	2.1	#define betagamma (intbias<<(gammashift-betashift))
275
276	greg	2.6	/* defs for decreasing radius factor */
277	greg	2.7	#define initrad (256>>3) /* for 256 cols, radius starts */
278	greg	2.6	#define radiusbiasshift 6 /* at 32.0 biased by 6 bits */
279			#define radiusbias (((int) 1)<<radiusbiasshift)
280			#define initradius (initradradiusbias) / and decreases by a */
281			#define radiusdec 30 /* factor of 1/30 each cycle */
282
283			/* defs for decreasing alpha factor */
284			#define alphabiasshift 10 /* alpha starts at 1.0 */
285			#define initalpha (((int) 1)<<alphabiasshift)
286			int alphadec; /* biased by 10 bits */
287
288			/* radbias and alpharadbias used for radpower calculation */
289	greg	2.1	#define radbiasshift 8
290	greg	2.6	#define radbias (((int) 1)<<radbiasshift)
291	greg	2.1	#define alpharadbshift (alphabiasshift+radbiasshift)
292	greg	2.6	#define alpharadbias (((int) 1)<<alpharadbshift)
293	greg	2.1
294	greg	2.6	/* four primes near 500 - assume no image has a length so large */
295			/* that it is divisible by all four primes */
296			#define prime1 499
297			#define prime2 491
298			#define prime3 487
299			#define prime4 503
300	greg	2.1
301			typedef int pixel[4]; /* BGRc */
302	greg	2.7	pixel network[256];
303	greg	2.1
304	greg	2.6	int netindex[256]; /* for network lookup - really 256 */
305	greg	2.1
306	greg	2.7	int bias [256]; /* bias and freq arrays for learning */
307			int freq [256];
308	greg	2.6	int radpower[initrad]; /* radpower for precomputation */
309	greg	2.1
310
311	greg	2.6	/* initialise network in range (0,0,0) to (255,255,255) */
312	greg	2.1
313	schorsch	2.11	static void
314			initnet(void)
315	greg	2.1	{
316			register int i;
317			register int *p;
318
319	greg	2.7	for (i=0; i<netsize; i++) {
320	greg	2.1	p = network[i];
321	greg	2.7	p[0] = p[1] = p[2] = (i << (netbiasshift+8))/netsize;
322			freq[i] = intbias/netsize; /* 1/netsize */
323	greg	2.1	bias[i] = 0;
324			}
325			}
326
327
328	greg	2.6	/* do after unbias - insertion sort of network and build netindex[0..255] */
329
330	schorsch	2.11	static void
331			inxbuild(void)
332	greg	2.1	{
333			register int i,j,smallpos,smallval;
334			register int p,q;
335	greg	2.6	int previouscol,startpos;
336	greg	2.1
337	greg	2.6	previouscol = 0;
338			startpos = 0;
339	greg	2.7	for (i=0; i<netsize; i++) {
340	greg	2.1	p = network[i];
341			smallpos = i;
342			smallval = p[1]; /* index on g */
343	greg	2.7	/* find smallest in i..netsize-1 */
344			for (j=i+1; j<netsize; j++) {
345	greg	2.1	q = network[j];
346			if (q[1] < smallval) { /* index on g */
347			smallpos = j;
348			smallval = q[1]; /* index on g */
349			}
350			}
351			q = network[smallpos];
352	greg	2.6	/* swap p (i) and q (smallpos) entries */
353	greg	2.1	if (i != smallpos) {
354			j = q[0]; q[0] = p[0]; p[0] = j;
355			j = q[1]; q[1] = p[1]; p[1] = j;
356			j = q[2]; q[2] = p[2]; p[2] = j;
357			j = q[3]; q[3] = p[3]; p[3] = j;
358			}
359			/* smallval entry is now in position i */
360	greg	2.6	if (smallval != previouscol) {
361			netindex[previouscol] = (startpos+i)>>1;
362			for (j=previouscol+1; j<smallval; j++) netindex[j] = i;
363			previouscol = smallval;
364			startpos = i;
365	greg	2.1	}
366			}
367	greg	2.6	netindex[previouscol] = (startpos+maxnetpos)>>1;
368			for (j=previouscol+1; j<256; j++) netindex[j] = maxnetpos; /* really 256 */
369	greg	2.1	}
370
371
372	schorsch	2.11	static int
373			inxsearch( /* accepts real BGR values after net is unbiased */
374			register int b,
375			register int g,
376			register int r
377			)
378	greg	2.1	{
379	greg	2.6	register int i,j,dist,a,bestd;
380	greg	2.1	register int *p;
381	greg	2.6	int best;
382	greg	2.1
383			bestd = 1000; /* biggest possible dist is 2563 /
384			best = -1;
385			i = netindex[g]; /* index on g */
386	greg	2.6	j = i-1; /* start at netindex[g] and work outwards */
387	greg	2.1
388	greg	2.7	while ((i<netsize) \|\| (j>=0)) {
389			if (i<netsize) {
390	greg	2.1	p = network[i];
391	greg	2.6	dist = p[1] - g; /* inx key */
392	greg	2.7	if (dist >= bestd) i = netsize; /* stop iter */
393	greg	2.1	else {
394			i++;
395	greg	2.6	if (dist<0) dist = -dist;
396			a = p[0] - b; if (a<0) a = -a;
397			dist += a;
398			if (dist<bestd) {
399			a = p[2] - r; if (a<0) a = -a;
400			dist += a;
401			if (dist<bestd) {bestd=dist; best=p[3];}
402	greg	2.1	}
403			}
404			}
405			if (j>=0) {
406			p = network[j];
407	greg	2.6	dist = g - p[1]; /* inx key - reverse dif */
408			if (dist >= bestd) j = -1; /* stop iter */
409	greg	2.1	else {
410			j--;
411	greg	2.6	if (dist<0) dist = -dist;
412			a = p[0] - b; if (a<0) a = -a;
413			dist += a;
414			if (dist<bestd) {
415			a = p[2] - r; if (a<0) a = -a;
416			dist += a;
417			if (dist<bestd) {bestd=dist; best=p[3];}
418	greg	2.1	}
419			}
420			}
421			}
422			return(best);
423			}
424
425
426	greg	2.6	/* finds closest neuron (min dist) and updates freq */
427			/* finds best neuron (min dist-bias) and returns position */
428			/* for frequently chosen neurons, freq[i] is high and bias[i] is negative */
429	greg	2.7	/* bias[i] = gamma((1/netsize)-freq[i]) /
430	greg	2.6
431	schorsch	2.11	static int
432			contest( /* accepts biased BGR values */
433			register int b,
434			register int g,
435			register int r
436			)
437	greg	2.1	{
438	greg	2.6	register int i,dist,a,biasdist,betafreq;
439			int bestpos,bestbiaspos,bestd,bestbiasd;
440			register int p,f, *n;
441	greg	2.1
442	greg	2.6	bestd = ~(((int) 1)<<31);
443	greg	2.1	bestbiasd = bestd;
444	greg	2.6	bestpos = -1;
445			bestbiaspos = bestpos;
446			p = bias;
447			f = freq;
448
449	greg	2.7	for (i=0; i<netsize; i++) {
450	greg	2.6	n = network[i];
451			dist = n[0] - b; if (dist<0) dist = -dist;
452			a = n[1] - g; if (a<0) a = -a;
453			dist += a;
454			a = n[2] - r; if (a<0) a = -a;
455			dist += a;
456			if (dist<bestd) {bestd=dist; bestpos=i;}
457			biasdist = dist - ((*p)>>(intbiasshift-netbiasshift));
458			if (biasdist<bestbiasd) {bestbiasd=biasdist; bestbiaspos=i;}
459			betafreq = (*f >> betashift);
460			*f++ -= betafreq;
461			*p++ += (betafreq<<gammashift);
462	greg	2.1	}
463	greg	2.6	freq[bestpos] += beta;
464			bias[bestpos] -= betagamma;
465			return(bestbiaspos);
466	greg	2.1	}
467
468
469	greg	2.6	/* move neuron i towards (b,g,r) by factor alpha */
470
471	schorsch	2.11	static void
472			altersingle( /* accepts biased BGR values */
473			register int alpha,
474			register int i,
475			register int b,
476			register int g,
477			register int r
478			)
479	greg	2.6	{
480			register int *n;
481
482			n = network[i]; /* alter hit neuron */
483			n -= (alpha(*n - b)) / initalpha;
484			n++;
485			n -= (alpha(*n - g)) / initalpha;
486			n++;
487			n -= (alpha(*n - r)) / initalpha;
488			}
489
490
491			/* move neurons adjacent to i towards (b,g,r) by factor */
492			/* alpha(1-((i-j)^2/[r]^2)) precomputed as radpower[\|i-j\|]/
493
494	schorsch	2.11	static void
495			alterneigh( /* accents biased BGR values */
496			int rad,
497			int i,
498			register int b,
499			register int g,
500			register int r
501			)
502	greg	2.1	{
503			register int j,k,lo,hi,a;
504			register int p, q;
505
506	greg	2.6	lo = i-rad; if (lo<-1) lo= -1;
507	greg	2.7	hi = i+rad; if (hi>netsize) hi=netsize;
508	greg	2.1
509			j = i+1;
510			k = i-1;
511			q = radpower;
512			while ((j<hi) \|\| (k>lo)) {
513			a = (*(++q));
514			if (j<hi) {
515			p = network[j];
516			p -= (a(*p - b)) / alpharadbias;
517			p++;
518			p -= (a(*p - g)) / alpharadbias;
519			p++;
520			p -= (a(*p - r)) / alpharadbias;
521			j++;
522			}
523			if (k>lo) {
524			p = network[k];
525			p -= (a(*p - b)) / alpharadbias;
526			p++;
527			p -= (a(*p - g)) / alpharadbias;
528			p++;
529			p -= (a(*p - r)) / alpharadbias;
530			k--;
531			}
532			}
533			}
534
535
536	schorsch	2.11	static void
537			learn(void)
538	greg	2.1	{
539			register int i,j,b,g,r;
540	greg	2.6	int radius,rad,alpha,step,delta,samplepixels;
541	greg	2.1	register unsigned char *p;
542			unsigned char *lim;
543
544	greg	2.6	alphadec = 30 + ((samplefac-1)/3);
545			p = thepicture;
546	greg	2.1	lim = thepicture + lengthcount;
547	greg	2.6	samplepixels = lengthcount/(3*samplefac);
548			delta = samplepixels/ncycles;
549	greg	2.1	alpha = initalpha;
550			radius = initradius;
551	greg	2.6
552	greg	2.1	rad = radius >> radiusbiasshift;
553			if (rad <= 1) rad = 0;
554			for (i=0; i<rad; i++)
555			radpower[i] = alpha(((radrad - ii)radbias)/(rad*rad));
556	greg	2.6
557			if ((lengthcount%prime1) != 0) step = 3*prime1;
558	greg	2.1	else {
559	greg	2.6	if ((lengthcount%prime2) !=0) step = 3*prime2;
560	greg	2.1	else {
561	greg	2.6	if ((lengthcount%prime3) !=0) step = 3*prime3;
562			else step = 3*prime4;
563	greg	2.1	}
564			}
565	greg	2.6
566	greg	2.1	i = 0;
567	greg	2.6	while (i < samplepixels) {
568	greg	2.1	b = p[0] << netbiasshift;
569			g = p[1] << netbiasshift;
570			r = p[2] << netbiasshift;
571			j = contest(b,g,r);
572
573			altersingle(alpha,j,b,g,r);
574	greg	2.6	if (rad) alterneigh(rad,j,b,g,r); /* alter neighbours */
575	greg	2.1
576			p += step;
577			if (p >= lim) p -= lengthcount;
578
579			i++;
580			if (i%delta == 0) {
581			alpha -= alpha / alphadec;
582			radius -= radius / radiusdec;
583			rad = radius >> radiusbiasshift;
584			if (rad <= 1) rad = 0;
585			for (j=0; j<rad; j++)
586			radpower[j] = alpha(((radrad - jj)radbias)/(rad*rad));
587			}
588			}
589			}
590
591	greg	2.6	/* unbias network to give 0..255 entries */
592			/* which can then be used for colour map */
593			/* and record position i to prepare for sort */
594
595	schorsch	2.11	static void
596			unbiasnet(void)
597	greg	2.1	{
598			int i,j;
599
600	greg	2.7	for (i=0; i<netsize; i++) {
601	greg	2.1	for (j=0; j<3; j++)
602			network[i][j] >>= netbiasshift;
603			network[i][3] = i; /* record colour no */
604			}
605			}
606
607	greg	2.6
608			/* Don't do this until the network has been unbiased (GW) */
609	greg	2.1
610	schorsch	2.11	static void
611			cpyclrtab(void)
612	greg	2.1	{
613			register int i,j,k;
614
615	greg	2.7	for (j=0; j<netsize; j++) {
616	greg	2.1	k = network[j][3];
617			for (i = 0; i < 3; i++)
618			clrtab[k][i] = network[j][2-i];
619			}
620			}