/*

 * Copyright (c) 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.

 */

/*

 * FUNCTION

 *      Image affine transformation with Bicubic filtering

 * SYNOPSIS

 *      mlib_status mlib_ImageAffine_[s32|f32|d64]_?ch_bc

 *                                  (mlib_s32 *leftEdges,

 *                                   mlib_s32 *rightEdges,

 *                                   mlib_s32 *xStarts,

 *                                   mlib_s32 *yStarts,

 *                                   mlib_s32 *sides,

 *                                   mlib_u8  *dstData,

 *                                   mlib_u8  **lineAddr,

 *                                   mlib_s32 dstYStride,

 *                                   mlib_s32 is_affine,

 *                                   mlib_s32 srcYStride,

 *                                   mlib_filter filter)

 *

 * ARGUMENTS

 *      leftEdges  array[dstHeight] of xLeft coordinates

 *      RightEdges array[dstHeight] of xRight coordinates

 *      xStarts    array[dstHeight] of xStart * 65536 coordinates

 *      yStarts    array[dstHeight] of yStart * 65536 coordinates

 *      sides      output array[4]. sides[0] is yStart, sides[1] is yFinish,

 *                 sides[2] is dx * 65536, sides[3] is dy * 65536

 *      dstData    pointer to the first pixel on (yStart - 1) line

 *      lineAddr   array[srcHeight] of pointers to the first pixel on

 *                 the corresponding lines

 *      dstYStride stride of destination image

 *      is_affine  indicator (Affine - GridWarp)

 *      srcYStride stride of source image

 *      filter     type of resampling filter

 *

 * DESCRIPTION

 *      The functions step along the lines from xLeft to xRight and apply

 *      the Bicubic and Bicubic2 filtering.

 *

 */

#include "mlib_ImageAffine.h"

#define IMG_TYPE  3

/***************************************************************/

#if IMG_TYPE == 3

#define DTYPE  mlib_s32

#define FTYPE  mlib_d64

#define FUN_NAME(CHAN) mlib_ImageAffine_s32_##CHAN##_bc

#define STORE(res, x) SAT32(res)

#elif IMG_TYPE == 4

#define DTYPE  mlib_f32

#define FTYPE  DTYPE

#define FUN_NAME(CHAN) mlib_ImageAffine_f32_##CHAN##_bc

#define STORE(res, x) res = (x)

#elif IMG_TYPE == 5

#define DTYPE  mlib_d64

#define FTYPE  DTYPE

#define FUN_NAME(CHAN) mlib_ImageAffine_d64_##CHAN##_bc

#define STORE(res, x) res = (x)

#endif

/***************************************************************/

#define CREATE_COEF_BICUBIC( X, Y, OPERATOR )                   \

  dx = (X & MLIB_MASK) * scale;                                 \

  dy = (Y & MLIB_MASK) * scale;                                 \

  dx_2  = ((FTYPE)0.5)  * dx;                                   \

  dy_2  = ((FTYPE)0.5)  * dy;                                   \

  dx2   = dx   * dx;    dy2   = dy   * dy;                      \

  dx3_2 = dx_2 * dx2;   dy3_2 = dy_2 * dy2;                     \

  dx3_3 = ((FTYPE)3.0)  * dx3_2;                                \

  dy3_3 = ((FTYPE)3.0)  * dy3_2;                                \

                                                                \

  xf0 = dx2 - dx3_2 - dx_2;                                     \

  xf1 = dx3_3 - ((FTYPE)2.5) * dx2 + ((FTYPE)1.0);              \

  xf2 = ((FTYPE)2.0) * dx2 - dx3_3 + dx_2;                      \

  xf3 = dx3_2 - ((FTYPE)0.5) * dx2;                             \

                                                                \

  OPERATOR;                                                     \

                                                                \

  yf0 = dy2 - dy3_2 - dy_2;                                     \

  yf1 = dy3_3 - ((FTYPE)2.5) * dy2 + ((FTYPE)1.0);              \

  yf2 = ((FTYPE)2.0) * dy2 - dy3_3 + dy_2;                      \

  yf3 = dy3_2 - ((FTYPE)0.5) * dy2

/***************************************************************/

