//---------------------------------------------------------------------------------

//

//  Little Color Management System

//  Copyright (c) 1998-2024 Marti Maria Saguer

//

// Permission is hereby granted, free of charge, to any person obtaining

// a copy of this software and associated documentation files (the "Software"),

// to deal in the Software without restriction, including without limitation

// the rights to use, copy, modify, merge, publish, distribute, sublicense,

// and/or sell copies of the Software, and to permit persons to whom the Software

// is furnished to do so, subject to the following conditions:

//

// The above copyright notice and this permission notice shall be included in

// all copies or substantial portions of the Software.

//

// THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,

// EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO

// THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND

// NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE

// LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION

// OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION

// WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.

//

//---------------------------------------------------------------------------------

//

#include "lcms2_internal.h"

// This module incorporates several interpolation routines, for 1 to 8 channels on input and

// up to 65535 channels on output. The user may change those by using the interpolation plug-in

// Some people may want to compile as C++ with all warnings on, in this case make compiler silent

#ifdef _MSC_VER

#    if (_MSC_VER >= 1400)

#       pragma warning( disable : 4365 )

#    endif

#endif

// Interpolation routines by default

static cmsInterpFunction DefaultInterpolatorsFactory(cmsUInt32Number nInputChannels, cmsUInt32Number nOutputChannels, cmsUInt32Number dwFlags);

// This is the default factory

_cmsInterpPluginChunkType _cmsInterpPluginChunk = { NULL };

// The interpolation plug-in memory chunk allocator/dup

void _cmsAllocInterpPluginChunk(struct _cmsContext_struct* ctx, const struct _cmsContext_struct* src)

{

    void* from;

    _cmsAssert(ctx != NULL);

    if (src != NULL) {

        from = src ->chunks[InterpPlugin];       

    }

    else { 

        static _cmsInterpPluginChunkType InterpPluginChunk = { NULL };

        from = &InterpPluginChunk;

    }

    _cmsAssert(from != NULL);

    ctx ->chunks[InterpPlugin] = _cmsSubAllocDup(ctx ->MemPool, from, sizeof(_cmsInterpPluginChunkType));

}

// Main plug-in entry

cmsBool  _cmsRegisterInterpPlugin(cmsContext ContextID, cmsPluginBase* Data)

{

    cmsPluginInterpolation* Plugin = (cmsPluginInterpolation*) Data;

    _cmsInterpPluginChunkType* ptr = (_cmsInterpPluginChunkType*) _cmsContextGetClientChunk(ContextID, InterpPlugin);

    if (Data == NULL) {

        ptr ->Interpolators = NULL;

        return TRUE;

    }

    // Set replacement functions

    ptr ->Interpolators = Plugin ->InterpolatorsFactory;

    return TRUE;

}

// Set the interpolation method

cmsBool _cmsSetInterpolationRoutine(cmsContext ContextID, cmsInterpParams* p)

{      

    _cmsInterpPluginChunkType* ptr = (_cmsInterpPluginChunkType*) _cmsContextGetClientChunk(ContextID, InterpPlugin);

    p ->Interpolation.Lerp16 = NULL;

   // Invoke factory, possibly in the Plug-in

    if (ptr ->Interpolators != NULL)

        p ->Interpolation = ptr->Interpolators(p -> nInputs, p ->nOutputs, p ->dwFlags);

    // If unsupported by the plug-in, go for the LittleCMS default.

    // If happens only if an extern plug-in is being used

    if (p ->Interpolation.Lerp16 == NULL)

        p ->Interpolation = DefaultInterpolatorsFactory(p ->nInputs, p ->nOutputs, p ->dwFlags);

    // Check for valid interpolator (we just check one member of the union)

    if (p ->Interpolation.Lerp16 == NULL) {

            return FALSE;

    }

    return TRUE;

}

// This function precalculates as many parameters as possible to speed up the interpolation.

cmsInterpParams* _cmsComputeInterpParamsEx(cmsContext ContextID,

                                           const cmsUInt32Number nSamples[],

                                           cmsUInt32Number InputChan, cmsUInt32Number OutputChan,

                                           const void *Table,

                                           cmsUInt32Number dwFlags)

