28 |
|
#define MINRUN 4 /* minimum run length */ |
29 |
|
|
30 |
|
|
31 |
+ |
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 |
+ |
float wlpt[4] |
113 |
+ |
) |
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 |
+ |
float wlpt[4] |
140 |
+ |
) |
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 |
+ |
scolor2scolr( /* float spectrum to common exponent */ |
151 |
+ |
SCOLR sclr, |
152 |
+ |
SCOLOR scol, |
153 |
+ |
int ncs |
154 |
+ |
) |
155 |
+ |
{ |
156 |
+ |
int i = ncs; |
157 |
+ |
COLORV p = scol[--i]; |
158 |
+ |
|
159 |
+ |
while (i) |
160 |
+ |
if (scol[--i] > p) |
161 |
+ |
p = scol[i]; |
162 |
+ |
if (p <= 1e-32) { |
163 |
+ |
memset(sclr, 0, ncs+1); |
164 |
+ |
return; |
165 |
+ |
} |
166 |
+ |
p = frexp(p, &i) * 256.0 / p; |
167 |
+ |
sclr[ncs] = i + COLXS; |
168 |
+ |
for (i = ncs; i--; ) |
169 |
+ |
sclr[i] = (scol[i] > 0) * (int)(scol[i]*p); |
170 |
+ |
} |
171 |
+ |
|
172 |
+ |
|
173 |
+ |
void |
174 |
+ |
scolr2scolor( /* common exponent to float spectrum */ |
175 |
+ |
SCOLOR scol, |
176 |
+ |
SCOLR sclr, |
177 |
+ |
int ncs |
178 |
+ |
) |
179 |
+ |
{ |
180 |
+ |
double f; |
181 |
+ |
int i; |
182 |
+ |
|
183 |
+ |
if (sclr[ncs] == 0) { |
184 |
+ |
memset(scol, 0, sizeof(COLORV)*ncs); |
185 |
+ |
return; |
186 |
+ |
} |
187 |
+ |
f = ldexp(1.0, (int)sclr[ncs]-(COLXS+8)); |
188 |
+ |
|
189 |
+ |
for (i = ncs; i--; ) |
190 |
+ |
scol[i] = (sclr[i] + 0.5)*f; |
191 |
+ |
} |
192 |
+ |
|
193 |
+ |
|
194 |
+ |
double |
195 |
+ |
scolor_mean( /* compute average for spectral color */ |
196 |
+ |
SCOLOR scol |
197 |
+ |
) |
198 |
+ |
{ |
199 |
+ |
int i = NCSAMP; |
200 |
+ |
double sum = 0; |
201 |
+ |
|
202 |
+ |
while (i--) |
203 |
+ |
sum += scol[i]; |
204 |
+ |
|
205 |
+ |
return sum/(double)NCSAMP; |
206 |
+ |
} |
207 |
+ |
|
208 |
+ |
|
209 |
+ |
double |
210 |
+ |
sintens( /* find maximum value from spectrum */ |
211 |
+ |
SCOLOR scol |
212 |
+ |
) |
213 |
+ |
{ |
214 |
+ |
int i = NCSAMP; |
215 |
+ |
COLORV peak = scol[--i]; |
216 |
+ |
|
217 |
+ |
while (i) |
218 |
+ |
if (scol[--i] > peak) |
219 |
+ |
peak = scol[i]; |
220 |
+ |
|
221 |
+ |
return peak; |
222 |
+ |
} |
223 |
+ |
|
224 |
+ |
|
225 |
+ |
void |
226 |
+ |
convertscolor( /* spectrum conversion, zero-fill ends */ |
227 |
+ |
SCOLOR dst, /* destination spectrum */ |
228 |
+ |
int dnc, /* destination # of spectral samples/intervals */ |
229 |
+ |
double dwl0, /* starting destination wavelength (longer) */ |
230 |
+ |
double dwl1, /* ending destination wavelength (shorter) */ |
231 |
+ |
const COLORV src[], /* source spectrum array */ |
232 |
+ |
int snc, |
233 |
+ |
double swl0, /* long/short wavelengths may be reversed */ |
234 |
+ |
double swl1 |
235 |
+ |
) |
236 |
+ |
{ |
237 |
+ |
const int sdir = 1 - 2*(swl0 < swl1); |
238 |
+ |
const double sstp = (swl1 - swl0)/(double)snc; |
239 |
+ |
const double dstp = (dwl1 - dwl0)/(double)dnc; |
240 |
+ |
const double rdstp = 1./dstp; |
241 |
+ |
int si, ssi, di; |
242 |
+ |
double wl; |
243 |
+ |
|
244 |
+ |
if ((dnc < 3) | (dwl0 <= dwl1) | (dst == src)) |
245 |
+ |
return; /* invalid destination */ |
246 |
+ |
|
247 |
+ |
if (dnc == snc && (dwl0-swl0)*(dwl0-swl0) + (dwl1-swl1)*(dwl1-swl1) <= .5) { |
248 |
+ |
memcpy(dst, src, sizeof(COLORV)*dnc); |
249 |
+ |
return; /* same spectral sampling */ |
250 |
+ |
} |
251 |
+ |
memset(dst, 0, sizeof(COLORV)*dnc); |
252 |
+ |
/* set starting positions */ |
253 |
+ |
if ((sdir>0 ? swl0 : swl1) <= dwl0) { |
254 |
+ |
if (sdir > 0) { |
255 |
+ |
wl = swl0; |
256 |
+ |
ssi = 0; |
257 |
+ |
} else { |
258 |
+ |
wl = swl1; |
259 |
+ |
ssi = snc-1; |
260 |
+ |
} |
261 |
+ |
si = 0; |
262 |
+ |
di = (wl - dwl0)*rdstp; |
263 |
+ |
} else { |
264 |
+ |
wl = dwl0; |
265 |
+ |
si = (wl - swl0)/sstp; |
266 |
+ |
ssi = sdir > 0 ? si : snc-1 - si; |
267 |
+ |
di = 0; |
268 |
+ |
} |
269 |
+ |
swl0 += (sdir < 0)*sstp; |
270 |
+ |
/* step through intervals */ |
271 |
+ |
while ((si < snc) & (di < dnc)) { |
272 |
+ |
double intvl; |
273 |
+ |
if (swl0 + (ssi+sdir)*sstp < dwl0 + (di+1)*dstp) { |
274 |
+ |
intvl = dwl0 + (di+1)*dstp - wl; |
275 |
+ |
dst[di++] += src[ssi]*intvl*rdstp; |
276 |
+ |
} else { |
277 |
+ |
intvl = swl0 + (ssi+sdir)*sstp - wl; |
278 |
+ |
dst[di] += src[ssi]*intvl*rdstp; |
279 |
+ |
ssi += sdir; |
280 |
+ |
si++; |
281 |
+ |
} |
282 |
+ |
wl += intvl; |
283 |
+ |
} |
284 |
+ |
} |
285 |
+ |
|
286 |
+ |
|
287 |
|
void * |
288 |
|
tempbuffer( /* get a temporary buffer */ |
289 |
< |
unsigned int len |
289 |
> |
size_t len |
290 |
|
) |
291 |
|
{ |
292 |
< |
static void *tempbuf = NULL; |
293 |
< |
static unsigned int tempbuflen = 0; |
292 |
> |
static void *tempbuf = NULL; |
293 |
> |
static size_t tempbuflen = 0; |
294 |
|
|
295 |
|
if (!len) { /* call to free */ |
296 |
|
if (tempbuflen) { |
562 |
|
|
563 |
|
d = frexp(d, &e) * 256.0 / d; |
564 |
|
|
565 |
< |
if (r > 0.0) |
566 |
< |
clr[RED] = r * d; |
567 |
< |
else |
312 |
< |
clr[RED] = 0; |
313 |
< |
if (g > 0.0) |
314 |
< |
clr[GRN] = g * d; |
315 |
< |
else |
316 |
< |
clr[GRN] = 0; |
317 |
< |
if (b > 0.0) |
318 |
< |
clr[BLU] = b * d; |
319 |
< |
else |
320 |
< |
clr[BLU] = 0; |
321 |
< |
|
565 |
> |
clr[RED] = (r > 0) * (int)(r*d); |
566 |
> |
clr[GRN] = (g > 0) * (int)(g*d); |
567 |
> |
clr[BLU] = (b > 0) * (int)(b*d); |
568 |
|
clr[EXP] = e + COLXS; |
569 |
|
} |
570 |
|
|
577 |
|
{ |
578 |
|
double f; |
579 |
|
|
580 |
< |
if (clr[EXP] == 0) |
580 |
> |
if (clr[EXP] == 0) { |
581 |
|
col[RED] = col[GRN] = col[BLU] = 0.0; |
582 |
< |
else { |
337 |
< |
f = ldexp(1.0, (int)clr[EXP]-(COLXS+8)); |
338 |
< |
col[RED] = (clr[RED] + 0.5)*f; |
339 |
< |
col[GRN] = (clr[GRN] + 0.5)*f; |
340 |
< |
col[BLU] = (clr[BLU] + 0.5)*f; |
582 |
> |
return; |
583 |
|
} |
584 |
+ |
f = ldexp(1.0, (int)clr[EXP]-(COLXS+8)); |
585 |
+ |
col[RED] = (clr[RED] + 0.5)*f; |
586 |
+ |
col[GRN] = (clr[GRN] + 0.5)*f; |
587 |
+ |
col[BLU] = (clr[BLU] + 0.5)*f; |
588 |
|
} |
589 |
|
|
590 |
|
|
598 |
|
int i; |
599 |
|
|
600 |
|
for (i = 0; i < 3; i++) |
601 |
< |
if (colval(c1,i)-colval(c2,i) > md*colval(c2,i) || |
602 |
< |
colval(c2,i)-colval(c1,i) > md*colval(c1,i)) |
601 |
> |
if ((colval(c1,i)-colval(c2,i) > md*colval(c2,i)) | |
602 |
> |
(colval(c2,i)-colval(c1,i) > md*colval(c1,i))) |
603 |
> |
return(1); |
604 |
> |
return(0); |
605 |
> |
} |
606 |
> |
|
607 |
> |
|
608 |
> |
int |
609 |
> |
sbigsdiff( /* sc1 delta sc2 > md? */ |
610 |
> |
SCOLOR c1, |
611 |
> |
SCOLOR c2, |
612 |
> |
double md |
613 |
> |
) |
614 |
> |
{ |
615 |
> |
int i = NCSAMP; |
616 |
> |
|
617 |
> |
while (i--) |
618 |
> |
if ((c1[i]-c2[i] > md*c2[i]) | (c2[i]-c1[i] > md*c1[i])) |
619 |
|
return(1); |
620 |
|
return(0); |
621 |
|
} |