text: /*
   * Copyright (c) 1998, 2003, Oracle and/or its affiliates. All rights reserved.
   * DO NOT ALTER OR REMOVE COPYRIGHT NOTICES OR THIS FILE HEADER.
   *
   * This code is free software; you can redistribute it and/or modify it
   * under the terms of the GNU General Public License version 2 only, as
   * published by the Free Software Foundation.  Oracle designates this
   * particular file as subject to the "Classpath" exception as provided
   * by Oracle in the LICENSE file that accompanied this code.
   *
   * This code is distributed in the hope that it will be useful, but WITHOUT
   * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
   * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
   * version 2 for more details (a copy is included in the LICENSE file that
   * accompanied this code).
   *
   * You should have received a copy of the GNU General Public License version
   * 2 along with this work; if not, write to the Free Software Foundation,
   * Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA.
   *
   * Please contact Oracle, 500 Oracle Parkway, Redwood Shores, CA 94065 USA
   * or visit www.oracle.com if you need additional information or have any
   * questions.
   */
  
  
  #include "mlib_image.h"
  #include "mlib_ImageAffine.h"
  #include "mlib_ImageColormap.h"
  
  /***************************************************************/
  #define MLIB_LIMIT  512
  #define MLIB_SHIFT   16
  #define MLIB_PREC    (1 << MLIB_SHIFT)
  #define MLIB_MASK    (MLIB_PREC - 1)
  
  /***************************************************************/
  #define DTYPE  MLIB_TYPE
  
  /***************************************************************/
  #define DECLAREVAR_IND()                                        \
    DECLAREVAR0();                                                \
    mlib_s32  *warp_tbl   = param -> warp_tbl;                    \
    mlib_s32  xSrc, ySrc;                                         \
    mlib_s32  srcYStride = param -> srcYStride;                   \
    mlib_s32  max_xsize  = param -> max_xsize;                    \
    mlib_filter filter = param -> filter;                         \
    MLIB_TYPE *sp, *dl;                                           \
    mlib_d64  xf0, xf1, xf2, xf3;                                 \
    mlib_d64  yf0, yf1, yf2, yf3;                                 \
    mlib_d64  c0, c1, c2, c3, val0;                               \
    mlib_s32  filterpos;                                          \
    mlib_f32  *fptr;                                              \
    mlib_d64  s0, s1, s2, s3;                                     \
    mlib_s32  i, size
  
  /***************************************************************/
  #define GET_FILTERS_KOEF()                                         \
    filterpos = (X >> FILTER_SHIFT) & FILTER_MASK;                   \
    fptr = (mlib_f32 *) ((mlib_u8 *)mlib_filters_table + filterpos); \
                                                                     \
    xf0 = fptr[0];                                                   \
    xf1 = fptr[1];                                                   \
    xf2 = fptr[2];                                                   \
    xf3 = fptr[3];                                                   \
                                                                     \
    filterpos = (Y >> FILTER_SHIFT) & FILTER_MASK;                   \
    fptr = (mlib_f32 *) ((mlib_u8 *)mlib_filters_table + filterpos); \
                                                                     \
    yf0 = fptr[0];                                                   \
    yf1 = fptr[1];                                                   \
    yf2 = fptr[2];                                                   \
    yf3 = fptr[3]
  
  /***************************************************************/
  #define GET_POINTER()                                           \
    xSrc = (X >> MLIB_SHIFT)-1;                                   \
    ySrc = (Y >> MLIB_SHIFT)-1;                                   \
    sp = ((MLIB_TYPE **)lineAddr)[ySrc] + xSrc
  
  /***************************************************************/
  #define LOAD_FIRST_ROW(nchan, chan)                             \
    s0 = *(lut + sp[0]*nchan + chan);                             \
    s1 = *(lut + sp[1]*nchan + chan);                             \
    s2 = *(lut + sp[2]*nchan + chan);                             \
    s3 = *(lut + sp[3]*nchan + chan)
  
  /***************************************************************/
  #define COUNT_NEXT_ROW(dst, nchan, chan)                        \
    sp = (MLIB_TYPE*)((mlib_addr)sp + srcYStride);                \
    dst = ((*(lut + sp[0]*nchan + chan))*xf0 +                    \
           (*(lut + sp[1]*nchan + chan))*xf1 +                    \
           (*(lut + sp[2]*nchan + chan))*xf2 +                    \
           (*(lut + sp[3]*nchan + chan))*xf3)
  
  /***************************************************************/
  #ifdef MLIB_USE_FTOI_CLAMPING
  
  /***********/
  #define STORE_SAT_VALUE_U8(ind)                                 \
    dp[ind] = ((mlib_s32)(val0 - (mlib_d64)0x7F800000) >> 24) ^ 0x80
  
  /***********/
  #define STORE_SAT_VALUE_S16(ind)                                \
    dp[ind] = ((mlib_s32)(val0)) >> 16
  
  #else
  
  /***********/
  #define STORE_SAT_VALUE_U8(ind)                                 \
    val0 -= (mlib_d64)0x7F800000;                                 \
    if (val0 >= MLIB_S32_MAX)                                     \
      dp[ind] = MLIB_U8_MAX;                                      \
    else if (val0 <= MLIB_S32_MIN)                                \
      dp[ind] = MLIB_U8_MIN;                                      \
    else                                                          \
      dp[ind] = ((mlib_s32)val0 >> 24) ^ 0x80
  
  /***********/
  #define STORE_SAT_VALUE_S16(ind)                                \
    if (val0 >= MLIB_S32_MAX)                                     \
      dp[ind] = MLIB_S16_MAX;                                     \
    else if (val0 <= MLIB_S32_MIN)                                \
      dp[ind] = MLIB_S16_MIN;                                     \
    else                                                          \
      dp[ind] = (mlib_s32)val0 >> 16
  
  #endif /* MLIB_USE_FTOI_CLAMPING */
  
  /***************************************************************/
  #define MAKE_BC_3CH(lut_format)                                 \
    X += dX;                                                      \
    Y += dY;                                                      \
    c0 = (s0*xf0 + s1*xf1 + s2*xf2 + s3*xf3);                     \
    COUNT_NEXT_ROW(c1, 3, 0);                                     \
    COUNT_NEXT_ROW(c2, 3, 0);                                     \
    COUNT_NEXT_ROW(c3, 3, 0);                                     \
    val0 = (c0*yf0 + c1*yf1 + c2*yf2 + c3*yf3);                   \
    sp = (MLIB_TYPE*)((mlib_addr)sp - 3*srcYStride);              \
    LOAD_FIRST_ROW(3, 1);                                         \
    STORE_SAT_VALUE_##lut_format(0);                              \
    c0 = (s0*xf0 + s1*xf1 + s2*xf2 + s3*xf3);                     \
    COUNT_NEXT_ROW(c1, 3, 1);                                     \
    COUNT_NEXT_ROW(c2, 3, 1);                                     \
    COUNT_NEXT_ROW(c3, 3, 1);                                     \
    val0 = (c0*yf0 + c1*yf1 + c2*yf2 + c3*yf3);                   \
    sp = (MLIB_TYPE*)((mlib_addr)sp - 3*srcYStride);              \
    LOAD_FIRST_ROW(3, 2);                                         \
    STORE_SAT_VALUE_##lut_format(1);                              \
    c0 = (s0*xf0 + s1*xf1 + s2*xf2 + s3*xf3);                     \
    COUNT_NEXT_ROW(c1, 3, 2);                                     \
    COUNT_NEXT_ROW(c2, 3, 2);                                     \
    COUNT_NEXT_ROW(c3, 3, 2);                                     \
    val0 = (c0*yf0 + c1*yf1 + c2*yf2 + c3*yf3);                   \
    GET_FILTERS_KOEF();                                           \
    GET_POINTER();                                                \
    LOAD_FIRST_ROW(3, 0);                                         \
    STORE_SAT_VALUE_##lut_format(2);
  
  /***************************************************************/
  #define MAKE_LAST_PIXEL_BC_3CH(lut_format)                      \
    c0 = (s0*xf0 + s1*xf1 + s2*xf2 + s3*xf3);                     \
    COUNT_NEXT_ROW(c1, 3, 0);                                     \
    COUNT_NEXT_ROW(c2, 3, 0);                                     \
    COUNT_NEXT_ROW(c3, 3, 0);                                     \
    val0 = (c0*yf0 + c1*yf1 + c2*yf2 + c3*yf3);                   \
    sp = (MLIB_TYPE*)((mlib_addr)sp - 3*srcYStride);              \
    LOAD_FIRST_ROW(3, 1);                                         \
    STORE_SAT_VALUE_##lut_format(0);                              \
    c0 = (s0*xf0 + s1*xf1 + s2*xf2 + s3*xf3);                     \
    COUNT_NEXT_ROW(c1, 3, 1);                                     \
    COUNT_NEXT_ROW(c2, 3, 1);                                     \
    COUNT_NEXT_ROW(c3, 3, 1);                                     \
    val0 = (c0*yf0 + c1*yf1 + c2*yf2 + c3*yf3);                   \
    sp = (MLIB_TYPE*)((mlib_addr)sp - 3*srcYStride);              \
    LOAD_FIRST_ROW(3, 2);                                         \
    STORE_SAT_VALUE_##lut_format(1);                              \
    c0 = (s0*xf0 + s1*xf1 + s2*xf2 + s3*xf3);                     \
    COUNT_NEXT_ROW(c1, 3, 2);                                     \
    COUNT_NEXT_ROW(c2, 3, 2);                                     \
    COUNT_NEXT_ROW(c3, 3, 2);                                     \
    val0 = (c0*yf0 + c1*yf1 + c2*yf2 + c3*yf3);                   \
    STORE_SAT_VALUE_##lut_format(2);
  
  /***************************************************************/
  #define MAKE_BC_4CH(lut_format)                                 \
    X += dX;                                                      \
    Y += dY;                                                      \
    c0 = (s0*xf0 + s1*xf1 + s2*xf2 + s3*xf3);                     \
    COUNT_NEXT_ROW(c1, 4, 0);                                     \
    COUNT_NEXT_ROW(c2, 4, 0);                                     \
    COUNT_NEXT_ROW(c3, 4, 0);                                     \
    val0 = (c0*yf0 + c1*yf1 + c2*yf2 + c3*yf3);                   \
    sp = (MLIB_TYPE*)((mlib_addr)sp - 3*srcYStride);              \
    LOAD_FIRST_ROW(4, 1);                                         \
    STORE_SAT_VALUE_##lut_format(0);                              \
    c0 = (s0*xf0 + s1*xf1 + s2*xf2 + s3*xf3);                     \
    COUNT_NEXT_ROW(c1, 4, 1);                                     \
    COUNT_NEXT_ROW(c2, 4, 1);                                     \
    COUNT_NEXT_ROW(c3, 4, 1);                                     \
    val0 = (c0*yf0 + c1*yf1 + c2*yf2 + c3*yf3);                   \
    sp = (MLIB_TYPE*)((mlib_addr)sp - 3*srcYStride);              \
    LOAD_FIRST_ROW(4, 2);                                         \
    STORE_SAT_VALUE_##lut_format(1);                              \
    c0 = (s0*xf0 + s1*xf1 + s2*xf2 + s3*xf3);                     \
    COUNT_NEXT_ROW(c1, 4, 2);                                     \
    COUNT_NEXT_ROW(c2, 4, 2);                                     \
    COUNT_NEXT_ROW(c3, 4, 2);                                     \
    val0 = (c0*yf0 + c1*yf1 + c2*yf2 + c3*yf3);                   \
    sp = (MLIB_TYPE*)((mlib_addr)sp - 3*srcYStride);              \
    LOAD_FIRST_ROW(4, 3);                                         \
    STORE_SAT_VALUE_##lut_format(2);                              \
    c0 = (s0*xf0 + s1*xf1 + s2*xf2 + s3*xf3);                     \
    COUNT_NEXT_ROW(c1, 4, 3);                                     \
    COUNT_NEXT_ROW(c2, 4, 3);                                     \
    COUNT_NEXT_ROW(c3, 4, 3);                                     \
    val0 = (c0*yf0 + c1*yf1 + c2*yf2 + c3*yf3);                   \
    GET_FILTERS_KOEF();                                           \
    GET_POINTER();                                                \
    LOAD_FIRST_ROW(4, 0);                                         \
    STORE_SAT_VALUE_##lut_format(3);
  
  /***************************************************************/
  #define MAKE_LAST_PIXEL_BC_4CH(lut_format)                      \
    c0 = (s0*xf0 + s1*xf1 + s2*xf2 + s3*xf3);                     \
    COUNT_NEXT_ROW(c1, 4, 0);                                     \
    COUNT_NEXT_ROW(c2, 4, 0);                                     \
    COUNT_NEXT_ROW(c3, 4, 0);                                     \
    val0 = (c0*yf0 + c1*yf1 + c2*yf2 + c3*yf3);                   \
    sp = (MLIB_TYPE*)((mlib_addr)sp - 3*srcYStride);              \
    LOAD_FIRST_ROW(4, 1);                                         \
    STORE_SAT_VALUE_##lut_format(0);                              \
    c0 = (s0*xf0 + s1*xf1 + s2*xf2 + s3*xf3);                     \
    COUNT_NEXT_ROW(c1, 4, 1);                                     \
    COUNT_NEXT_ROW(c2, 4, 1);                                     \
    COUNT_NEXT_ROW(c3, 4, 1);                                     \
    val0 = (c0*yf0 + c1*yf1 + c2*yf2 + c3*yf3);                   \
    sp = (MLIB_TYPE*)((mlib_addr)sp - 3*srcYStride);              \
    LOAD_FIRST_ROW(4, 2);                                         \
    STORE_SAT_VALUE_##lut_format(1);                              \
    c0 = (s0*xf0 + s1*xf1 + s2*xf2 + s3*xf3);                     \
    COUNT_NEXT_ROW(c1, 4, 2);                                     \
    COUNT_NEXT_ROW(c2, 4, 2);                                     \
    COUNT_NEXT_ROW(c3, 4, 2);                                     \
    val0 = (c0*yf0 + c1*yf1 + c2*yf2 + c3*yf3);                   \
    sp = (MLIB_TYPE*)((mlib_addr)sp - 3*srcYStride);              \
    LOAD_FIRST_ROW(4, 3);                                         \
    STORE_SAT_VALUE_##lut_format(2);                              \
    c0 = (s0*xf0 + s1*xf1 + s2*xf2 + s3*xf3);                     \
    COUNT_NEXT_ROW(c1, 4, 3);                                     \
    COUNT_NEXT_ROW(c2, 4, 3);                                     \
    COUNT_NEXT_ROW(c3, 4, 3);                                     \
    val0 = (c0*yf0 + c1*yf1 + c2*yf2 + c3*yf3);                   \
    STORE_SAT_VALUE_##lut_format(3);
  
  /***************************************************************/
  #define FILTER_U8  ((filter == MLIB_BICUBIC) ? mlib_filters_u8f_bc  : mlib_filters_u8f_bc2)
  #define FILTER_S16 ((filter == MLIB_BICUBIC) ? mlib_filters_s16f_bc : mlib_filters_s16f_bc2)
  
  /***************************************************************/
  #define mlib_U8  mlib_u8
  #define mlib_S16 mlib_s16
  
  /***************************************************************/
  #define FUNC_AFFINEINDEX_BC_0(ITYPE, LTYPE, NCHAN)                                                  \
    mlib_status mlib_ImageAffineIndex_##ITYPE##_##LTYPE##_##NCHAN##CH_BC(mlib_affine_param *param,    \
                                                                         const void        *colormap) \
    {                                                                                                 \
      DECLAREVAR_IND();                                                                               \
      mlib_##LTYPE buff_lcl[NCHAN * MLIB_LIMIT], *pbuff = buff_lcl, *dp;                              \
      mlib_d64  *lut = ((mlib_d64*)mlib_ImageGetLutDoubleData(colormap) -                             \
                        NCHAN * mlib_ImageGetLutOffset(colormap));                                    \
      const mlib_f32 *mlib_filters_table = FILTER_##LTYPE;                                            \
                                                                                                      \
      if (max_xsize > MLIB_LIMIT) {                                                                   \
        pbuff = mlib_malloc(NCHAN * sizeof(mlib_##LTYPE) * max_xsize);                                \
        if (pbuff == NULL) return MLIB_FAILURE;                                                       \
      }                                                                                               \
                                                                                                      \
      for (j = yStart; j <= yFinish; j++) {                                                           \
                                                                                                      \
        NEW_LINE(1);                                                                                  \
        dp = pbuff;                                                                                   \
                                                                                                      \
        GET_FILTERS_KOEF();                                                                           \
        GET_POINTER();                                                                                \
        LOAD_FIRST_ROW(NCHAN, 0);
  
      /* pragma pipeloop(0) must be here */
  
  /***************************************************************/
  #define FUNC_AFFINEINDEX_BC_1(ITYPE, LTYPE, NCHAN)                         \
                                                                             \
        for (i = 0; i < (xRight - xLeft); i++, dp += NCHAN) {                \
          MAKE_BC_##NCHAN##CH(LTYPE);                                        \
        }                                                                    \
                                                                             \
        MAKE_LAST_PIXEL_BC_##NCHAN##CH(LTYPE);                               \
                                                                             \
        mlib_ImageColorTrue2IndexLine_##LTYPE##_##ITYPE##_##NCHAN            \
                                  (pbuff, dl, xRight - xLeft + 1, colormap); \
      }                                                                      \
                                                                             \
      if (pbuff != buff_lcl) mlib_free(pbuff);                               \
                                                                             \
      return MLIB_SUCCESS;                                                   \
    }
  
  /***************************************************************/
  #undef MLIB_TYPE
  #define MLIB_TYPE mlib_u8
  
  /***************************************************************/
  #undef  FILTER_SHIFT
  #define FILTER_SHIFT 4
  #undef  FILTER_MASK
  #define FILTER_MASK  (((1 << 8) - 1) << 4)
  
  FUNC_AFFINEINDEX_BC_0(U8, U8, 3)
  #ifdef __SUNPRO_C
  #pragma pipeloop(0)
  #endif /* __SUNPRO_C */
  FUNC_AFFINEINDEX_BC_1(U8, U8, 3)
  
  /***************************************************************/
  #undef  FILTER_SHIFT
  #define FILTER_SHIFT 3
  #undef  FILTER_MASK
  #define FILTER_MASK  (((1 << 9) - 1) << 4)
  
  FUNC_AFFINEINDEX_BC_0(U8, S16, 3)
  #ifdef __SUNPRO_C
  #pragma pipeloop(0)
  #endif /* __SUNPRO_C */
  FUNC_AFFINEINDEX_BC_1(U8, S16, 3)
  
  /***************************************************************/
  #undef  FILTER_SHIFT
  #define FILTER_SHIFT 4
  #undef  FILTER_MASK
  #define FILTER_MASK  (((1 << 8) - 1) << 4)
  
  FUNC_AFFINEINDEX_BC_0(U8, U8, 4)
  #ifdef __SUNPRO_C
  #pragma pipeloop(0)
  #endif /* __SUNPRO_C */
  FUNC_AFFINEINDEX_BC_1(U8, U8, 4)
  
  /***************************************************************/
  #undef  FILTER_SHIFT
  #define FILTER_SHIFT 3
  #undef  FILTER_MASK
  #define FILTER_MASK  (((1 << 9) - 1) << 4)
  
  FUNC_AFFINEINDEX_BC_0(U8, S16, 4)
  #ifdef __SUNPRO_C
  #pragma pipeloop(0)
  #endif /* __SUNPRO_C */
  FUNC_AFFINEINDEX_BC_1(U8, S16, 4)
  
  /***************************************************************/
  #undef  MLIB_TYPE
  #define MLIB_TYPE mlib_s16
  
  /***************************************************************/
  #undef  FILTER_SHIFT
  #define FILTER_SHIFT 4
  #undef  FILTER_MASK
  #define FILTER_MASK  (((1 << 8) - 1) << 4)
  
  FUNC_AFFINEINDEX_BC_0(S16, U8, 3)
  #ifdef __SUNPRO_C
  #pragma pipeloop(0)
  #endif /* __SUNPRO_C */
  FUNC_AFFINEINDEX_BC_1(S16, U8, 3)
  
  /***************************************************************/
  #undef  FILTER_SHIFT
  #define FILTER_SHIFT 3
  #undef  FILTER_MASK
  #define FILTER_MASK  (((1 << 9) - 1) << 4)
  
  FUNC_AFFINEINDEX_BC_0(S16, S16, 3)
  #ifdef __SUNPRO_C
  #pragma pipeloop(0)
  #endif /* __SUNPRO_C */
  FUNC_AFFINEINDEX_BC_1(S16, S16, 3)
  
  /***************************************************************/
  #undef  FILTER_SHIFT
  #define FILTER_SHIFT 4
  #undef  FILTER_MASK
  #define FILTER_MASK  (((1 << 8) - 1) << 4)
  
  FUNC_AFFINEINDEX_BC_0(S16, U8, 4)
  #ifdef __SUNPRO_C
  #pragma pipeloop(0)
  #endif /* __SUNPRO_C */
  FUNC_AFFINEINDEX_BC_1(S16, U8, 4)
  
  /***************************************************************/
  #undef  FILTER_SHIFT
  #define FILTER_SHIFT 3
  #undef  FILTER_MASK
  #define FILTER_MASK  (((1 << 9) - 1) << 4)
  
  FUNC_AFFINEINDEX_BC_0(S16, S16, 4)
  #ifdef __SUNPRO_C
  #pragma pipeloop(0)
  #endif /* __SUNPRO_C */
  FUNC_AFFINEINDEX_BC_1(S16, S16, 4)
  
  /***************************************************************/
  