?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
alsa.audio: limit the supported frequencies to common set
[AROS.git] / workbench / libs / lcms2 / src / cmsintrp.c
blobea33cc6cf01b858aee3658088c02d4e7aea4d8b7
1 //---------------------------------------------------------------------------------
2 //
3 // Little Color Management System
4 // Copyright (c) 1998-2012 Marti Maria Saguer
5 //
6 // Permission is hereby granted, free of charge, to any person obtaining
7 // a copy of this software and associated documentation files (the "Software"),
8 // to deal in the Software without restriction, including without limitation
9 // the rights to use, copy, modify, merge, publish, distribute, sublicense,
10 // and/or sell copies of the Software, and to permit persons to whom the Software
11 // is furnished to do so, subject to the following conditions:
12 //
13 // The above copyright notice and this permission notice shall be included in
14 // all copies or substantial portions of the Software.
15 //
16 // THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
17 // EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO
18 // THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
19 // NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
20 // LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
21 // OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
22 // WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
23 //
24 //---------------------------------------------------------------------------------
25 //
26
27 #include "lcms2_internal.h"
28
29 // This module incorporates several interpolation routines, for 1 to 8 channels on input and
30 // up to 65535 channels on output. The user may change those by using the interpolation plug-in
31
32 // Interpolation routines by default
33 static cmsInterpFunction DefaultInterpolatorsFactory(cmsUInt32Number nInputChannels, cmsUInt32Number nOutputChannels, cmsUInt32Number dwFlags);
34
35 // This is the default factory
36 static cmsInterpFnFactory Interpolators = DefaultInterpolatorsFactory;
37
38
39 // Main plug-in entry
40 cmsBool _cmsRegisterInterpPlugin(cmsPluginBase* Data)
41 {
42 cmsPluginInterpolation* Plugin = (cmsPluginInterpolation*) Data;
43
44 if (Data == NULL) {
45
46 Interpolators = DefaultInterpolatorsFactory;
47 return TRUE;
48 }
49
50 // Set replacement functions
51 Interpolators = Plugin ->InterpolatorsFactory;
52 return TRUE;
53 }
54
55
56 // Set the interpolation method
57 cmsBool _cmsSetInterpolationRoutine(cmsInterpParams* p)
58 {
59 // Invoke factory, possibly in the Plug-in
60 p ->Interpolation = Interpolators(p -> nInputs, p ->nOutputs, p ->dwFlags);
61
62 // If unsupported by the plug-in, go for the LittleCMS default.
63 // If happens only if an extern plug-in is being used
64 if (p ->Interpolation.Lerp16 == NULL)
65 p ->Interpolation = DefaultInterpolatorsFactory(p ->nInputs, p ->nOutputs, p ->dwFlags);
66
67 // Check for valid interpolator (we just check one member of the union)
68 if (p ->Interpolation.Lerp16 == NULL) {
69 return FALSE;
70 }
71 return TRUE;
72 }
73
74
75 // This function precalculates as many parameters as possible to speed up the interpolation.
76 cmsInterpParams* _cmsComputeInterpParamsEx(cmsContext ContextID,
77 const cmsUInt32Number nSamples[],
78 int InputChan, int OutputChan,
79 const void *Table,
80 cmsUInt32Number dwFlags)
81 {
82 cmsInterpParams* p;
83 int i;
84
85 // Check for maximum inputs
86 if (InputChan > MAX_INPUT_DIMENSIONS) {
87 cmsSignalError(ContextID, cmsERROR_RANGE, "Too many input channels (%d channels, max=%d)", InputChan, MAX_INPUT_DIMENSIONS);
88 return NULL;
89 }
90
91 // Creates an empty object
92 p = (cmsInterpParams*) _cmsMallocZero(ContextID, sizeof(cmsInterpParams));
93 if (p == NULL) return NULL;
94
95 // Keep original parameters
96 p -> dwFlags = dwFlags;
97 p -> nInputs = InputChan;
98 p -> nOutputs = OutputChan;
99 p ->Table = Table;
100 p ->ContextID = ContextID;
101
102 // Fill samples per input direction and domain (which is number of nodes minus one)
103 for (i=0; i < InputChan; i++) {
104
105 p -> nSamples[i] = nSamples[i];
106 p -> Domain[i] = nSamples[i] - 1;
107 }
108
109 // Compute factors to apply to each component to index the grid array
110 p -> opta[0] = p -> nOutputs;
111 for (i=1; i < InputChan; i++)
112 p ->opta[i] = p ->opta[i-1] * nSamples[InputChan-i];
113
114
115 if (!_cmsSetInterpolationRoutine(p)) {
116 cmsSignalError(ContextID, cmsERROR_UNKNOWN_EXTENSION, "Unsupported interpolation (%d->%d channels)", InputChan, OutputChan);
117 _cmsFree(ContextID, p);
118 return NULL;
119 }
120
121 // All seems ok
122 return p;
123 }
124
125
126 // This one is a wrapper on the anterior, but assuming all directions have same number of nodes
127 cmsInterpParams* _cmsComputeInterpParams(cmsContext ContextID, int nSamples, int InputChan, int OutputChan, const void* Table, cmsUInt32Number dwFlags)
128 {
129 int i;
130 cmsUInt32Number Samples[MAX_INPUT_DIMENSIONS];
131
132 // Fill the auxiliar array
133 for (i=0; i < MAX_INPUT_DIMENSIONS; i++)
134 Samples[i] = nSamples;
135
136 // Call the extended function
137 return _cmsComputeInterpParamsEx(ContextID, Samples, InputChan, OutputChan, Table, dwFlags);
138 }
139
140
141 // Free all associated memory
142 void _cmsFreeInterpParams(cmsInterpParams* p)
143 {
144 if (p != NULL) _cmsFree(p ->ContextID, p);
145 }
146
147
148 // Inline fixed point interpolation
149 cmsINLINE cmsUInt16Number LinearInterp(cmsS15Fixed16Number a, cmsS15Fixed16Number l, cmsS15Fixed16Number h)
150 {
151 cmsUInt32Number dif = (cmsUInt32Number) (h - l) * a + 0x8000;
152 dif = (dif >> 16) + l;
153 return (cmsUInt16Number) (dif);
154 }
155
156
157 // Linear interpolation (Fixed-point optimized)
158 static
159 void LinLerp1D(register const cmsUInt16Number Value[],
160 register cmsUInt16Number Output[],
161 register const cmsInterpParams* p)
162 {
163 cmsUInt16Number y1, y0;
164 int cell0, rest;
165 int val3;
166 const cmsUInt16Number* LutTable = (cmsUInt16Number*) p ->Table;
167
168 // if last value...
169 if (Value[0] == 0xffff) {
170
171 Output[0] = LutTable[p -> Domain[0]];
172 return;
173 }
174
175 val3 = p -> Domain[0] * Value[0];
176 val3 = _cmsToFixedDomain(val3); // To fixed 15.16
177
178 cell0 = FIXED_TO_INT(val3); // Cell is 16 MSB bits
179 rest = FIXED_REST_TO_INT(val3); // Rest is 16 LSB bits
180
181 y0 = LutTable[cell0];
182 y1 = LutTable[cell0+1];
183
184
185 Output[0] = LinearInterp(rest, y0, y1);
186 }
187
188
189 // Floating-point version of 1D interpolation
190 static
191 void LinLerp1Dfloat(const cmsFloat32Number Value[],
192 cmsFloat32Number Output[],
193 const cmsInterpParams* p)
194 {
195 cmsFloat32Number y1, y0;
196 cmsFloat32Number val2, rest;
197 int cell0, cell1;
198 const cmsFloat32Number* LutTable = (cmsFloat32Number*) p ->Table;
199
200 // if last value...
201 if (Value[0] == 1.0) {
202 Output[0] = LutTable[p -> Domain[0]];
203 return;
204 }
205
206 val2 = p -> Domain[0] * Value[0];
207
208 cell0 = (int) floor(val2);
209 cell1 = (int) ceil(val2);
210
211 // Rest is 16 LSB bits
212 rest = val2 - cell0;
213
214 y0 = LutTable[cell0] ;
215 y1 = LutTable[cell1] ;
216
217 Output[0] = y0 + (y1 - y0) * rest;
218 }
219
220
221
222 // Eval gray LUT having only one input channel
223 static
224 void Eval1Input(register const cmsUInt16Number Input[],
225 register cmsUInt16Number Output[],
226 register const cmsInterpParams* p16)
227 {
228 cmsS15Fixed16Number fk;
229 cmsS15Fixed16Number k0, k1, rk, K0, K1;
230 int v;
231 cmsUInt32Number OutChan;
232 const cmsUInt16Number* LutTable = (cmsUInt16Number*) p16 -> Table;
233
234 v = Input[0] * p16 -> Domain[0];
235 fk = _cmsToFixedDomain(v);
236
237 k0 = FIXED_TO_INT(fk);
238 rk = (cmsUInt16Number) FIXED_REST_TO_INT(fk);
239
240 k1 = k0 + (Input[0] != 0xFFFFU ? 1 : 0);
241
242 K0 = p16 -> opta[0] * k0;
243 K1 = p16 -> opta[0] * k1;
244
245 for (OutChan=0; OutChan < p16->nOutputs; OutChan++) {
246
247 Output[OutChan] = LinearInterp(rk, LutTable[K0+OutChan], LutTable[K1+OutChan]);
248 }
249 }
250
251
252
253 // Eval gray LUT having only one input channel
254 static
255 void Eval1InputFloat(const cmsFloat32Number Value[],
256 cmsFloat32Number Output[],
257 const cmsInterpParams* p)
258 {
259 cmsFloat32Number y1, y0;
260 cmsFloat32Number val2, rest;
261 int cell0, cell1;
262 cmsUInt32Number OutChan;
263 const cmsFloat32Number* LutTable = (cmsFloat32Number*) p ->Table;
264
265 // if last value...
266 if (Value[0] == 1.0) {
267 Output[0] = LutTable[p -> Domain[0]];
268 return;
269 }
270
271 val2 = p -> Domain[0] * Value[0];
272
273 cell0 = (int) floor(val2);
274 cell1 = (int) ceil(val2);
275
276 // Rest is 16 LSB bits
277 rest = val2 - cell0;
278
279 cell0 *= p -> opta[0];
280 cell1 *= p -> opta[0];
281
282 for (OutChan=0; OutChan < p->nOutputs; OutChan++) {
283
284 y0 = LutTable[cell0 + OutChan] ;
285 y1 = LutTable[cell1 + OutChan] ;
286
287 Output[OutChan] = y0 + (y1 - y0) * rest;
288 }
289 }
290
291 // Bilinear interpolation (16 bits) - cmsFloat32Number version
292 static
293 void BilinearInterpFloat(const cmsFloat32Number Input[],
294 cmsFloat32Number Output[],
295 const cmsInterpParams* p)
296
297 {
298 # define LERP(a,l,h) (cmsFloat32Number) ((l)+(((h)-(l))*(a)))
299 # define DENS(i,j) (LutTable[(i)+(j)+OutChan])
300
301 const cmsFloat32Number* LutTable = (cmsFloat32Number*) p ->Table;
302 cmsFloat32Number px, py;
303 int x0, y0,
304 X0, Y0, X1, Y1;
305 int TotalOut, OutChan;
306 cmsFloat32Number fx, fy,
307 d00, d01, d10, d11,
308 dx0, dx1,
309 dxy;
310
311 TotalOut = p -> nOutputs;
312 px = Input[0] * p->Domain[0];
313 py = Input[1] * p->Domain[1];
314
315 x0 = (int) _cmsQuickFloor(px); fx = px - (cmsFloat32Number) x0;
316 y0 = (int) _cmsQuickFloor(py); fy = py - (cmsFloat32Number) y0;
317
318 X0 = p -> opta[1] * x0;
319 X1 = X0 + (Input[0] >= 1.0 ? 0 : p->opta[1]);
320
321 Y0 = p -> opta[0] * y0;
322 Y1 = Y0 + (Input[1] >= 1.0 ? 0 : p->opta[0]);
323
324 for (OutChan = 0; OutChan < TotalOut; OutChan++) {
325
326 d00 = DENS(X0, Y0);
327 d01 = DENS(X0, Y1);
328 d10 = DENS(X1, Y0);
329 d11 = DENS(X1, Y1);
330
331 dx0 = LERP(fx, d00, d10);
332 dx1 = LERP(fx, d01, d11);
333
334 dxy = LERP(fy, dx0, dx1);
335
336 Output[OutChan] = dxy;
337 }
338
339
340 # undef LERP
341 # undef DENS
342 }
343
344 // Bilinear interpolation (16 bits) - optimized version
345 static
346 void BilinearInterp16(register const cmsUInt16Number Input[],
347 register cmsUInt16Number Output[],
348 register const cmsInterpParams* p)
349
350 {
351 #define DENS(i,j) (LutTable[(i)+(j)+OutChan])
352 #define LERP(a,l,h) (cmsUInt16Number) (l + ROUND_FIXED_TO_INT(((h-l)*a)))
353
354 const cmsUInt16Number* LutTable = (cmsUInt16Number*) p ->Table;
355 int OutChan, TotalOut;
356 cmsS15Fixed16Number fx, fy;
357 register int rx, ry;
358 int x0, y0;
359 register int X0, X1, Y0, Y1;
360 int d00, d01, d10, d11,
361 dx0, dx1,
362 dxy;
363
364 TotalOut = p -> nOutputs;
365
366 fx = _cmsToFixedDomain((int) Input[0] * p -> Domain[0]);
367 x0 = FIXED_TO_INT(fx);
368 rx = FIXED_REST_TO_INT(fx); // Rest in 0..1.0 domain
369
370
371 fy = _cmsToFixedDomain((int) Input[1] * p -> Domain[1]);
372 y0 = FIXED_TO_INT(fy);
373 ry = FIXED_REST_TO_INT(fy);
374
375
376 X0 = p -> opta[1] * x0;
377 X1 = X0 + (Input[0] == 0xFFFFU ? 0 : p->opta[1]);
378
379 Y0 = p -> opta[0] * y0;
380 Y1 = Y0 + (Input[1] == 0xFFFFU ? 0 : p->opta[0]);
381
382 for (OutChan = 0; OutChan < TotalOut; OutChan++) {
383
384 d00 = DENS(X0, Y0);
385 d01 = DENS(X0, Y1);
386 d10 = DENS(X1, Y0);
387 d11 = DENS(X1, Y1);
388
389 dx0 = LERP(rx, d00, d10);
390 dx1 = LERP(rx, d01, d11);
391
392 dxy = LERP(ry, dx0, dx1);
393
394 Output[OutChan] = (cmsUInt16Number) dxy;
395 }
396
397
398 # undef LERP
399 # undef DENS
400 }
401
402
403 // Trilinear interpolation (16 bits) - cmsFloat32Number version
404 static
405 void TrilinearInterpFloat(const cmsFloat32Number Input[],
406 cmsFloat32Number Output[],
407 const cmsInterpParams* p)
408
409 {
410 # define LERP(a,l,h) (cmsFloat32Number) ((l)+(((h)-(l))*(a)))
411 # define DENS(i,j,k) (LutTable[(i)+(j)+(k)+OutChan])
412
413 const cmsFloat32Number* LutTable = (cmsFloat32Number*) p ->Table;
414 cmsFloat32Number px, py, pz;
415 int x0, y0, z0,
416 X0, Y0, Z0, X1, Y1, Z1;
417 int TotalOut, OutChan;
418 cmsFloat32Number fx, fy, fz,
419 d000, d001, d010, d011,
420 d100, d101, d110, d111,
421 dx00, dx01, dx10, dx11,
422 dxy0, dxy1, dxyz;
423
424 TotalOut = p -> nOutputs;
425
426 // We need some clipping here
427 px = Input[0];
428 py = Input[1];
429 pz = Input[2];
430
431 if (px < 0) px = 0;
432 if (px > 1) px = 1;
433 if (py < 0) py = 0;
434 if (py > 1) py = 1;
435 if (pz < 0) pz = 0;
436 if (pz > 1) pz = 1;
437
438 px *= p->Domain[0];
439 py *= p->Domain[1];
440 pz *= p->Domain[2];
441
442 x0 = (int) _cmsQuickFloor(px); fx = px - (cmsFloat32Number) x0;
443 y0 = (int) _cmsQuickFloor(py); fy = py - (cmsFloat32Number) y0;
444 z0 = (int) _cmsQuickFloor(pz); fz = pz - (cmsFloat32Number) z0;
445
446 X0 = p -> opta[2] * x0;
447 X1 = X0 + (Input[0] >= 1.0 ? 0 : p->opta[2]);
448
449 Y0 = p -> opta[1] * y0;
450 Y1 = Y0 + (Input[1] >= 1.0 ? 0 : p->opta[1]);
451
452 Z0 = p -> opta[0] * z0;
453 Z1 = Z0 + (Input[2] >= 1.0 ? 0 : p->opta[0]);
454
455 for (OutChan = 0; OutChan < TotalOut; OutChan++) {
456
457 d000 = DENS(X0, Y0, Z0);
458 d001 = DENS(X0, Y0, Z1);
459 d010 = DENS(X0, Y1, Z0);
460 d011 = DENS(X0, Y1, Z1);
461
462 d100 = DENS(X1, Y0, Z0);
463 d101 = DENS(X1, Y0, Z1);
464 d110 = DENS(X1, Y1, Z0);
465 d111 = DENS(X1, Y1, Z1);
466
467
468 dx00 = LERP(fx, d000, d100);
469 dx01 = LERP(fx, d001, d101);
470 dx10 = LERP(fx, d010, d110);
471 dx11 = LERP(fx, d011, d111);
472
473 dxy0 = LERP(fy, dx00, dx10);
474 dxy1 = LERP(fy, dx01, dx11);
475
476 dxyz = LERP(fz, dxy0, dxy1);
477
478 Output[OutChan] = dxyz;
479 }
480
481
482 # undef LERP
483 # undef DENS
484 }
485
486 // Trilinear interpolation (16 bits) - optimized version
487 static
488 void TrilinearInterp16(register const cmsUInt16Number Input[],
489 register cmsUInt16Number Output[],
490 register const cmsInterpParams* p)
491
492 {
493 #define DENS(i,j,k) (LutTable[(i)+(j)+(k)+OutChan])
494 #define LERP(a,l,h) (cmsUInt16Number) (l + ROUND_FIXED_TO_INT(((h-l)*a)))
495
496 const cmsUInt16Number* LutTable = (cmsUInt16Number*) p ->Table;
497 int OutChan, TotalOut;
498 cmsS15Fixed16Number fx, fy, fz;
499 register int rx, ry, rz;
500 int x0, y0, z0;
501 register int X0, X1, Y0, Y1, Z0, Z1;
502 int d000, d001, d010, d011,
503 d100, d101, d110, d111,
504 dx00, dx01, dx10, dx11,
505 dxy0, dxy1, dxyz;
506
507 TotalOut = p -> nOutputs;
508
509 fx = _cmsToFixedDomain((int) Input[0] * p -> Domain[0]);
510 x0 = FIXED_TO_INT(fx);
511 rx = FIXED_REST_TO_INT(fx); // Rest in 0..1.0 domain
512
513
514 fy = _cmsToFixedDomain((int) Input[1] * p -> Domain[1]);
515 y0 = FIXED_TO_INT(fy);
516 ry = FIXED_REST_TO_INT(fy);
517
518 fz = _cmsToFixedDomain((int) Input[2] * p -> Domain[2]);
519 z0 = FIXED_TO_INT(fz);
520 rz = FIXED_REST_TO_INT(fz);
521
522
523 X0 = p -> opta[2] * x0;
524 X1 = X0 + (Input[0] == 0xFFFFU ? 0 : p->opta[2]);
525
526 Y0 = p -> opta[1] * y0;
527 Y1 = Y0 + (Input[1] == 0xFFFFU ? 0 : p->opta[1]);
528
529 Z0 = p -> opta[0] * z0;
530 Z1 = Z0 + (Input[2] == 0xFFFFU ? 0 : p->opta[0]);
531
532 for (OutChan = 0; OutChan < TotalOut; OutChan++) {
533
534 d000 = DENS(X0, Y0, Z0);
535 d001 = DENS(X0, Y0, Z1);
536 d010 = DENS(X0, Y1, Z0);
537 d011 = DENS(X0, Y1, Z1);
538
539 d100 = DENS(X1, Y0, Z0);
540 d101 = DENS(X1, Y0, Z1);
541 d110 = DENS(X1, Y1, Z0);
542 d111 = DENS(X1, Y1, Z1);
543
544
545 dx00 = LERP(rx, d000, d100);
546 dx01 = LERP(rx, d001, d101);
547 dx10 = LERP(rx, d010, d110);
548 dx11 = LERP(rx, d011, d111);
549
550 dxy0 = LERP(ry, dx00, dx10);
551 dxy1 = LERP(ry, dx01, dx11);
552
553 dxyz = LERP(rz, dxy0, dxy1);
554
555 Output[OutChan] = (cmsUInt16Number) dxyz;
556 }
557
558
559 # undef LERP
560 # undef DENS
561 }
562
563
564 // Tetrahedral interpolation, using Sakamoto algorithm.
565 #define DENS(i,j,k) (LutTable[(i)+(j)+(k)+OutChan])
566 static
567 void TetrahedralInterpFloat(const cmsFloat32Number Input[],
568 cmsFloat32Number Output[],
569 const cmsInterpParams* p)
570 {
571 const cmsFloat32Number* LutTable = (cmsFloat32Number*) p -> Table;
572 cmsFloat32Number px, py, pz;
573 int x0, y0, z0,
574 X0, Y0, Z0, X1, Y1, Z1;
575 cmsFloat32Number rx, ry, rz;
576 cmsFloat32Number c0, c1=0, c2=0, c3=0;
577 int OutChan, TotalOut;
578
579 TotalOut = p -> nOutputs;
580
581 // We need some clipping here
582 px = Input[0];
583 py = Input[1];
584 pz = Input[2];
585
586 if (px < 0) px = 0;
587 if (px > 1) px = 1;
588 if (py < 0) py = 0;
589 if (py > 1) py = 1;
590 if (pz < 0) pz = 0;
591 if (pz > 1) pz = 1;
592
593 px *= p->Domain[0];
594 py *= p->Domain[1];
595 pz *= p->Domain[2];
596
597 x0 = (int) _cmsQuickFloor(px); rx = (px - (cmsFloat32Number) x0);
598 y0 = (int) _cmsQuickFloor(py); ry = (py - (cmsFloat32Number) y0);
599 z0 = (int) _cmsQuickFloor(pz); rz = (pz - (cmsFloat32Number) z0);
600
601
602 X0 = p -> opta[2] * x0;
603 X1 = X0 + (Input[0] >= 1.0 ? 0 : p->opta[2]);
604
605 Y0 = p -> opta[1] * y0;
606 Y1 = Y0 + (Input[1] >= 1.0 ? 0 : p->opta[1]);
607
608 Z0 = p -> opta[0] * z0;
609 Z1 = Z0 + (Input[2] >= 1.0 ? 0 : p->opta[0]);
610
611 for (OutChan=0; OutChan < TotalOut; OutChan++) {
612
613 // These are the 6 Tetrahedral
614
615 c0 = DENS(X0, Y0, Z0);
616
617 if (rx >= ry && ry >= rz) {
618
619 c1 = DENS(X1, Y0, Z0) - c0;
620 c2 = DENS(X1, Y1, Z0) - DENS(X1, Y0, Z0);
621 c3 = DENS(X1, Y1, Z1) - DENS(X1, Y1, Z0);
622
623 }
624 else
625 if (rx >= rz && rz >= ry) {
626
627 c1 = DENS(X1, Y0, Z0) - c0;
628 c2 = DENS(X1, Y1, Z1) - DENS(X1, Y0, Z1);
629 c3 = DENS(X1, Y0, Z1) - DENS(X1, Y0, Z0);
630
631 }
632 else
633 if (rz >= rx && rx >= ry) {
634
635 c1 = DENS(X1, Y0, Z1) - DENS(X0, Y0, Z1);
636 c2 = DENS(X1, Y1, Z1) - DENS(X1, Y0, Z1);
637 c3 = DENS(X0, Y0, Z1) - c0;
638
639 }
640 else
641 if (ry >= rx && rx >= rz) {
642
643 c1 = DENS(X1, Y1, Z0) - DENS(X0, Y1, Z0);
644 c2 = DENS(X0, Y1, Z0) - c0;
645 c3 = DENS(X1, Y1, Z1) - DENS(X1, Y1, Z0);
646
647 }
648 else
649 if (ry >= rz && rz >= rx) {
650
651 c1 = DENS(X1, Y1, Z1) - DENS(X0, Y1, Z1);
652 c2 = DENS(X0, Y1, Z0) - c0;
653 c3 = DENS(X0, Y1, Z1) - DENS(X0, Y1, Z0);
654
655 }
656 else
657 if (rz >= ry && ry >= rx) {
658
659 c1 = DENS(X1, Y1, Z1) - DENS(X0, Y1, Z1);
660 c2 = DENS(X0, Y1, Z1) - DENS(X0, Y0, Z1);
661 c3 = DENS(X0, Y0, Z1) - c0;
662
663 }
664 else {
665 c1 = c2 = c3 = 0;
666 }
667
668 Output[OutChan] = c0 + c1 * rx + c2 * ry + c3 * rz;
669 }
670
671 }
672
673 #undef DENS
674
675
676
677
678 static
679 void TetrahedralInterp16(register const cmsUInt16Number Input[],
680 register cmsUInt16Number Output[],
681 register const cmsInterpParams* p)
682 {
683 const cmsUInt16Number* LutTable = (cmsUInt16Number*) p -> Table;
684 cmsS15Fixed16Number fx, fy, fz;
685 cmsS15Fixed16Number rx, ry, rz;
686 int x0, y0, z0;
687 cmsS15Fixed16Number c0, c1, c2, c3, Rest;
688 cmsS15Fixed16Number X0, X1, Y0, Y1, Z0, Z1;
689 cmsUInt32Number TotalOut = p -> nOutputs;
690
691 fx = _cmsToFixedDomain((int) Input[0] * p -> Domain[0]);
692 fy = _cmsToFixedDomain((int) Input[1] * p -> Domain[1]);
693 fz = _cmsToFixedDomain((int) Input[2] * p -> Domain[2]);
694
695 x0 = FIXED_TO_INT(fx);
696 y0 = FIXED_TO_INT(fy);
697 z0 = FIXED_TO_INT(fz);
698
699 rx = FIXED_REST_TO_INT(fx);
700 ry = FIXED_REST_TO_INT(fy);
701 rz = FIXED_REST_TO_INT(fz);
702
703 X0 = p -> opta[2] * x0;
704 X1 = (Input[0] == 0xFFFFU ? 0 : p->opta[2]);
705
706 Y0 = p -> opta[1] * y0;
707 Y1 = (Input[1] == 0xFFFFU ? 0 : p->opta[1]);
708
709 Z0 = p -> opta[0] * z0;
710 Z1 = (Input[2] == 0xFFFFU ? 0 : p->opta[0]);
711
712 LutTable = &LutTable[X0+Y0+Z0];
713
714 // Output should be computed as x = ROUND_FIXED_TO_INT(_cmsToFixedDomain(Rest))
715 // which expands as: x = (Rest + ((Rest+0x7fff)/0xFFFF) + 0x8000)>>16
716 // This can be replaced by: t = Rest+0x8001, x = (t + (t>>16))>>16
717 // at the cost of being off by one at 7fff and 17ffe.
718
719 if (rx >= ry) {
720 if (ry >= rz) {
721 Y1 += X1;
722 Z1 += Y1;
723 for (; TotalOut; TotalOut--) {
724 c1 = LutTable[X1];
725 c2 = LutTable[Y1];
726 c3 = LutTable[Z1];
727 c0 = *LutTable++;
728 c3 -= c2;
729 c2 -= c1;
730 c1 -= c0;
731 Rest = c1 * rx + c2 * ry + c3 * rz + 0x8001;
732 *Output++ = (cmsUInt16Number) c0 + ((Rest + (Rest>>16))>>16);
733 }
734 } else if (rz >= rx) {
735 X1 += Z1;
736 Y1 += X1;
737 for (; TotalOut; TotalOut--) {
738 c1 = LutTable[X1];
739 c2 = LutTable[Y1];
740 c3 = LutTable[Z1];
741 c0 = *LutTable++;
742 c2 -= c1;
743 c1 -= c3;
744 c3 -= c0;
745 Rest = c1 * rx + c2 * ry + c3 * rz + 0x8001;
746 *Output++ = (cmsUInt16Number) c0 + ((Rest + (Rest>>16))>>16);
747 }
748 } else {
749 Z1 += X1;
750 Y1 += Z1;
751 for (; TotalOut; TotalOut--) {
752 c1 = LutTable[X1];
753 c2 = LutTable[Y1];
754 c3 = LutTable[Z1];
755 c0 = *LutTable++;
756 c2 -= c3;
757 c3 -= c1;
758 c1 -= c0;
759 Rest = c1 * rx + c2 * ry + c3 * rz + 0x8001;
760 *Output++ = (cmsUInt16Number) c0 + ((Rest + (Rest>>16))>>16);
761 }
762 }
763 } else {
764 if (rx >= rz) {
765 X1 += Y1;
766 Z1 += X1;
767 for (; TotalOut; TotalOut--) {
768 c1 = LutTable[X1];
769 c2 = LutTable[Y1];
770 c3 = LutTable[Z1];
771 c0 = *LutTable++;
772 c3 -= c1;
773 c1 -= c2;
774 c2 -= c0;
775 Rest = c1 * rx + c2 * ry + c3 * rz + 0x8001;
776 *Output++ = (cmsUInt16Number) c0 + ((Rest + (Rest>>16))>>16);
777 }
778 } else if (ry >= rz) {
779 Z1 += Y1;
780 X1 += Z1;
781 for (; TotalOut; TotalOut--) {
782 c1 = LutTable[X1];
783 c2 = LutTable[Y1];
784 c3 = LutTable[Z1];
785 c0 = *LutTable++;
786 c1 -= c3;
787 c3 -= c2;
788 c2 -= c0;
789 Rest = c1 * rx + c2 * ry + c3 * rz + 0x8001;
790 *Output++ = (cmsUInt16Number) c0 + ((Rest + (Rest>>16))>>16);
791 }
792 } else {
793 Y1 += Z1;
794 X1 += Y1;
795 for (; TotalOut; TotalOut--) {
796 c1 = LutTable[X1];
797 c2 = LutTable[Y1];
798 c3 = LutTable[Z1];
799 c0 = *LutTable++;
800 c1 -= c2;
801 c2 -= c3;
802 c3 -= c0;
803 Rest = c1 * rx + c2 * ry + c3 * rz + 0x8001;
804 *Output++ = (cmsUInt16Number) c0 + ((Rest + (Rest>>16))>>16);
805 }
806 }
807 }
808 }
809
810
811 #define DENS(i,j,k) (LutTable[(i)+(j)+(k)+OutChan])
812 static
813 void Eval4Inputs(register const cmsUInt16Number Input[],
814 register cmsUInt16Number Output[],
815 register const cmsInterpParams* p16)
816 {
817 const cmsUInt16Number* LutTable;
818 cmsS15Fixed16Number fk;
819 cmsS15Fixed16Number k0, rk;
820 int K0, K1;
821 cmsS15Fixed16Number fx, fy, fz;
822 cmsS15Fixed16Number rx, ry, rz;
823 int x0, y0, z0;
824 cmsS15Fixed16Number X0, X1, Y0, Y1, Z0, Z1;
825 cmsUInt32Number i;
826 cmsS15Fixed16Number c0, c1, c2, c3, Rest;
827 cmsUInt32Number OutChan;
828 cmsUInt16Number Tmp1[MAX_STAGE_CHANNELS], Tmp2[MAX_STAGE_CHANNELS];
829
830
831 fk = _cmsToFixedDomain((int) Input[0] * p16 -> Domain[0]);
832 fx = _cmsToFixedDomain((int) Input[1] * p16 -> Domain[1]);
833 fy = _cmsToFixedDomain((int) Input[2] * p16 -> Domain[2]);
834 fz = _cmsToFixedDomain((int) Input[3] * p16 -> Domain[3]);
835
836 k0 = FIXED_TO_INT(fk);
837 x0 = FIXED_TO_INT(fx);
838 y0 = FIXED_TO_INT(fy);
839 z0 = FIXED_TO_INT(fz);
840
841 rk = FIXED_REST_TO_INT(fk);
842 rx = FIXED_REST_TO_INT(fx);
843 ry = FIXED_REST_TO_INT(fy);
844 rz = FIXED_REST_TO_INT(fz);
845
846 K0 = p16 -> opta[3] * k0;
847 K1 = K0 + (Input[0] == 0xFFFFU ? 0 : p16->opta[3]);
848
849 X0 = p16 -> opta[2] * x0;
850 X1 = X0 + (Input[1] == 0xFFFFU ? 0 : p16->opta[2]);
851
852 Y0 = p16 -> opta[1] * y0;
853 Y1 = Y0 + (Input[2] == 0xFFFFU ? 0 : p16->opta[1]);
854
855 Z0 = p16 -> opta[0] * z0;
856 Z1 = Z0 + (Input[3] == 0xFFFFU ? 0 : p16->opta[0]);
857
858 LutTable = (cmsUInt16Number*) p16 -> Table;
859 LutTable += K0;
860
861 for (OutChan=0; OutChan < p16 -> nOutputs; OutChan++) {
862
863 c0 = DENS(X0, Y0, Z0);
864
865 if (rx >= ry && ry >= rz) {
866
867 c1 = DENS(X1, Y0, Z0) - c0;
868 c2 = DENS(X1, Y1, Z0) - DENS(X1, Y0, Z0);
869 c3 = DENS(X1, Y1, Z1) - DENS(X1, Y1, Z0);
870
871 }
872 else
873 if (rx >= rz && rz >= ry) {
874
875 c1 = DENS(X1, Y0, Z0) - c0;
876 c2 = DENS(X1, Y1, Z1) - DENS(X1, Y0, Z1);
877 c3 = DENS(X1, Y0, Z1) - DENS(X1, Y0, Z0);
878
879 }
880 else
881 if (rz >= rx && rx >= ry) {
882
883 c1 = DENS(X1, Y0, Z1) - DENS(X0, Y0, Z1);
884 c2 = DENS(X1, Y1, Z1) - DENS(X1, Y0, Z1);
885 c3 = DENS(X0, Y0, Z1) - c0;
886
887 }
888 else
889 if (ry >= rx && rx >= rz) {
890
891 c1 = DENS(X1, Y1, Z0) - DENS(X0, Y1, Z0);
892 c2 = DENS(X0, Y1, Z0) - c0;
893 c3 = DENS(X1, Y1, Z1) - DENS(X1, Y1, Z0);
894
895 }
896 else
897 if (ry >= rz && rz >= rx) {
898
899 c1 = DENS(X1, Y1, Z1) - DENS(X0, Y1, Z1);
900 c2 = DENS(X0, Y1, Z0) - c0;
901 c3 = DENS(X0, Y1, Z1) - DENS(X0, Y1, Z0);
902
903 }
904 else
905 if (rz >= ry && ry >= rx) {
906
907 c1 = DENS(X1, Y1, Z1) - DENS(X0, Y1, Z1);
908 c2 = DENS(X0, Y1, Z1) - DENS(X0, Y0, Z1);
909 c3 = DENS(X0, Y0, Z1) - c0;
910
911 }
912 else {
913 c1 = c2 = c3 = 0;
914 }
915
916 Rest = c1 * rx + c2 * ry + c3 * rz;
917
918 Tmp1[OutChan] = (cmsUInt16Number) c0 + ROUND_FIXED_TO_INT(_cmsToFixedDomain(Rest));
919 }
920
921
922 LutTable = (cmsUInt16Number*) p16 -> Table;
923 LutTable += K1;
924
925 for (OutChan=0; OutChan < p16 -> nOutputs; OutChan++) {
926
927 c0 = DENS(X0, Y0, Z0);
928
929 if (rx >= ry && ry >= rz) {
930
931 c1 = DENS(X1, Y0, Z0) - c0;
932 c2 = DENS(X1, Y1, Z0) - DENS(X1, Y0, Z0);
933 c3 = DENS(X1, Y1, Z1) - DENS(X1, Y1, Z0);
934
935 }
936 else
937 if (rx >= rz && rz >= ry) {
938
939 c1 = DENS(X1, Y0, Z0) - c0;
940 c2 = DENS(X1, Y1, Z1) - DENS(X1, Y0, Z1);
941 c3 = DENS(X1, Y0, Z1) - DENS(X1, Y0, Z0);
942
943 }
944 else
945 if (rz >= rx && rx >= ry) {
946
947 c1 = DENS(X1, Y0, Z1) - DENS(X0, Y0, Z1);
948 c2 = DENS(X1, Y1, Z1) - DENS(X1, Y0, Z1);
949 c3 = DENS(X0, Y0, Z1) - c0;
950
951 }
952 else
953 if (ry >= rx && rx >= rz) {
954
955 c1 = DENS(X1, Y1, Z0) - DENS(X0, Y1, Z0);
956 c2 = DENS(X0, Y1, Z0) - c0;
957 c3 = DENS(X1, Y1, Z1) - DENS(X1, Y1, Z0);
958
959 }
960 else
961 if (ry >= rz && rz >= rx) {
962
963 c1 = DENS(X1, Y1, Z1) - DENS(X0, Y1, Z1);
964 c2 = DENS(X0, Y1, Z0) - c0;
965 c3 = DENS(X0, Y1, Z1) - DENS(X0, Y1, Z0);
966
967 }
968 else
969 if (rz >= ry && ry >= rx) {
970
971 c1 = DENS(X1, Y1, Z1) - DENS(X0, Y1, Z1);
972 c2 = DENS(X0, Y1, Z1) - DENS(X0, Y0, Z1);
973 c3 = DENS(X0, Y0, Z1) - c0;
974
975 }
976 else {
977 c1 = c2 = c3 = 0;
978 }
979
980 Rest = c1 * rx + c2 * ry + c3 * rz;
981
982 Tmp2[OutChan] = (cmsUInt16Number) c0 + ROUND_FIXED_TO_INT(_cmsToFixedDomain(Rest));
983 }
984
985
986
987 for (i=0; i < p16 -> nOutputs; i++) {
988 Output[i] = LinearInterp(rk, Tmp1[i], Tmp2[i]);
989 }
990 }
991 #undef DENS
992
993
994 // For more that 3 inputs (i.e., CMYK)
995 // evaluate two 3-dimensional interpolations and then linearly interpolate between them.
996
997
998 static
999 void Eval4InputsFloat(const cmsFloat32Number Input[],
1000 cmsFloat32Number Output[],
1001 const cmsInterpParams* p)
1002 {
1003 const cmsFloat32Number* LutTable = (cmsFloat32Number*) p -> Table;
1004 cmsFloat32Number rest;
1005 cmsFloat32Number pk;
1006 int k0, K0, K1;
1007 const cmsFloat32Number* T;
1008 cmsUInt32Number i;
1009 cmsFloat32Number Tmp1[MAX_STAGE_CHANNELS], Tmp2[MAX_STAGE_CHANNELS];
1010 cmsInterpParams p1;
1011
1012
1013 pk = Input[0] * p->Domain[0];
1014 k0 = _cmsQuickFloor(pk);
1015 rest = pk - (cmsFloat32Number) k0;
1016
1017 K0 = p -> opta[3] * k0;
1018 K1 = K0 + (Input[0] >= 1.0 ? 0 : p->opta[3]);
1019
1020 p1 = *p;
1021 memmove(&p1.Domain[0], &p ->Domain[1], 3*sizeof(cmsUInt32Number));
1022
1023 T = LutTable + K0;
1024 p1.Table = T;
1025
1026 TetrahedralInterpFloat(Input + 1, Tmp1, &p1);
1027
1028 T = LutTable + K1;
1029 p1.Table = T;
1030 TetrahedralInterpFloat(Input + 1, Tmp2, &p1);
1031
1032 for (i=0; i < p -> nOutputs; i++)
1033 {
1034 cmsFloat32Number y0 = Tmp1[i];
1035 cmsFloat32Number y1 = Tmp2[i];
1036
1037 Output[i] = y0 + (y1 - y0) * rest;
1038 }
1039 }
1040
1041
1042 static
1043 void Eval5Inputs(register const cmsUInt16Number Input[],
1044 register cmsUInt16Number Output[],
1045
1046 register const cmsInterpParams* p16)
1047 {
1048 const cmsUInt16Number* LutTable = (cmsUInt16Number*) p16 -> Table;
1049 cmsS15Fixed16Number fk;
1050 cmsS15Fixed16Number k0, rk;
1051 int K0, K1;
1052 const cmsUInt16Number* T;
1053 cmsUInt32Number i;
1054 cmsUInt16Number Tmp1[MAX_STAGE_CHANNELS], Tmp2[MAX_STAGE_CHANNELS];
1055 cmsInterpParams p1;
1056
1057
1058 fk = _cmsToFixedDomain((cmsS15Fixed16Number) Input[0] * p16 -> Domain[0]);
1059 k0 = FIXED_TO_INT(fk);
1060 rk = FIXED_REST_TO_INT(fk);
1061
1062 K0 = p16 -> opta[4] * k0;
1063 K1 = p16 -> opta[4] * (k0 + (Input[0] != 0xFFFFU ? 1 : 0));
1064
1065 p1 = *p16;
1066 memmove(&p1.Domain[0], &p16 ->Domain[1], 4*sizeof(cmsUInt32Number));
1067
1068 T = LutTable + K0;
1069 p1.Table = T;
1070
1071 Eval4Inputs(Input + 1, Tmp1, &p1);
1072
1073 T = LutTable + K1;
1074 p1.Table = T;
1075
1076 Eval4Inputs(Input + 1, Tmp2, &p1);
1077
1078 for (i=0; i < p16 -> nOutputs; i++) {
1079
1080 Output[i] = LinearInterp(rk, Tmp1[i], Tmp2[i]);
1081 }
1082
1083 }
1084
1085
1086 static
1087 void Eval5InputsFloat(const cmsFloat32Number Input[],
1088 cmsFloat32Number Output[],
1089 const cmsInterpParams* p)
1090 {
1091 const cmsFloat32Number* LutTable = (cmsFloat32Number*) p -> Table;
1092 cmsFloat32Number rest;
1093 cmsFloat32Number pk;
1094 int k0, K0, K1;
1095 const cmsFloat32Number* T;
1096 cmsUInt32Number i;
1097 cmsFloat32Number Tmp1[MAX_STAGE_CHANNELS], Tmp2[MAX_STAGE_CHANNELS];
1098 cmsInterpParams p1;
1099
1100 pk = Input[0] * p->Domain[0];
1101 k0 = _cmsQuickFloor(pk);
1102 rest = pk - (cmsFloat32Number) k0;
1103
1104 K0 = p -> opta[4] * k0;
1105 K1 = K0 + (Input[0] >= 1.0 ? 0 : p->opta[4]);
1106
1107 p1 = *p;
1108 memmove(&p1.Domain[0], &p ->Domain[1], 4*sizeof(cmsUInt32Number));
1109
1110 T = LutTable + K0;
1111 p1.Table = T;
1112
1113 Eval4InputsFloat(Input + 1, Tmp1, &p1);
1114
1115 T = LutTable + K1;
1116 p1.Table = T;
1117
1118 Eval4InputsFloat(Input + 1, Tmp2, &p1);
1119
1120 for (i=0; i < p -> nOutputs; i++) {
1121
1122 cmsFloat32Number y0 = Tmp1[i];
1123 cmsFloat32Number y1 = Tmp2[i];
1124
1125 Output[i] = y0 + (y1 - y0) * rest;
1126 }
1127 }
1128
1129
1130
1131 static
1132 void Eval6Inputs(register const cmsUInt16Number Input[],
1133 register cmsUInt16Number Output[],
1134 register const cmsInterpParams* p16)
1135 {
1136 const cmsUInt16Number* LutTable = (cmsUInt16Number*) p16 -> Table;
1137 cmsS15Fixed16Number fk;
1138 cmsS15Fixed16Number k0, rk;
1139 int K0, K1;
1140 const cmsUInt16Number* T;
1141 cmsUInt32Number i;
1142 cmsUInt16Number Tmp1[MAX_STAGE_CHANNELS], Tmp2[MAX_STAGE_CHANNELS];
1143 cmsInterpParams p1;
1144
1145 fk = _cmsToFixedDomain((cmsS15Fixed16Number) Input[0] * p16 -> Domain[0]);
1146 k0 = FIXED_TO_INT(fk);
1147 rk = FIXED_REST_TO_INT(fk);
1148
1149 K0 = p16 -> opta[5] * k0;
1150 K1 = p16 -> opta[5] * (k0 + (Input[0] != 0xFFFFU ? 1 : 0));
1151
1152 p1 = *p16;
1153 memmove(&p1.Domain[0], &p16 ->Domain[1], 5*sizeof(cmsUInt32Number));
1154
1155 T = LutTable + K0;
1156 p1.Table = T;
1157
1158 Eval5Inputs(Input + 1, Tmp1, &p1);
1159
1160 T = LutTable + K1;
1161 p1.Table = T;
1162
1163 Eval5Inputs(Input + 1, Tmp2, &p1);
1164
1165 for (i=0; i < p16 -> nOutputs; i++) {
1166
1167 Output[i] = LinearInterp(rk, Tmp1[i], Tmp2[i]);
1168 }
1169
1170 }
1171
1172
1173 static
1174 void Eval6InputsFloat(const cmsFloat32Number Input[],
1175 cmsFloat32Number Output[],
1176 const cmsInterpParams* p)
1177 {
1178 const cmsFloat32Number* LutTable = (cmsFloat32Number*) p -> Table;
1179 cmsFloat32Number rest;
1180 cmsFloat32Number pk;
1181 int k0, K0, K1;
1182 const cmsFloat32Number* T;
1183 cmsUInt32Number i;
1184 cmsFloat32Number Tmp1[MAX_STAGE_CHANNELS], Tmp2[MAX_STAGE_CHANNELS];
1185 cmsInterpParams p1;
1186
1187 pk = Input[0] * p->Domain[0];
1188 k0 = _cmsQuickFloor(pk);
1189 rest = pk - (cmsFloat32Number) k0;
1190
1191 K0 = p -> opta[5] * k0;
1192 K1 = K0 + (Input[0] >= 1.0 ? 0 : p->opta[5]);
1193
1194 p1 = *p;
1195 memmove(&p1.Domain[0], &p ->Domain[1], 5*sizeof(cmsUInt32Number));
1196
1197 T = LutTable + K0;
1198 p1.Table = T;
1199
1200 Eval5InputsFloat(Input + 1, Tmp1, &p1);
1201
1202 T = LutTable + K1;
1203 p1.Table = T;
1204
1205 Eval5InputsFloat(Input + 1, Tmp2, &p1);
1206
1207 for (i=0; i < p -> nOutputs; i++) {
1208
1209 cmsFloat32Number y0 = Tmp1[i];
1210 cmsFloat32Number y1 = Tmp2[i];
1211
1212 Output[i] = y0 + (y1 - y0) * rest;
1213 }
1214 }
1215
1216
1217 static
1218 void Eval7Inputs(register const cmsUInt16Number Input[],
1219 register cmsUInt16Number Output[],
1220 register const cmsInterpParams* p16)
1221 {
1222 const cmsUInt16Number* LutTable = (cmsUInt16Number*) p16 -> Table;
1223 cmsS15Fixed16Number fk;
1224 cmsS15Fixed16Number k0, rk;
1225 int K0, K1;
1226 const cmsUInt16Number* T;
1227 cmsUInt32Number i;
1228 cmsUInt16Number Tmp1[MAX_STAGE_CHANNELS], Tmp2[MAX_STAGE_CHANNELS];
1229 cmsInterpParams p1;
1230
1231
1232 fk = _cmsToFixedDomain((cmsS15Fixed16Number) Input[0] * p16 -> Domain[0]);
1233 k0 = FIXED_TO_INT(fk);
1234 rk = FIXED_REST_TO_INT(fk);
1235
1236 K0 = p16 -> opta[6] * k0;
1237 K1 = p16 -> opta[6] * (k0 + (Input[0] != 0xFFFFU ? 1 : 0));
1238
1239 p1 = *p16;
1240 memmove(&p1.Domain[0], &p16 ->Domain[1], 6*sizeof(cmsUInt32Number));
1241
1242 T = LutTable + K0;
1243 p1.Table = T;
1244
1245 Eval6Inputs(Input + 1, Tmp1, &p1);
1246
1247 T = LutTable + K1;
1248 p1.Table = T;
1249
1250 Eval6Inputs(Input + 1, Tmp2, &p1);
1251
1252 for (i=0; i < p16 -> nOutputs; i++) {
1253 Output[i] = LinearInterp(rk, Tmp1[i], Tmp2[i]);
1254 }
1255 }
1256
1257
1258 static
1259 void Eval7InputsFloat(const cmsFloat32Number Input[],
1260 cmsFloat32Number Output[],
1261 const cmsInterpParams* p)
1262 {
1263 const cmsFloat32Number* LutTable = (cmsFloat32Number*) p -> Table;
1264 cmsFloat32Number rest;
1265 cmsFloat32Number pk;
1266 int k0, K0, K1;
1267 const cmsFloat32Number* T;
1268 cmsUInt32Number i;
1269 cmsFloat32Number Tmp1[MAX_STAGE_CHANNELS], Tmp2[MAX_STAGE_CHANNELS];
1270 cmsInterpParams p1;
1271
1272 pk = Input[0] * p->Domain[0];
1273 k0 = _cmsQuickFloor(pk);
1274 rest = pk - (cmsFloat32Number) k0;
1275
1276 K0 = p -> opta[6] * k0;
1277 K1 = K0 + (Input[0] >= 1.0 ? 0 : p->opta[6]);
1278
1279 p1 = *p;
1280 memmove(&p1.Domain[0], &p ->Domain[1], 6*sizeof(cmsUInt32Number));
1281
1282 T = LutTable + K0;
1283 p1.Table = T;
1284
1285 Eval6InputsFloat(Input + 1, Tmp1, &p1);
1286
1287 T = LutTable + K1;
1288 p1.Table = T;
1289
1290 Eval6InputsFloat(Input + 1, Tmp2, &p1);
1291
1292
1293 for (i=0; i < p -> nOutputs; i++) {
1294
1295 cmsFloat32Number y0 = Tmp1[i];
1296 cmsFloat32Number y1 = Tmp2[i];
1297
1298 Output[i] = y0 + (y1 - y0) * rest;
1299
1300 }
1301 }
1302
1303 static
1304 void Eval8Inputs(register const cmsUInt16Number Input[],
1305 register cmsUInt16Number Output[],
1306 register const cmsInterpParams* p16)
1307 {
1308 const cmsUInt16Number* LutTable = (cmsUInt16Number*) p16 -> Table;
1309 cmsS15Fixed16Number fk;
1310 cmsS15Fixed16Number k0, rk;
1311 int K0, K1;
1312 const cmsUInt16Number* T;
1313 cmsUInt32Number i;
1314 cmsUInt16Number Tmp1[MAX_STAGE_CHANNELS], Tmp2[MAX_STAGE_CHANNELS];
1315 cmsInterpParams p1;
1316
1317 fk = _cmsToFixedDomain((cmsS15Fixed16Number) Input[0] * p16 -> Domain[0]);
1318 k0 = FIXED_TO_INT(fk);
1319 rk = FIXED_REST_TO_INT(fk);
1320
1321 K0 = p16 -> opta[7] * k0;
1322 K1 = p16 -> opta[7] * (k0 + (Input[0] != 0xFFFFU ? 1 : 0));
1323
1324 p1 = *p16;
1325 memmove(&p1.Domain[0], &p16 ->Domain[1], 7*sizeof(cmsUInt32Number));
1326
1327 T = LutTable + K0;
1328 p1.Table = T;
1329
1330 Eval7Inputs(Input + 1, Tmp1, &p1);
1331
1332 T = LutTable + K1;
1333 p1.Table = T;
1334 Eval7Inputs(Input + 1, Tmp2, &p1);
1335
1336 for (i=0; i < p16 -> nOutputs; i++) {
1337 Output[i] = LinearInterp(rk, Tmp1[i], Tmp2[i]);
1338 }
1339 }
1340
1341
1342
1343 static
1344 void Eval8InputsFloat(const cmsFloat32Number Input[],
1345 cmsFloat32Number Output[],
1346 const cmsInterpParams* p)
1347 {
1348 const cmsFloat32Number* LutTable = (cmsFloat32Number*) p -> Table;
1349 cmsFloat32Number rest;
1350 cmsFloat32Number pk;
1351 int k0, K0, K1;
1352 const cmsFloat32Number* T;
1353 cmsUInt32Number i;
1354 cmsFloat32Number Tmp1[MAX_STAGE_CHANNELS], Tmp2[MAX_STAGE_CHANNELS];
1355 cmsInterpParams p1;
1356
1357 pk = Input[0] * p->Domain[0];
1358 k0 = _cmsQuickFloor(pk);
1359 rest = pk - (cmsFloat32Number) k0;
1360
1361 K0 = p -> opta[7] * k0;
1362 K1 = K0 + (Input[0] >= 1.0 ? 0 : p->opta[7]);
1363
1364 p1 = *p;
1365 memmove(&p1.Domain[0], &p ->Domain[1], 7*sizeof(cmsUInt32Number));
1366
1367 T = LutTable + K0;
1368 p1.Table = T;
1369
1370 Eval7InputsFloat(Input + 1, Tmp1, &p1);
1371
1372 T = LutTable + K1;
1373 p1.Table = T;
1374
1375 Eval7InputsFloat(Input + 1, Tmp2, &p1);
1376
1377
1378 for (i=0; i < p -> nOutputs; i++) {
1379
1380 cmsFloat32Number y0 = Tmp1[i];
1381 cmsFloat32Number y1 = Tmp2[i];
1382
1383 Output[i] = y0 + (y1 - y0) * rest;
1384 }
1385 }
1386
1387 // The default factory
1388 static
1389 cmsInterpFunction DefaultInterpolatorsFactory(cmsUInt32Number nInputChannels, cmsUInt32Number nOutputChannels, cmsUInt32Number dwFlags)
1390 {
1391
1392 cmsInterpFunction Interpolation;
1393 cmsBool IsFloat = (dwFlags & CMS_LERP_FLAGS_FLOAT);
1394 cmsBool IsTrilinear = (dwFlags & CMS_LERP_FLAGS_TRILINEAR);
1395
1396 memset(&Interpolation, 0, sizeof(Interpolation));
1397
1398 // Safety check
1399 if (nInputChannels >= 4 && nOutputChannels >= MAX_STAGE_CHANNELS)
1400 return Interpolation;
1401
1402 switch (nInputChannels) {
1403
1404 case 1: // Gray LUT / linear
1405
1406 if (nOutputChannels == 1) {
1407
1408 if (IsFloat)
1409 Interpolation.LerpFloat = LinLerp1Dfloat;
1410 else
1411 Interpolation.Lerp16 = LinLerp1D;
1412
1413 }
1414 else {
1415
1416 if (IsFloat)
1417 Interpolation.LerpFloat = Eval1InputFloat;
1418 else
1419 Interpolation.Lerp16 = Eval1Input;
1420 }
1421 break;
1422
1423 case 2: // Duotone
1424 if (IsFloat)
1425 Interpolation.LerpFloat = BilinearInterpFloat;
1426 else
1427 Interpolation.Lerp16 = BilinearInterp16;
1428 break;
1429
1430 case 3: // RGB et al
1431
1432 if (IsTrilinear) {
1433
1434 if (IsFloat)
1435 Interpolation.LerpFloat = TrilinearInterpFloat;
1436 else
1437 Interpolation.Lerp16 = TrilinearInterp16;
1438 }
1439 else {
1440
1441 if (IsFloat)
1442 Interpolation.LerpFloat = TetrahedralInterpFloat;
1443 else {
1444
1445 Interpolation.Lerp16 = TetrahedralInterp16;
1446 }
1447 }
1448 break;
1449
1450 case 4: // CMYK lut
1451
1452 if (IsFloat)
1453 Interpolation.LerpFloat = Eval4InputsFloat;
1454 else
1455 Interpolation.Lerp16 = Eval4Inputs;
1456 break;
1457
1458 case 5: // 5 Inks
1459 if (IsFloat)
1460 Interpolation.LerpFloat = Eval5InputsFloat;
1461 else
1462 Interpolation.Lerp16 = Eval5Inputs;
1463 break;
1464
1465 case 6: // 6 Inks
1466 if (IsFloat)
1467 Interpolation.LerpFloat = Eval6InputsFloat;
1468 else
1469 Interpolation.Lerp16 = Eval6Inputs;
1470 break;
1471
1472 case 7: // 7 inks
1473 if (IsFloat)
1474 Interpolation.LerpFloat = Eval7InputsFloat;
1475 else
1476 Interpolation.Lerp16 = Eval7Inputs;
1477 break;
1478
1479 case 8: // 8 inks
1480 if (IsFloat)
1481 Interpolation.LerpFloat = Eval8InputsFloat;
1482 else
1483 Interpolation.Lerp16 = Eval8Inputs;
1484 break;
1485
1486 break;
1487
1488 default:
1489 Interpolation.Lerp16 = NULL;
1490 }
1491
1492 return Interpolation;
1493 }
Mirror of AROS' svn.