/*
* 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 5
/***************************************************************/
#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 /* IMG_TYPE == 3 */
/***************************************************************/
#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];
}
}
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);
val0 = (c0 * yf0 + c1 * yf1 + c2 * yf2 + c3 * yf3);
STORE(dPtr[0], val0);
}
}
return MLIB_SUCCESS;
}
/***************************************************************/
mlib_status FUN_NAME(4ch)(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(4);
dstLineEnd = (DTYPE *) dstData + 4 * xRight;
for (k = 0; k < 4; 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] + 4 * xSrc + k;
s0 = srcPixelPtr[0];
s1 = srcPixelPtr[4];
s2 = srcPixelPtr[8];
s3 = srcPixelPtr[12];
srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);
s4 = srcPixelPtr[0];
s5 = srcPixelPtr[4];
s6 = srcPixelPtr[8];
s7 = srcPixelPtr[12];
if (filter == MLIB_BICUBIC) {
for (; dPtr <= (dstLineEnd - 1); dPtr += 4) {
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[4] * xf1 +
srcPixelPtr[8] * xf2 + srcPixelPtr[12] * xf3);
srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);
c3 = (srcPixelPtr[0] * xf0 + srcPixelPtr[4] * xf1 +
srcPixelPtr[8] * xf2 + srcPixelPtr[12] * 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] + 4 * xSrc + k;
s0 = srcPixelPtr[0];
s1 = srcPixelPtr[4];
s2 = srcPixelPtr[8];
s3 = srcPixelPtr[12];
srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);
s4 = srcPixelPtr[0];
s5 = srcPixelPtr[4];
s6 = srcPixelPtr[8];
s7 = srcPixelPtr[12];
}
}
else {
for (; dPtr <= (dstLineEnd - 1); dPtr += 4) {
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[4] * xf1 +
srcPixelPtr[8] * xf2 + srcPixelPtr[12] * xf3);
srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);
c3 = (srcPixelPtr[0] * xf0 + srcPixelPtr[4] * xf1 +
srcPixelPtr[8] * xf2 + srcPixelPtr[12] * 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] + 4 * xSrc + k;
s0 = srcPixelPtr[0];
s1 = srcPixelPtr[4];
s2 = srcPixelPtr[8];
s3 = srcPixelPtr[12];
srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);
s4 = srcPixelPtr[0];
s5 = srcPixelPtr[4];
s6 = srcPixelPtr[8];
s7 = srcPixelPtr[12];
}
}
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[4] * xf1 +
srcPixelPtr[8] * xf2 + srcPixelPtr[12] * xf3);
srcPixelPtr = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);
c3 = (srcPixelPtr[0] * xf0 + srcPixelPtr[4] * xf1 +
srcPixelPtr[8] * xf2 + srcPixelPtr[12] * xf3);
val0 = (c0 * yf0 + c1 * yf1 + c2 * yf2 + c3 * yf3);
STORE(dPtr[0], val0);
}
}
return MLIB_SUCCESS;
}
/***************************************************************/