#define CREATE_COEF_BICUBIC_2( X, Y, OPERATOR )                 \

  dx = (X & MLIB_MASK) * scale;                                 \

  dy = (Y & MLIB_MASK) * scale;                                 \

  dx2   = dx  * dx;    dy2   = dy  * dy;                        \

  dx3_2 = dx  * dx2;   dy3_2 = dy  * dy2;                       \

  dx3_3 = ((FTYPE)2.0) * dx2;                                   \

  dy3_3 = ((FTYPE)2.0) * dy2;                                   \

                                                                \

  xf0 = dx3_3 - dx3_2 - dx;                                     \

  xf1 = dx3_2 - dx3_3 + ((FTYPE)1.0);                           \

  xf2 = dx2   - dx3_2   + dx;                                   \

  xf3 = dx3_2 - dx2;                                            \

                                                                \

  OPERATOR;                                                     \

                                                                \

  yf0 = dy3_3 - dy3_2 - dy;                                     \

  yf1 = dy3_2 - dy3_3 + ((FTYPE)1.0);                           \

  yf2 = dy2   - dy3_2   + dy;                                   \

  yf3 = dy3_2 - dy2

/***************************************************************/

mlib_status FUN_NAME(1ch)(mlib_affine_param *param)

{

  DECLAREVAR_BC();

  DTYPE *dstLineEnd;

  for (j = yStart; j <= yFinish; j++) {

    FTYPE xf0, xf1, xf2, xf3;

    FTYPE yf0, yf1, yf2, yf3;

    FTYPE dx, dx_2, dx2, dx3_2, dx3_3;

    FTYPE dy, dy_2, dy2, dy3_2, dy3_3;

    FTYPE c0, c1, c2, c3, val0;

    FTYPE scale = 1 / 65536.f;

    FTYPE s0, s1, s2, s3;

    FTYPE s4, s5, s6, s7;

    CLIP(1);

    dstLineEnd = (DTYPE *) dstData + xRight;

    if (filter == MLIB_BICUBIC) {

      CREATE_COEF_BICUBIC(X, Y,;

        );

    }

    else {

      CREATE_COEF_BICUBIC_2(X, Y,;

        );

    }

    xSrc = (X >> MLIB_SHIFT) - 1;

    ySrc = (Y >> MLIB_SHIFT) - 1;

    srcPixelPtr = ((DTYPE **) lineAddr)[ySrc] + xSrc;

    s0 = srcPixelPtr[0];

    s1 = srcPixelPtr[1];

    s2 = srcPixelPtr[2];

    s3 = srcPixelPtr[3];

    srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

    s4 = srcPixelPtr[0];

    s5 = srcPixelPtr[1];

    s6 = srcPixelPtr[2];

    s7 = srcPixelPtr[3];

    if (filter == MLIB_BICUBIC) {

      for (; dstPixelPtr <= (dstLineEnd - 1); dstPixelPtr++) {

        X += dX;

        Y += dY;

        c0 = (s0 * xf0 + s1 * xf1 + s2 * xf2 + s3 * xf3);

        c1 = (s4 * xf0 + s5 * xf1 + s6 * xf2 + s7 * xf3);

        srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

        c2 = (srcPixelPtr[0] * xf0 + srcPixelPtr[1] * xf1 +

              srcPixelPtr[2] * xf2 + srcPixelPtr[3] * xf3);

        srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

        c3 = (srcPixelPtr[0] * xf0 + srcPixelPtr[1] * xf1 +

              srcPixelPtr[2] * xf2 + srcPixelPtr[3] * xf3);

        CREATE_COEF_BICUBIC(X, Y, val0 = (c0 * yf0 + c1 * yf1 + c2 * yf2 + c3 * yf3));

        STORE(dstPixelPtr[0], val0);

        xSrc = (X >> MLIB_SHIFT) - 1;

        ySrc = (Y >> MLIB_SHIFT) - 1;

        srcPixelPtr = ((DTYPE **) lineAddr)[ySrc] + xSrc;

        s0 = srcPixelPtr[0];

        s1 = srcPixelPtr[1];

        s2 = srcPixelPtr[2];

        s3 = srcPixelPtr[3];

        srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

        s4 = srcPixelPtr[0];

        s5 = srcPixelPtr[1];

        s6 = srcPixelPtr[2];

        s7 = srcPixelPtr[3];

      }

    }

    else {

      for (; dstPixelPtr <= (dstLineEnd - 1); dstPixelPtr++) {

        X += dX;

        Y += dY;

        c0 = (s0 * xf0 + s1 * xf1 + s2 * xf2 + s3 * xf3);

        c1 = (s4 * xf0 + s5 * xf1 + s6 * xf2 + s7 * xf3);

        srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

        c2 = (srcPixelPtr[0] * xf0 + srcPixelPtr[1] * xf1 +

              srcPixelPtr[2] * xf2 + srcPixelPtr[3] * xf3);

        srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

        c3 = (srcPixelPtr[0] * xf0 + srcPixelPtr[1] * xf1 +

              srcPixelPtr[2] * xf2 + srcPixelPtr[3] * xf3);

        CREATE_COEF_BICUBIC_2(X, Y, val0 = (c0 * yf0 + c1 * yf1 + c2 * yf2 + c3 * yf3));

        STORE(dstPixelPtr[0], val0);

        xSrc = (X >> MLIB_SHIFT) - 1;

        ySrc = (Y >> MLIB_SHIFT) - 1;

        srcPixelPtr = ((DTYPE **) lineAddr)[ySrc] + xSrc;

        s0 = srcPixelPtr[0];

        s1 = srcPixelPtr[1];

        s2 = srcPixelPtr[2];

        s3 = srcPixelPtr[3];

        srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

        s4 = srcPixelPtr[0];

        s5 = srcPixelPtr[1];

        s6 = srcPixelPtr[2];

        s7 = srcPixelPtr[3];

      }

    }

    c0 = (s0 * xf0 + s1 * xf1 + s2 * xf2 + s3 * xf3);

    c1 = (s4 * xf0 + s5 * xf1 + s6 * xf2 + s7 * xf3);

    srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

    c2 = (srcPixelPtr[0] * xf0 + srcPixelPtr[1] * xf1 +

          srcPixelPtr[2] * xf2 + srcPixelPtr[3] * xf3);

    srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

    c3 = (srcPixelPtr[0] * xf0 + srcPixelPtr[1] * xf1 +

          srcPixelPtr[2] * xf2 + srcPixelPtr[3] * xf3);

    val0 = (c0 * yf0 + c1 * yf1 + c2 * yf2 + c3 * yf3);

    STORE(dstPixelPtr[0], val0);

  }

  return MLIB_SUCCESS;

}