{

    cmsInterpParams* p;

    cmsUInt32Number i;

    // Check for maximum inputs

    if (InputChan > MAX_INPUT_DIMENSIONS) {

             cmsSignalError(ContextID, cmsERROR_RANGE, "Too many input channels (%d channels, max=%d)", InputChan, MAX_INPUT_DIMENSIONS);

            return NULL;

    }

    // Creates an empty object

    p = (cmsInterpParams*) _cmsMallocZero(ContextID, sizeof(cmsInterpParams));

    if (p == NULL) return NULL;

    // Keep original parameters

    p -> dwFlags  = dwFlags;

    p -> nInputs  = InputChan;

    p -> nOutputs = OutputChan;

    p ->Table     = Table;

    p ->ContextID  = ContextID;

    // Fill samples per input direction and domain (which is number of nodes minus one)

    for (i=0; i < InputChan; i++) {

        p -> nSamples[i] = nSamples[i];

        p -> Domain[i]   = nSamples[i] - 1;

    }

    // Compute factors to apply to each component to index the grid array

    p -> opta[0] = p -> nOutputs;

    for (i=1; i < InputChan; i++)

        p ->opta[i] = p ->opta[i-1] * nSamples[InputChan-i];

    if (!_cmsSetInterpolationRoutine(ContextID, p)) {

         cmsSignalError(ContextID, cmsERROR_UNKNOWN_EXTENSION, "Unsupported interpolation (%d->%d channels)", InputChan, OutputChan);

        _cmsFree(ContextID, p);

        return NULL;

    }

    // All seems ok

    return p;

}

// This one is a wrapper on the anterior, but assuming all directions have same number of nodes

cmsInterpParams* CMSEXPORT _cmsComputeInterpParams(cmsContext ContextID, cmsUInt32Number nSamples, 

                                                   cmsUInt32Number InputChan, cmsUInt32Number OutputChan, const void* Table, cmsUInt32Number dwFlags)

{

    int i;

    cmsUInt32Number Samples[MAX_INPUT_DIMENSIONS];

    // Fill the auxiliary array

    for (i=0; i < MAX_INPUT_DIMENSIONS; i++)

        Samples[i] = nSamples;

    // Call the extended function

    return _cmsComputeInterpParamsEx(ContextID, Samples, InputChan, OutputChan, Table, dwFlags);

}

// Free all associated memory

void CMSEXPORT _cmsFreeInterpParams(cmsInterpParams* p)

{

    if (p != NULL) _cmsFree(p ->ContextID, p);

}

// Inline fixed point interpolation

cmsINLINE CMS_NO_SANITIZE cmsUInt16Number LinearInterp(cmsS15Fixed16Number a, cmsS15Fixed16Number l, cmsS15Fixed16Number h)

{

    cmsUInt32Number dif = (cmsUInt32Number) (h - l) * a + 0x8000;

    dif = (dif >> 16) + l;

    return (cmsUInt16Number) (dif);

}

//  Linear interpolation (Fixed-point optimized)

static

void LinLerp1D(CMSREGISTER const cmsUInt16Number Value[],

               CMSREGISTER cmsUInt16Number Output[],

               CMSREGISTER const cmsInterpParams* p)

{

    cmsUInt16Number y1, y0;

    int cell0, rest;

    int val3;

    const cmsUInt16Number* LutTable = (cmsUInt16Number*) p ->Table;

    // if last value or just one point

    if (Value[0] == 0xffff || p->Domain[0] == 0) {

        Output[0] = LutTable[p -> Domain[0]];      

    }

    else

    {

        val3 = p->Domain[0] * Value[0];

        val3 = _cmsToFixedDomain(val3);    // To fixed 15.16

        cell0 = FIXED_TO_INT(val3);             // Cell is 16 MSB bits

        rest = FIXED_REST_TO_INT(val3);        // Rest is 16 LSB bits

        y0 = LutTable[cell0];

        y1 = LutTable[cell0 + 1];

        Output[0] = LinearInterp(rest, y0, y1);

    }

}

// To prevent out of bounds indexing

cmsINLINE cmsFloat32Number fclamp(cmsFloat32Number v) 

{

    return ((v < 1.0e-9f) || isnan(v)) ? 0.0f : (v > 1.0f ? 1.0f : v);

}

// Floating-point version of 1D interpolation

static

void LinLerp1Dfloat(const cmsFloat32Number Value[],

                    cmsFloat32Number Output[],

                    const cmsInterpParams* p)

{

       cmsFloat32Number y1, y0;

       cmsFloat32Number val2, rest;

       int cell0, cell1;

       const cmsFloat32Number* LutTable = (cmsFloat32Number*) p ->Table;

       val2 = fclamp(Value[0]);

       // if last value...

       if (val2 == 1.0 || p->Domain[0] == 0) {

           Output[0] = LutTable[p -> Domain[0]];          

       }

       else

       {

           val2 *= p->Domain[0];

           cell0 = (int)floor(val2);

           cell1 = (int)ceil(val2);

           // Rest is 16 LSB bits

           rest = val2 - cell0;

           y0 = LutTable[cell0];

           y1 = LutTable[cell1];

           Output[0] = y0 + (y1 - y0) * rest;

       }

}

