6 |
|
*/ |
7 |
|
|
8 |
|
#include <stdio.h> |
9 |
+ |
#include <stdlib.h> |
10 |
|
#include <math.h> |
11 |
|
#include "ccolor.h" |
12 |
|
|
13 |
+ |
#undef frand |
14 |
+ |
#define frand() (rand()*(1./(RAND_MAX+.5))) |
15 |
+ |
|
16 |
|
/* Sharp primary matrix */ |
17 |
|
float XYZtoSharp[3][3] = { |
18 |
|
{ 1.2694, -0.0988, -0.1706}, |
28 |
|
|
29 |
|
const C_COLOR c_dfcolor = C_DEFCOLOR; |
30 |
|
|
31 |
+ |
const C_CHROMA c_dfchroma = 49750; /* c_encodeChroma(&c_dfcolor) */ |
32 |
+ |
|
33 |
|
/* CIE 1931 Standard Observer curves */ |
34 |
|
const C_COLOR c_x31 = { 1, NULL, C_CDSPEC|C_CSSPEC|C_CSXY|C_CSEFF, |
35 |
|
{14,42,143,435,1344,2839,3483,3362,2908,1954,956, |
135 |
|
if ((nwl <= 1) | (spec == NULL) | (wlmin >= C_CMAXWL) | |
136 |
|
(wlmax <= C_CMINWL) | (wlmin >= wlmax)) |
137 |
|
return(0.); |
138 |
< |
wlstep = (wlmax - wlmin)/(nwl-1); |
138 |
> |
wlstep = (wlmax - wlmin)/(nwl-1.); |
139 |
|
while (wlmin < C_CMINWL) { |
140 |
|
wlmin += wlstep; |
141 |
|
--nwl; ++spec; |
184 |
|
if ((wl < wlmin) | (wl > wlmax)) |
185 |
|
clr->ssamp[i] = 0; |
186 |
|
else { |
187 |
< |
while (wl0 + wlstep < wl+1e-7) { |
187 |
> |
while (wl0 + wlstep < wl+.01) { |
188 |
|
wl0 += wlstep; |
189 |
|
pos++; |
190 |
|
} |
191 |
< |
if ((wl+1e-7 >= wl0) & (wl-1e-7 <= wl0)) |
192 |
< |
clr->ssamp[i] = scale*va[pos] + .5; |
191 |
> |
if ((wl+.01 >= wl0) & (wl-.01 <= wl0)) |
192 |
> |
clr->ssamp[i] = scale*va[pos] + frand(); |
193 |
|
else /* interpolate if necessary */ |
194 |
< |
clr->ssamp[i] = .5 + scale / wlstep * |
194 |
> |
clr->ssamp[i] = frand() + scale / wlstep * |
195 |
|
( va[pos]*(wl0+wlstep - wl) + |
196 |
|
va[pos+1]*(wl - wl0) ); |
197 |
|
clr->ssum += clr->ssamp[i]; |
200 |
|
return(yval); |
201 |
|
} |
202 |
|
|
203 |
+ |
|
204 |
+ |
/* check if colors are equivalent */ |
205 |
+ |
int |
206 |
+ |
c_equiv(C_COLOR *c1, C_COLOR *c2) |
207 |
+ |
{ |
208 |
+ |
long thresh; |
209 |
+ |
int i; |
210 |
+ |
|
211 |
+ |
if (c1 == c2) |
212 |
+ |
return(1); |
213 |
+ |
c_ccvt(c1, C_CSXY); /* first check chromaticities */ |
214 |
+ |
c_ccvt(c2, C_CSXY); |
215 |
+ |
if (fabs(c1->cx - c2->cx) + fabs(c1->cy - c2->cy) > .015) |
216 |
+ |
return(0); /* mismatch means definitely different */ |
217 |
+ |
if (c1->flags & c2->flags & C_CDXY) |
218 |
+ |
return(1); /* done if both defined as (x,y) */ |
219 |
+ |
c_ccvt(c1, C_CSSPEC); /* else compare spectra */ |
220 |
+ |
c_ccvt(c2, C_CSSPEC); |
221 |
+ |
thresh = C_CMAXV/200*(c1->ssum + c2->ssum); |
222 |
+ |
for (i = 0; i < C_CNSS; i++) |
223 |
+ |
if (labs(c1->ssamp[i]*c2->ssum - c2->ssamp[i]*c1->ssum) > thresh) |
224 |
+ |
return(0); |
225 |
+ |
return(1); |
226 |
+ |
} |
227 |
+ |
|
228 |
+ |
|
229 |
|
/* check if color is grey */ |
230 |
|
int |
231 |
|
c_isgrey(C_COLOR *clr) |
246 |
|
double x, y, z; |
247 |
|
int i; |
248 |
|
|
249 |
< |
fl &= ~clr->flags; /* ignore what's done */ |
250 |
< |
if (!fl) /* everything's done! */ |
249 |
> |
fl &= ~clr->flags; /* ignore what's done */ |
250 |
> |
if (!fl) /* everything's done! */ |
251 |
|
return; |
252 |
|
if (!(clr->flags & (C_CSXY|C_CSSPEC))) { |
253 |
< |
*clr = c_dfcolor; /* nothing was set! */ |
253 |
> |
*clr = c_dfcolor; /* nothing was set! */ |
254 |
|
return; |
255 |
|
} |
256 |
|
if (fl & C_CSXY) { /* cspec -> cxy */ |
264 |
|
y /= (double)c_y31.ssum; |
265 |
|
z /= (double)c_z31.ssum; |
266 |
|
z += x + y; |
267 |
< |
clr->cx = x / z; |
268 |
< |
clr->cy = y / z; |
267 |
> |
if (z > 1e-6) { |
268 |
> |
clr->cx = x / z; |
269 |
> |
clr->cy = y / z; |
270 |
> |
} else |
271 |
> |
clr->cx = clr->cy = 1./3.; |
272 |
|
clr->flags |= C_CSXY; |
273 |
|
} |
274 |
|
if (fl & C_CSSPEC) { /* cxy -> cspec */ |
278 |
|
clr->ssum = 0; |
279 |
|
for (i = 0; i < C_CNSS; i++) { |
280 |
|
clr->ssamp[i] = x*cie_xp.ssamp[i] + y*cie_yp.ssamp[i] |
281 |
< |
+ z*cie_zp.ssamp[i] + .5; |
281 |
> |
+ z*cie_zp.ssamp[i] + frand(); |
282 |
|
if (clr->ssamp[i] < 0) /* out of gamut! */ |
283 |
|
clr->ssamp[i] = 0; |
284 |
|
else |
291 |
|
y = 0.; |
292 |
|
for (i = 0; i < C_CNSS; i++) |
293 |
|
y += c_y31.ssamp[i] * clr->ssamp[i]; |
294 |
< |
clr->eff = C_CLPWM * y / clr->ssum; |
294 |
> |
clr->eff = C_CLPWM * y / (clr->ssum + 0.0001); |
295 |
|
} else /* clr->flags & C_CSXY */ { /* from (x,y) */ |
296 |
|
clr->eff = clr->cx*c_x31.eff + clr->cy*c_y31.eff + |
297 |
|
(1. - clr->cx - clr->cy)*c_z31.eff; |
307 |
|
double scale; |
308 |
|
int i; |
309 |
|
|
310 |
+ |
if (w1 == 0) { |
311 |
+ |
*cres = *c2; |
312 |
+ |
return; |
313 |
+ |
} |
314 |
+ |
if (w2 == 0) { |
315 |
+ |
*cres = *c1; |
316 |
+ |
return; |
317 |
+ |
} |
318 |
|
if ((c1->flags|c2->flags) & C_CDSPEC) { /* spectral mixing */ |
319 |
|
float cmix[C_CNSS]; |
320 |
|
|
321 |
|
c_ccvt(c1, C_CSSPEC|C_CSEFF); |
322 |
|
c_ccvt(c2, C_CSSPEC|C_CSEFF); |
323 |
+ |
if (c1->ssum*c2->ssum == 0) { |
324 |
+ |
*cres = c_dfcolor; |
325 |
+ |
return; |
326 |
+ |
} |
327 |
|
w1 /= c1->eff*c1->ssum; |
328 |
|
w2 /= c2->eff*c2->ssum; |
329 |
|
scale = 0.; |
337 |
|
scale = C_CMAXV / scale; |
338 |
|
cres->ssum = 0; |
339 |
|
for (i = 0; i < C_CNSS; i++) |
340 |
< |
cres->ssum += cres->ssamp[i] = scale*cmix[i] + .5; |
340 |
> |
cres->ssum += cres->ssamp[i] = scale*cmix[i] + frand(); |
341 |
|
cres->flags = C_CDSPEC|C_CSSPEC; |
342 |
|
} else { /* CIE xy mixing */ |
343 |
|
c_ccvt(c1, C_CSXY); |
427 |
|
clr->ssum = 0; |
428 |
|
for (i = 0; i < C_CNSS; i++) { |
429 |
|
wl = (C_CMINWL + i*C_CWLI)*1e-9; |
430 |
< |
clr->ssum += clr->ssamp[i] = sf*bbsp(wl,tk) + .5; |
430 |
> |
clr->ssum += clr->ssamp[i] = sf*bbsp(wl,tk) + frand(); |
431 |
|
} |
432 |
|
clr->flags = C_CDSPEC|C_CSSPEC; |
433 |
|
return(1); |
449 |
|
|
450 |
|
c_ccvt(clr, C_CSXY); |
451 |
|
df = UV_NORMF/(-2.*clr->cx + 12.*clr->cy + 3.); |
452 |
< |
ub = 4.*clr->cx * df; |
453 |
< |
if (ub < 0) ub = 0; |
454 |
< |
else if (ub > 0xff) ub = 0xff; |
455 |
< |
vb = 9.*clr->cy * df; |
456 |
< |
if (vb < 0) vb = 0; |
457 |
< |
else if (vb > 0xff) vb = 0xff; |
452 |
> |
ub = 4.*clr->cx*df + frand(); |
453 |
> |
if (ub > 0xff) ub = 0xff; |
454 |
> |
else ub *= (ub > 0); |
455 |
> |
vb = 9.*clr->cy*df + frand(); |
456 |
> |
if (vb > 0xff) vb = 0xff; |
457 |
> |
else vb *= (vb > 0); |
458 |
|
|
459 |
|
return(vb<<8 | ub); |
460 |
|
} |
463 |
|
void |
464 |
|
c_decodeChroma(C_COLOR *cres, C_CHROMA ccode) |
465 |
|
{ |
466 |
< |
double up = ((ccode & 0xff) + .5)*(1./UV_NORMF); |
467 |
< |
double vp = ((ccode>>8 & 0xff) + .5)*(1./UV_NORMF); |
466 |
> |
double up = (ccode & 0xff)*(1./UV_NORMF); |
467 |
> |
double vp = (ccode>>8 & 0xff)*(1./UV_NORMF); |
468 |
|
double df = 1./(6.*up - 16.*vp + 12.); |
469 |
|
|
470 |
|
cres->cx = 9.*up * df; |