/***************************************************************/

mlib_status FUN_NAME(2ch)(mlib_affine_param *param)

{

  DECLAREVAR_BC();

  DTYPE *dstLineEnd;

  for (j = yStart; j <= yFinish; j++) {

    FTYPE xf0, xf1, xf2, xf3;

    FTYPE yf0, yf1, yf2, yf3;

    FTYPE dx, dx_2, dx2, dx3_2, dx3_3;

    FTYPE dy, dy_2, dy2, dy3_2, dy3_3;

    FTYPE c0, c1, c2, c3, val0;

    FTYPE scale = 1 / 65536.f;

    FTYPE s0, s1, s2, s3;

    FTYPE s4, s5, s6, s7;

    mlib_s32 k;

    CLIP(2);

    dstLineEnd = (DTYPE *) dstData + 2 * xRight;

    for (k = 0; k < 2; k++) {

      mlib_s32 X1 = X;

      mlib_s32 Y1 = Y;

      DTYPE *dPtr = dstPixelPtr + k;

      if (filter == MLIB_BICUBIC) {

        CREATE_COEF_BICUBIC(X1, Y1,;

          );

      }

      else {

        CREATE_COEF_BICUBIC_2(X1, Y1,;

          );

      }

      xSrc = (X1 >> MLIB_SHIFT) - 1;

      ySrc = (Y1 >> MLIB_SHIFT) - 1;

      srcPixelPtr = ((DTYPE **) lineAddr)[ySrc] + 2 * xSrc + k;

      s0 = srcPixelPtr[0];

      s1 = srcPixelPtr[2];

      s2 = srcPixelPtr[4];

      s3 = srcPixelPtr[6];

      srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

      s4 = srcPixelPtr[0];

      s5 = srcPixelPtr[2];

      s6 = srcPixelPtr[4];

      s7 = srcPixelPtr[6];

      if (filter == MLIB_BICUBIC) {

        for (; dPtr <= (dstLineEnd - 1); dPtr += 2) {

          X1 += dX;

          Y1 += dY;

          c0 = (s0 * xf0 + s1 * xf1 + s2 * xf2 + s3 * xf3);

          c1 = (s4 * xf0 + s5 * xf1 + s6 * xf2 + s7 * xf3);

          srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

          c2 = (srcPixelPtr[0] * xf0 + srcPixelPtr[2] * xf1 +

                srcPixelPtr[4] * xf2 + srcPixelPtr[6] * xf3);

          srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

          c3 = (srcPixelPtr[0] * xf0 + srcPixelPtr[2] * xf1 +

                srcPixelPtr[4] * xf2 + srcPixelPtr[6] * xf3);

          CREATE_COEF_BICUBIC(X1, Y1, val0 = (c0 * yf0 + c1 * yf1 + c2 * yf2 + c3 * yf3));

          STORE(dPtr[0], val0);

          xSrc = (X1 >> MLIB_SHIFT) - 1;

          ySrc = (Y1 >> MLIB_SHIFT) - 1;

          srcPixelPtr = ((DTYPE **) lineAddr)[ySrc] + 2 * xSrc + k;

          s0 = srcPixelPtr[0];

          s1 = srcPixelPtr[2];

          s2 = srcPixelPtr[4];

          s3 = srcPixelPtr[6];

          srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

          s4 = srcPixelPtr[0];

          s5 = srcPixelPtr[2];

          s6 = srcPixelPtr[4];

          s7 = srcPixelPtr[6];

        }

      }

      else {

        for (; dPtr <= (dstLineEnd - 1); dPtr += 2) {

          X1 += dX;

          Y1 += dY;

          c0 = (s0 * xf0 + s1 * xf1 + s2 * xf2 + s3 * xf3);

          c1 = (s4 * xf0 + s5 * xf1 + s6 * xf2 + s7 * xf3);

          srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

          c2 = (srcPixelPtr[0] * xf0 + srcPixelPtr[2] * xf1 +

                srcPixelPtr[4] * xf2 + srcPixelPtr[6] * xf3);

          srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

          c3 = (srcPixelPtr[0] * xf0 + srcPixelPtr[2] * xf1 +

                srcPixelPtr[4] * xf2 + srcPixelPtr[6] * xf3);

          CREATE_COEF_BICUBIC_2(X1, Y1, val0 =

                                (c0 * yf0 + c1 * yf1 + c2 * yf2 + c3 * yf3));

          STORE(dPtr[0], val0);

          xSrc = (X1 >> MLIB_SHIFT) - 1;

          ySrc = (Y1 >> MLIB_SHIFT) - 1;

          srcPixelPtr = ((DTYPE **) lineAddr)[ySrc] + 2 * xSrc + k;

          s0 = srcPixelPtr[0];

          s1 = srcPixelPtr[2];

          s2 = srcPixelPtr[4];

          s3 = srcPixelPtr[6];

          srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

          s4 = srcPixelPtr[0];

          s5 = srcPixelPtr[2];

          s6 = srcPixelPtr[4];

          s7 = srcPixelPtr[6];

        }

      }

      c0 = (s0 * xf0 + s1 * xf1 + s2 * xf2 + s3 * xf3);

      c1 = (s4 * xf0 + s5 * xf1 + s6 * xf2 + s7 * xf3);

      srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

      c2 = (srcPixelPtr[0] * xf0 + srcPixelPtr[2] * xf1 +

            srcPixelPtr[4] * xf2 + srcPixelPtr[6] * xf3);

      srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

      c3 = (srcPixelPtr[0] * xf0 + srcPixelPtr[2] * xf1 +

            srcPixelPtr[4] * xf2 + srcPixelPtr[6] * xf3);

      val0 = (c0 * yf0 + c1 * yf1 + c2 * yf2 + c3 * yf3);

      STORE(dPtr[0], val0);

    }

  }

  return MLIB_SUCCESS;

}