// Eval gray LUT having only one input channel

static CMS_NO_SANITIZE

void Eval1Input(CMSREGISTER const cmsUInt16Number Input[],

                CMSREGISTER cmsUInt16Number Output[],

                CMSREGISTER const cmsInterpParams* p16)

{

       cmsS15Fixed16Number fk;

       cmsS15Fixed16Number k0, k1, rk, K0, K1;

       int v;

       cmsUInt32Number OutChan;

       const cmsUInt16Number* LutTable = (cmsUInt16Number*) p16 -> Table;

       // if last value...

       if (Input[0] == 0xffff || p16->Domain[0] == 0) {

           cmsUInt32Number y0 = p16->Domain[0] * p16->opta[0];

           for (OutChan = 0; OutChan < p16->nOutputs; OutChan++) {

               Output[OutChan] = LutTable[y0 + OutChan];

           }

       }

       else

       {

           v = Input[0] * p16->Domain[0];

           fk = _cmsToFixedDomain(v);

           k0 = FIXED_TO_INT(fk);

           rk = (cmsUInt16Number)FIXED_REST_TO_INT(fk);

           k1 = k0 + (Input[0] != 0xFFFFU ? 1 : 0);

           K0 = p16->opta[0] * k0;

           K1 = p16->opta[0] * k1;

           for (OutChan = 0; OutChan < p16->nOutputs; OutChan++) {

               Output[OutChan] = LinearInterp(rk, LutTable[K0 + OutChan], LutTable[K1 + OutChan]);

           }

       }

}

// Eval gray LUT having only one input channel

static

void Eval1InputFloat(const cmsFloat32Number Value[],

                     cmsFloat32Number Output[],

                     const cmsInterpParams* p)

{

    cmsFloat32Number y1, y0;

    cmsFloat32Number val2, rest;

    int cell0, cell1;

    cmsUInt32Number OutChan;

    const cmsFloat32Number* LutTable = (cmsFloat32Number*) p ->Table;

    val2 = fclamp(Value[0]);

    // if last value...

    if (val2 == 1.0 || p->Domain[0] == 0) {

        cmsUInt32Number start = p->Domain[0] * p->opta[0];

        for (OutChan = 0; OutChan < p->nOutputs; OutChan++) {

            Output[OutChan] = LutTable[start + OutChan];

        }        

    }

    else

    {

        val2 *= p->Domain[0];

        cell0 = (int)floor(val2);

        cell1 = (int)ceil(val2);

        // Rest is 16 LSB bits

        rest = val2 - cell0;

        cell0 *= p->opta[0];

        cell1 *= p->opta[0];

        for (OutChan = 0; OutChan < p->nOutputs; OutChan++) {

            y0 = LutTable[cell0 + OutChan];

            y1 = LutTable[cell1 + OutChan];

            Output[OutChan] = y0 + (y1 - y0) * rest;

        }

    }

}

// Bilinear interpolation (16 bits) - cmsFloat32Number version

static

void BilinearInterpFloat(const cmsFloat32Number Input[],

                         cmsFloat32Number Output[],

                         const cmsInterpParams* p)

{

#   define LERP(a,l,h)    (cmsFloat32Number) ((l)+(((h)-(l))*(a)))

#   define DENS(i,j)      (LutTable[(i)+(j)+OutChan])

    const cmsFloat32Number* LutTable = (cmsFloat32Number*) p ->Table;

    cmsFloat32Number      px, py;

    int        x0, y0,

               X0, Y0, X1, Y1;

    int        TotalOut, OutChan;

    cmsFloat32Number      fx, fy,

        d00, d01, d10, d11,

        dx0, dx1,

        dxy;

    TotalOut   = p -> nOutputs;

    px = fclamp(Input[0]) * p->Domain[0];

    py = fclamp(Input[1]) * p->Domain[1];

    x0 = (int) _cmsQuickFloor(px); fx = px - (cmsFloat32Number) x0;

    y0 = (int) _cmsQuickFloor(py); fy = py - (cmsFloat32Number) y0;

    X0 = p -> opta[1] * x0;

    X1 = X0 + (fclamp(Input[0]) >= 1.0 ? 0 : p->opta[1]);

    Y0 = p -> opta[0] * y0;

    Y1 = Y0 + (fclamp(Input[1]) >= 1.0 ? 0 : p->opta[0]);

    for (OutChan = 0; OutChan < TotalOut; OutChan++) {

        d00 = DENS(X0, Y0);

        d01 = DENS(X0, Y1);

        d10 = DENS(X1, Y0);

        d11 = DENS(X1, Y1);

        dx0 = LERP(fx, d00, d10);

        dx1 = LERP(fx, d01, d11);

        dxy = LERP(fy, dx0, dx1);

        Output[OutChan] = dxy;

    }

#   undef LERP

#   undef DENS

}

// Bilinear interpolation (16 bits) - optimized version

static CMS_NO_SANITIZE

void BilinearInterp16(CMSREGISTER const cmsUInt16Number Input[],

                      CMSREGISTER cmsUInt16Number Output[],

                      CMSREGISTER const cmsInterpParams* p)

{

#define DENS(i,j) (LutTable[(i)+(j)+OutChan])

#define LERP(a,l,h)     (cmsUInt16Number) (l + ROUND_FIXED_TO_INT(((h-l)*a)))

           const cmsUInt16Number* LutTable = (cmsUInt16Number*) p ->Table;

           int        OutChan, TotalOut;

           cmsS15Fixed16Number    fx, fy;

           CMSREGISTER int        rx, ry;

           int                    x0, y0;

           CMSREGISTER int        X0, X1, Y0, Y1;

           int                    d00, d01, d10, d11,

                                  dx0, dx1,

                                  dxy;

    TotalOut   = p -> nOutputs;

    fx = _cmsToFixedDomain((int) Input[0] * p -> Domain[0]);

    x0  = FIXED_TO_INT(fx);

    rx  = FIXED_REST_TO_INT(fx);    // Rest in 0..1.0 domain

    fy = _cmsToFixedDomain((int) Input[1] * p -> Domain[1]);

    y0  = FIXED_TO_INT(fy);

    ry  = FIXED_REST_TO_INT(fy);

    X0 = p -> opta[1] * x0;

    X1 = X0 + (Input[0] == 0xFFFFU ? 0 : p->opta[1]);

    Y0 = p -> opta[0] * y0;

    Y1 = Y0 + (Input[1] == 0xFFFFU ? 0 : p->opta[0]);

    for (OutChan = 0; OutChan < TotalOut; OutChan++) {

        d00 = DENS(X0, Y0);

        d01 = DENS(X0, Y1);

        d10 = DENS(X1, Y0);

        d11 = DENS(X1, Y1);

        dx0 = LERP(rx, d00, d10);

        dx1 = LERP(rx, d01, d11);

        dxy = LERP(ry, dx0, dx1);

        Output[OutChan] = (cmsUInt16Number) dxy;

    }

#   undef LERP

#   undef DENS

}

// Trilinear interpolation (16 bits) - cmsFloat32Number version

static

void TrilinearInterpFloat(const cmsFloat32Number Input[],

                          cmsFloat32Number Output[],

                          const cmsInterpParams* p)

{

#   define LERP(a,l,h)      (cmsFloat32Number) ((l)+(((h)-(l))*(a)))

#   define DENS(i,j,k)      (LutTable[(i)+(j)+(k)+OutChan])

    const cmsFloat32Number* LutTable = (cmsFloat32Number*) p ->Table;

    cmsFloat32Number      px, py, pz;

    int        x0, y0, z0,

               X0, Y0, Z0, X1, Y1, Z1;

    int        TotalOut, OutChan;

    cmsFloat32Number      fx, fy, fz,

                          d000, d001, d010, d011,

                          d100, d101, d110, d111,

                          dx00, dx01, dx10, dx11,

                          dxy0, dxy1, dxyz;

    TotalOut   = p -> nOutputs;

    // We need some clipping here

    px = fclamp(Input[0]) * p->Domain[0];

    py = fclamp(Input[1]) * p->Domain[1];

    pz = fclamp(Input[2]) * p->Domain[2];

    x0 = (int) floor(px); fx = px - (cmsFloat32Number) x0;  // We need full floor functionality here

    y0 = (int) floor(py); fy = py - (cmsFloat32Number) y0;

    z0 = (int) floor(pz); fz = pz - (cmsFloat32Number) z0;

    X0 = p -> opta[2] * x0;

    X1 = X0 + (fclamp(Input[0]) >= 1.0 ? 0 : p->opta[2]);

    Y0 = p -> opta[1] * y0;

    Y1 = Y0 + (fclamp(Input[1]) >= 1.0 ? 0 : p->opta[1]);

    Z0 = p -> opta[0] * z0;

    Z1 = Z0 + (fclamp(Input[2]) >= 1.0 ? 0 : p->opta[0]);

    for (OutChan = 0; OutChan < TotalOut; OutChan++) {

        d000 = DENS(X0, Y0, Z0);

        d001 = DENS(X0, Y0, Z1);

        d010 = DENS(X0, Y1, Z0);

        d011 = DENS(X0, Y1, Z1);

        d100 = DENS(X1, Y0, Z0);

        d101 = DENS(X1, Y0, Z1);

        d110 = DENS(X1, Y1, Z0);

        d111 = DENS(X1, Y1, Z1);

        dx00 = LERP(fx, d000, d100);

        dx01 = LERP(fx, d001, d101);

        dx10 = LERP(fx, d010, d110);

        dx11 = LERP(fx, d011, d111);

        dxy0 = LERP(fy, dx00, dx10);

        dxy1 = LERP(fy, dx01, dx11);

        dxyz = LERP(fz, dxy0, dxy1);

        Output[OutChan] = dxyz;

    }

#   undef LERP

#   undef DENS

}