/***************************************************************/

mlib_status FUN_NAME(3ch)(mlib_affine_param *param)

{

  DECLAREVAR_BC();

  DTYPE *dstLineEnd;

  for (j = yStart; j <= yFinish; j++) {

    FTYPE xf0, xf1, xf2, xf3;

    FTYPE yf0, yf1, yf2, yf3;

    FTYPE dx, dx_2, dx2, dx3_2, dx3_3;

    FTYPE dy, dy_2, dy2, dy3_2, dy3_3;

    FTYPE c0, c1, c2, c3, val0;

    FTYPE scale = 1 / 65536.f;

    FTYPE s0, s1, s2, s3;

    FTYPE s4, s5, s6, s7;

    mlib_s32 k;

    CLIP(3);

    dstLineEnd = (DTYPE *) dstData + 3 * xRight;

    for (k = 0; k < 3; k++) {

      mlib_s32 X1 = X;

      mlib_s32 Y1 = Y;

      DTYPE *dPtr = dstPixelPtr + k;

      if (filter == MLIB_BICUBIC) {

        CREATE_COEF_BICUBIC(X1, Y1,;

          );

      }

      else {

        CREATE_COEF_BICUBIC_2(X1, Y1,;

          );

      }

      xSrc = (X1 >> MLIB_SHIFT) - 1;

      ySrc = (Y1 >> MLIB_SHIFT) - 1;

      srcPixelPtr = ((DTYPE **) lineAddr)[ySrc] + 3 * xSrc + k;

      s0 = srcPixelPtr[0];

      s1 = srcPixelPtr[3];

      s2 = srcPixelPtr[6];

      s3 = srcPixelPtr[9];

      srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

      s4 = srcPixelPtr[0];

      s5 = srcPixelPtr[3];

      s6 = srcPixelPtr[6];

      s7 = srcPixelPtr[9];

      if (filter == MLIB_BICUBIC) {

        for (; dPtr <= (dstLineEnd - 1); dPtr += 3) {

          X1 += dX;

          Y1 += dY;

          c0 = (s0 * xf0 + s1 * xf1 + s2 * xf2 + s3 * xf3);

          c1 = (s4 * xf0 + s5 * xf1 + s6 * xf2 + s7 * xf3);

          srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

          c2 = (srcPixelPtr[0] * xf0 + srcPixelPtr[3] * xf1 +

                srcPixelPtr[6] * xf2 + srcPixelPtr[9] * xf3);

          srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

          c3 = (srcPixelPtr[0] * xf0 + srcPixelPtr[3] * xf1 +

                srcPixelPtr[6] * xf2 + srcPixelPtr[9] * xf3);

          CREATE_COEF_BICUBIC(X1, Y1, val0 = (c0 * yf0 + c1 * yf1 + c2 * yf2 + c3 * yf3));

          STORE(dPtr[0], val0);

          xSrc = (X1 >> MLIB_SHIFT) - 1;

          ySrc = (Y1 >> MLIB_SHIFT) - 1;

          srcPixelPtr = ((DTYPE **) lineAddr)[ySrc] + 3 * xSrc + k;

          s0 = srcPixelPtr[0];

          s1 = srcPixelPtr[3];

          s2 = srcPixelPtr[6];

          s3 = srcPixelPtr[9];

          srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

          s4 = srcPixelPtr[0];

          s5 = srcPixelPtr[3];

          s6 = srcPixelPtr[6];

          s7 = srcPixelPtr[9];

        }

      }

      else {

        for (; dPtr <= (dstLineEnd - 1); dPtr += 3) {

          X1 += dX;

          Y1 += dY;

          c0 = (s0 * xf0 + s1 * xf1 + s2 * xf2 + s3 * xf3);

          c1 = (s4 * xf0 + s5 * xf1 + s6 * xf2 + s7 * xf3);

          srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

          c2 = (srcPixelPtr[0] * xf0 + srcPixelPtr[3] * xf1 +

                srcPixelPtr[6] * xf2 + srcPixelPtr[9] * xf3);

          srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

          c3 = (srcPixelPtr[0] * xf0 + srcPixelPtr[3] * xf1 +

                srcPixelPtr[6] * xf2 + srcPixelPtr[9] * xf3);

          CREATE_COEF_BICUBIC_2(X1, Y1, val0 =

                                (c0 * yf0 + c1 * yf1 + c2 * yf2 + c3 * yf3));

          STORE(dPtr[0], val0);

          xSrc = (X1 >> MLIB_SHIFT) - 1;

          ySrc = (Y1 >> MLIB_SHIFT) - 1;

          srcPixelPtr = ((DTYPE **) lineAddr)[ySrc] + 3 * xSrc + k;

          s0 = srcPixelPtr[0];

          s1 = srcPixelPtr[3];

          s2 = srcPixelPtr[6];

          s3 = srcPixelPtr[9];

          srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);

          s4 = srcPixelPtr[0];

          s5 = srcPixelPtr[3];

          s6 = srcPixelPtr[6];

          s7 = srcPixelPtr[9];

        }

      }