// Trilinear interpolation (16 bits) - optimized version

static CMS_NO_SANITIZE

void TrilinearInterp16(CMSREGISTER const cmsUInt16Number Input[],

                       CMSREGISTER cmsUInt16Number Output[],

                       CMSREGISTER const cmsInterpParams* p)

{

#define DENS(i,j,k) (LutTable[(i)+(j)+(k)+OutChan])

#define LERP(a,l,h)     (cmsUInt16Number) (l + ROUND_FIXED_TO_INT(((h-l)*a)))

           const cmsUInt16Number* LutTable = (cmsUInt16Number*) p ->Table;

           int        OutChan, TotalOut;

           cmsS15Fixed16Number    fx, fy, fz;

           CMSREGISTER int        rx, ry, rz;

           int                    x0, y0, z0;

           CMSREGISTER int        X0, X1, Y0, Y1, Z0, Z1;

           int                    d000, d001, d010, d011,

                                  d100, d101, d110, d111,

                                  dx00, dx01, dx10, dx11,

                                  dxy0, dxy1, dxyz;

    TotalOut   = p -> nOutputs;

    fx = _cmsToFixedDomain((int) Input[0] * p -> Domain[0]);

    x0  = FIXED_TO_INT(fx);

    rx  = FIXED_REST_TO_INT(fx);    // Rest in 0..1.0 domain

    fy = _cmsToFixedDomain((int) Input[1] * p -> Domain[1]);

    y0  = FIXED_TO_INT(fy);

    ry  = FIXED_REST_TO_INT(fy);

    fz = _cmsToFixedDomain((int) Input[2] * p -> Domain[2]);

    z0 = FIXED_TO_INT(fz);

    rz = FIXED_REST_TO_INT(fz);

    X0 = p -> opta[2] * x0;

    X1 = X0 + (Input[0] == 0xFFFFU ? 0 : p->opta[2]);

    Y0 = p -> opta[1] * y0;

    Y1 = Y0 + (Input[1] == 0xFFFFU ? 0 : p->opta[1]);

    Z0 = p -> opta[0] * z0;

    Z1 = Z0 + (Input[2] == 0xFFFFU ? 0 : p->opta[0]);

    for (OutChan = 0; OutChan < TotalOut; OutChan++) {

        d000 = DENS(X0, Y0, Z0);

        d001 = DENS(X0, Y0, Z1);

        d010 = DENS(X0, Y1, Z0);

        d011 = DENS(X0, Y1, Z1);

        d100 = DENS(X1, Y0, Z0);

        d101 = DENS(X1, Y0, Z1);

        d110 = DENS(X1, Y1, Z0);

        d111 = DENS(X1, Y1, Z1);

        dx00 = LERP(rx, d000, d100);

        dx01 = LERP(rx, d001, d101);

        dx10 = LERP(rx, d010, d110);

        dx11 = LERP(rx, d011, d111);

        dxy0 = LERP(ry, dx00, dx10);

        dxy1 = LERP(ry, dx01, dx11);

        dxyz = LERP(rz, dxy0, dxy1);

        Output[OutChan] = (cmsUInt16Number) dxyz;

    }

#   undef LERP

#   undef DENS

}

// Tetrahedral interpolation, using Sakamoto algorithm.

#define DENS(i,j,k) (LutTable[(i)+(j)+(k)+OutChan])

static

void TetrahedralInterpFloat(const cmsFloat32Number Input[],

                            cmsFloat32Number Output[],

                            const cmsInterpParams* p)

{

    const cmsFloat32Number* LutTable = (cmsFloat32Number*) p -> Table;

    cmsFloat32Number     px, py, pz;

    int                  x0, y0, z0,

                         X0, Y0, Z0, X1, Y1, Z1;

    cmsFloat32Number     rx, ry, rz;

    cmsFloat32Number     c0, c1=0, c2=0, c3=0;

    int                  OutChan, TotalOut;

    TotalOut   = p -> nOutputs;

    // We need some clipping here

    px = fclamp(Input[0]) * p->Domain[0];

    py = fclamp(Input[1]) * p->Domain[1];

    pz = fclamp(Input[2]) * p->Domain[2];

    x0 = (int) floor(px); rx = (px - (cmsFloat32Number) x0);  // We need full floor functionality here

    y0 = (int) floor(py); ry = (py - (cmsFloat32Number) y0);

    z0 = (int) floor(pz); rz = (pz - (cmsFloat32Number) z0);

    X0 = p -> opta[2] * x0;

    X1 = X0 + (fclamp(Input[0]) >= 1.0 ? 0 : p->opta[2]);

    Y0 = p -> opta[1] * y0;

    Y1 = Y0 + (fclamp(Input[1]) >= 1.0 ? 0 : p->opta[1]);

    Z0 = p -> opta[0] * z0;

    Z1 = Z0 + (fclamp(Input[2]) >= 1.0 ? 0 : p->opta[0]);

    for (OutChan=0; OutChan < TotalOut; OutChan++) {

       // These are the 6 Tetrahedral

        c0 = DENS(X0, Y0, Z0);

        if (rx >= ry && ry >= rz) {

            c1 = DENS(X1, Y0, Z0) - c0;

            c2 = DENS(X1, Y1, Z0) - DENS(X1, Y0, Z0);

            c3 = DENS(X1, Y1, Z1) - DENS(X1, Y1, Z0);

        }

        else

            if (rx >= rz && rz >= ry) {

                c1 = DENS(X1, Y0, Z0) - c0;

                c2 = DENS(X1, Y1, Z1) - DENS(X1, Y0, Z1);

                c3 = DENS(X1, Y0, Z1) - DENS(X1, Y0, Z0);

            }

            else

                if (rz >= rx && rx >= ry) {

                    c1 = DENS(X1, Y0, Z1) - DENS(X0, Y0, Z1);

                    c2 = DENS(X1, Y1, Z1) - DENS(X1, Y0, Z1);

                    c3 = DENS(X0, Y0, Z1) - c0;

                }

                else

                    if (ry >= rx && rx >= rz) {

                        c1 = DENS(X1, Y1, Z0) - DENS(X0, Y1, Z0);

                        c2 = DENS(X0, Y1, Z0) - c0;

                        c3 = DENS(X1, Y1, Z1) - DENS(X1, Y1, Z0);

                    }

                    else

                        if (ry >= rz && rz >= rx) {

                            c1 = DENS(X1, Y1, Z1) - DENS(X0, Y1, Z1);

                            c2 = DENS(X0, Y1, Z0) - c0;

                            c3 = DENS(X0, Y1, Z1) - DENS(X0, Y1, Z0);

                        }

                        else

                            if (rz >= ry && ry >= rx) {

                                c1 = DENS(X1, Y1, Z1) - DENS(X0, Y1, Z1);

                                c2 = DENS(X0, Y1, Z1) - DENS(X0, Y0, Z1);

                                c3 = DENS(X0, Y0, Z1) - c0;

                            }

                            else  {

                                c1 = c2 = c3 = 0;

                            }

       Output[OutChan] = c0 + c1 * rx + c2 * ry + c3 * rz;

       }

}

#undef DENS

static CMS_NO_SANITIZE

void TetrahedralInterp16(CMSREGISTER const cmsUInt16Number Input[],

                         CMSREGISTER cmsUInt16Number Output[],

                         CMSREGISTER const cmsInterpParams* p)

{

    const cmsUInt16Number* LutTable = (cmsUInt16Number*) p -> Table;

    cmsS15Fixed16Number fx, fy, fz;

    cmsS15Fixed16Number rx, ry, rz;

    int x0, y0, z0;

    cmsS15Fixed16Number c0, c1, c2, c3, Rest;

    cmsUInt32Number X0, X1, Y0, Y1, Z0, Z1;

    cmsUInt32Number TotalOut = p -> nOutputs;

    fx = _cmsToFixedDomain((int) Input[0] * p -> Domain[0]);

    fy = _cmsToFixedDomain((int) Input[1] * p -> Domain[1]);

    fz = _cmsToFixedDomain((int) Input[2] * p -> Domain[2]);

    x0 = FIXED_TO_INT(fx);

    y0 = FIXED_TO_INT(fy);

    z0 = FIXED_TO_INT(fz);

    rx = FIXED_REST_TO_INT(fx);

    ry = FIXED_REST_TO_INT(fy);

    rz = FIXED_REST_TO_INT(fz);

    X0 = p -> opta[2] * x0;

    X1 = (Input[0] == 0xFFFFU ? 0 : p->opta[2]);

    Y0 = p -> opta[1] * y0;

    Y1 = (Input[1] == 0xFFFFU ? 0 : p->opta[1]);

    Z0 = p -> opta[0] * z0;

    Z1 = (Input[2] == 0xFFFFU ? 0 : p->opta[0]);

    LutTable += X0+Y0+Z0;

    // Output should be computed as x = ROUND_FIXED_TO_INT(_cmsToFixedDomain(Rest))

    // which expands as: x = (Rest + ((Rest+0x7fff)/0xFFFF) + 0x8000)>>16

    // This can be replaced by: t = Rest+0x8001, x = (t + (t>>16))>>16

    // at the cost of being off by one at 7fff and 17ffe.

    if (rx >= ry) {

        if (ry >= rz) {

            Y1 += X1;

            Z1 += Y1;

            for (; TotalOut; TotalOut--) {

                c1 = LutTable[X1];

                c2 = LutTable[Y1];

                c3 = LutTable[Z1];

                c0 = *LutTable++;

                c3 -= c2;

                c2 -= c1;

                c1 -= c0;

                Rest = c1 * rx + c2 * ry + c3 * rz + 0x8001;

                *Output++ = (cmsUInt16Number) c0 + ((Rest + (Rest>>16))>>16);

            }

        } else if (rz >= rx) {

            X1 += Z1;

            Y1 += X1;

            for (; TotalOut; TotalOut--) {

                c1 = LutTable[X1];

                c2 = LutTable[Y1];

                c3 = LutTable[Z1];

                c0 = *LutTable++;

                c2 -= c1;

                c1 -= c3;

                c3 -= c0;

                Rest = c1 * rx + c2 * ry + c3 * rz + 0x8001;

                *Output++ = (cmsUInt16Number) c0 + ((Rest + (Rest>>16))>>16);

            }

        } else {

            Z1 += X1;

            Y1 += Z1;

            for (; TotalOut; TotalOut--) {

                c1 = LutTable[X1];

                c2 = LutTable[Y1];

                c3 = LutTable[Z1];

                c0 = *LutTable++;

                c2 -= c3;

                c3 -= c1;

                c1 -= c0;

                Rest = c1 * rx + c2 * ry + c3 * rz + 0x8001;

                *Output++ = (cmsUInt16Number) c0 + ((Rest + (Rest>>16))>>16);

            }

        }

    } else {

        if (rx >= rz) {

            X1 += Y1;

            Z1 += X1;

            for (; TotalOut; TotalOut--) {

                c1 = LutTable[X1];

                c2 = LutTable[Y1];

                c3 = LutTable[Z1];

                c0 = *LutTable++;

                c3 -= c1;

                c1 -= c2;

                c2 -= c0;

                Rest = c1 * rx + c2 * ry + c3 * rz + 0x8001;

                *Output++ = (cmsUInt16Number) c0 + ((Rest + (Rest>>16))>>16);

            }

        } else if (ry >= rz) {

            Z1 += Y1;

            X1 += Z1;

            for (; TotalOut; TotalOut--) {

                c1 = LutTable[X1];

                c2 = LutTable[Y1];

                c3 = LutTable[Z1];

                c0 = *LutTable++;

                c1 -= c3;

                c3 -= c2;

                c2 -= c0;

                Rest = c1 * rx + c2 * ry + c3 * rz + 0x8001;

                *Output++ = (cmsUInt16Number) c0 + ((Rest + (Rest>>16))>>16);

            }

        } else {

            Y1 += Z1;

            X1 += Y1;

            for (; TotalOut; TotalOut--) {

                c1 = LutTable[X1];

                c2 = LutTable[Y1];

                c3 = LutTable[Z1];

                c0 = *LutTable++;

                c1 -= c2;

                c2 -= c3;

                c3 -= c0;

                Rest = c1 * rx + c2 * ry + c3 * rz + 0x8001;

                *Output++ = (cmsUInt16Number) c0 + ((Rest + (Rest>>16))>>16);

            }

        }

    }

}

#define DENS(i,j,k) (LutTable[(i)+(j)+(k)+OutChan])

static CMS_NO_SANITIZE

void Eval4Inputs(CMSREGISTER const cmsUInt16Number Input[],

                     CMSREGISTER cmsUInt16Number Output[],

                     CMSREGISTER const cmsInterpParams* p16)

{

    const cmsUInt16Number* LutTable;

    cmsS15Fixed16Number fk;

    cmsS15Fixed16Number k0, rk;

    int K0, K1;

    cmsS15Fixed16Number    fx, fy, fz;

    cmsS15Fixed16Number    rx, ry, rz;

    int                    x0, y0, z0;

    cmsS15Fixed16Number    X0, X1, Y0, Y1, Z0, Z1;

    cmsUInt32Number i;

    cmsS15Fixed16Number    c0, c1, c2, c3, Rest;

    cmsUInt32Number        OutChan;

    cmsUInt16Number        Tmp1[MAX_STAGE_CHANNELS], Tmp2[MAX_STAGE_CHANNELS];

    fk  = _cmsToFixedDomain((int) Input[0] * p16 -> Domain[0]);

    fx  = _cmsToFixedDomain((int) Input[1] * p16 -> Domain[1]);

    fy  = _cmsToFixedDomain((int) Input[2] * p16 -> Domain[2]);

    fz  = _cmsToFixedDomain((int) Input[3] * p16 -> Domain[3]);

    k0  = FIXED_TO_INT(fk);

    x0  = FIXED_TO_INT(fx);

    y0  = FIXED_TO_INT(fy);

    z0  = FIXED_TO_INT(fz);

    rk  = FIXED_REST_TO_INT(fk);

    rx  = FIXED_REST_TO_INT(fx);

    ry  = FIXED_REST_TO_INT(fy);

    rz  = FIXED_REST_TO_INT(fz);

    K0 = p16 -> opta[3] * k0;

    K1 = K0 + (Input[0] == 0xFFFFU ? 0 : p16->opta[3]);

    X0 = p16 -> opta[2] * x0;

    X1 = X0 + (Input[1] == 0xFFFFU ? 0 : p16->opta[2]);

    Y0 = p16 -> opta[1] * y0;

    Y1 = Y0 + (Input[2] == 0xFFFFU ? 0 : p16->opta[1]);

    Z0 = p16 -> opta[0] * z0;

    Z1 = Z0 + (Input[3] == 0xFFFFU ? 0 : p16->opta[0]);

    LutTable = (cmsUInt16Number*) p16 -> Table;

    LutTable += K0;

    for (OutChan=0; OutChan < p16 -> nOutputs; OutChan++) {

        c0 = DENS(X0, Y0, Z0);

        if (rx >= ry && ry >= rz) {

            c1 = DENS(X1, Y0, Z0) - c0;

            c2 = DENS(X1, Y1, Z0) - DENS(X1, Y0, Z0);

            c3 = DENS(X1, Y1, Z1) - DENS(X1, Y1, Z0);

        }

        else

            if (rx >= rz && rz >= ry) {

                c1 = DENS(X1, Y0, Z0) - c0;

                c2 = DENS(X1, Y1, Z1) - DENS(X1, Y0, Z1);

                c3 = DENS(X1, Y0, Z1) - DENS(X1, Y0, Z0);

            }

            else

                if (rz >= rx && rx >= ry) {

                    c1 = DENS(X1, Y0, Z1) - DENS(X0, Y0, Z1);

                    c2 = DENS(X1, Y1, Z1) - DENS(X1, Y0, Z1);

                    c3 = DENS(X0, Y0, Z1) - c0;

                }

                else

                    if (ry >= rx && rx >= rz) {

                        c1 = DENS(X1, Y1, Z0) - DENS(X0, Y1, Z0);

                        c2 = DENS(X0, Y1, Z0) - c0;

                        c3 = DENS(X1, Y1, Z1) - DENS(X1, Y1, Z0);

                    }

                    else

                        if (ry >= rz && rz >= rx) {

                            c1 = DENS(X1, Y1, Z1) - DENS(X0, Y1, Z1);

                            c2 = DENS(X0, Y1, Z0) - c0;

                            c3 = DENS(X0, Y1, Z1) - DENS(X0, Y1, Z0);

                        }

                        else

                            if (rz >= ry && ry >= rx) {

                                c1 = DENS(X1, Y1, Z1) - DENS(X0, Y1, Z1);

                                c2 = DENS(X0, Y1, Z1) - DENS(X0, Y0, Z1);

                                c3 = DENS(X0, Y0, Z1) - c0;

                            }

                            else {

                                c1 = c2 = c3 = 0;

                            }

        Rest = c1 * rx + c2 * ry + c3 * rz;

        Tmp1[OutChan] = (cmsUInt16Number)(c0 + ROUND_FIXED_TO_INT(_cmsToFixedDomain(Rest)));

    }

    LutTable = (cmsUInt16Number*) p16 -> Table;

    LutTable += K1;

    for (OutChan=0; OutChan < p16 -> nOutputs; OutChan++) {

        c0 = DENS(X0, Y0, Z0);

        if (rx >= ry && ry >= rz) {

            c1 = DENS(X1, Y0, Z0) - c0;

            c2 = DENS(X1, Y1, Z0) - DENS(X1, Y0, Z0);

            c3 = DENS(X1, Y1, Z1) - DENS(X1, Y1, Z0);

        }