0N/A/*
2362N/A * Copyright (c) 2003, Oracle and/or its affiliates. All rights reserved.
0N/A * DO NOT ALTER OR REMOVE COPYRIGHT NOTICES OR THIS FILE HEADER.
0N/A *
0N/A * This code is free software; you can redistribute it and/or modify it
0N/A * under the terms of the GNU General Public License version 2 only, as
2362N/A * published by the Free Software Foundation. Oracle designates this
0N/A * particular file as subject to the "Classpath" exception as provided
2362N/A * by Oracle in the LICENSE file that accompanied this code.
0N/A *
0N/A * This code is distributed in the hope that it will be useful, but WITHOUT
0N/A * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
0N/A * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
0N/A * version 2 for more details (a copy is included in the LICENSE file that
0N/A * accompanied this code).
0N/A *
0N/A * You should have received a copy of the GNU General Public License version
0N/A * 2 along with this work; if not, write to the Free Software Foundation,
0N/A * Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA.
0N/A *
2362N/A * Please contact Oracle, 500 Oracle Parkway, Redwood Shores, CA 94065 USA
2362N/A * or visit www.oracle.com if you need additional information or have any
2362N/A * questions.
0N/A */
0N/A
0N/A
0N/A/*
0N/A * FUNCTION
0N/A * Internal functions for mlib_ImageAffine with bilinear filtering.
0N/A */
0N/A
0N/A#include "mlib_ImageAffine.h"
0N/A
0N/A/***************************************************************/
0N/A#define DTYPE mlib_d64
0N/A#define FTYPE DTYPE
0N/A
0N/A#define FUN_NAME(CHAN) mlib_ImageAffine_d64_##CHAN##_bl
0N/A
0N/A/***************************************************************/
0N/Amlib_status FUN_NAME(1ch)(mlib_affine_param *param)
0N/A{
0N/A DECLAREVAR_BL();
0N/A DTYPE *dstLineEnd;
0N/A FTYPE scale = ONE / MLIB_PREC;
0N/A mlib_s32 srcYStride1;
0N/A
0N/A srcYStride /= sizeof(DTYPE);
0N/A srcYStride1 = srcYStride + 1;
0N/A
0N/A for (j = yStart; j <= yFinish; j++) {
0N/A FTYPE t, u, k0, k1, k2, k3;
0N/A FTYPE a00_0, a01_0, a10_0, a11_0;
0N/A FTYPE pix0;
0N/A
0N/A CLIP(1);
0N/A dstLineEnd = (DTYPE *) dstData + xRight;
0N/A
0N/A t = (X & MLIB_MASK) * scale;
0N/A u = (Y & MLIB_MASK) * scale;
0N/A ySrc = MLIB_POINTER_SHIFT(Y);
0N/A Y += dY;
0N/A xSrc = X >> MLIB_SHIFT;
0N/A X += dX;
0N/A srcPixelPtr = MLIB_POINTER_GET(lineAddr, ySrc) + xSrc;
0N/A k3 = t * u;
0N/A k2 = (ONE - t) * u;
0N/A k1 = t * (ONE - u);
0N/A k0 = (ONE - t) * (ONE - u);
0N/A a00_0 = srcPixelPtr[0];
0N/A a01_0 = srcPixelPtr[1];
0N/A a10_0 = srcPixelPtr[srcYStride];
0N/A a11_0 = srcPixelPtr[srcYStride1];
0N/A
0N/A for (; dstPixelPtr < dstLineEnd; dstPixelPtr++) {
0N/A pix0 = k0 * a00_0 + k1 * a01_0 + k2 * a10_0 + k3 * a11_0;
0N/A t = (X & MLIB_MASK) * scale;
0N/A u = (Y & MLIB_MASK) * scale;
0N/A ySrc = MLIB_POINTER_SHIFT(Y);
0N/A Y += dY;
0N/A xSrc = X >> MLIB_SHIFT;
0N/A X += dX;
0N/A srcPixelPtr = *(DTYPE **) ((mlib_u8 *) lineAddr + ySrc) + xSrc;
0N/A k3 = t * u;
0N/A k2 = (ONE - t) * u;
0N/A k1 = t * (ONE - u);
0N/A k0 = (ONE - t) * (ONE - u);
0N/A a00_0 = srcPixelPtr[0];
0N/A a01_0 = srcPixelPtr[1];
0N/A a10_0 = srcPixelPtr[srcYStride];
0N/A a11_0 = srcPixelPtr[srcYStride1];
0N/A dstPixelPtr[0] = pix0;
0N/A }
0N/A
0N/A pix0 = k0 * a00_0 + k1 * a01_0 + k2 * a10_0 + k3 * a11_0;
0N/A dstPixelPtr[0] = pix0;
0N/A }
0N/A
0N/A return MLIB_SUCCESS;
0N/A}
0N/A
0N/A/***************************************************************/
0N/Amlib_status FUN_NAME(2ch)(mlib_affine_param *param)
0N/A{
0N/A DECLAREVAR_BL();
0N/A DTYPE *dstLineEnd;
0N/A FTYPE scale = ONE / MLIB_PREC;
0N/A
0N/A for (j = yStart; j <= yFinish; j++) {
0N/A DTYPE *srcPixelPtr2;
0N/A FTYPE t, u, k0, k1, k2, k3;
0N/A FTYPE a00_0, a01_0, a10_0, a11_0;
0N/A FTYPE a00_1, a01_1, a10_1, a11_1;
0N/A FTYPE pix0, pix1;
0N/A
0N/A CLIP(2);
0N/A dstLineEnd = (DTYPE *) dstData + 2 * xRight;
0N/A
0N/A t = (X & MLIB_MASK) * scale;
0N/A u = (Y & MLIB_MASK) * scale;
0N/A ySrc = MLIB_POINTER_SHIFT(Y);
0N/A Y += dY;
0N/A xSrc = X >> MLIB_SHIFT;
0N/A X += dX;
0N/A srcPixelPtr = MLIB_POINTER_GET(lineAddr, ySrc) + 2 * xSrc;
0N/A srcPixelPtr2 = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);
0N/A k3 = t * u;
0N/A k2 = (ONE - t) * u;
0N/A k1 = t * (ONE - u);
0N/A k0 = (ONE - t) * (ONE - u);
0N/A a00_0 = srcPixelPtr[0];
0N/A a00_1 = srcPixelPtr[1];
0N/A a01_0 = srcPixelPtr[2];
0N/A a01_1 = srcPixelPtr[3];
0N/A a10_0 = srcPixelPtr2[0];
0N/A a10_1 = srcPixelPtr2[1];
0N/A a11_0 = srcPixelPtr2[2];
0N/A a11_1 = srcPixelPtr2[3];
0N/A
0N/A for (; dstPixelPtr < dstLineEnd; dstPixelPtr += 2) {
0N/A pix0 = k0 * a00_0 + k1 * a01_0 + k2 * a10_0 + k3 * a11_0;
0N/A pix1 = k0 * a00_1 + k1 * a01_1 + k2 * a10_1 + k3 * a11_1;
0N/A t = (X & MLIB_MASK) * scale;
0N/A u = (Y & MLIB_MASK) * scale;
0N/A ySrc = MLIB_POINTER_SHIFT(Y);
0N/A Y += dY;
0N/A xSrc = X >> MLIB_SHIFT;
0N/A X += dX;
0N/A srcPixelPtr = MLIB_POINTER_GET(lineAddr, ySrc) + 2 * xSrc;
0N/A srcPixelPtr2 = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);
0N/A k3 = t * u;
0N/A k2 = (ONE - t) * u;
0N/A k1 = t * (ONE - u);
0N/A k0 = (ONE - t) * (ONE - u);
0N/A a01_0 = srcPixelPtr[2];
0N/A a01_1 = srcPixelPtr[3];
0N/A a00_0 = srcPixelPtr[0];
0N/A a00_1 = srcPixelPtr[1];
0N/A a10_0 = srcPixelPtr2[0];
0N/A a10_1 = srcPixelPtr2[1];
0N/A a11_0 = srcPixelPtr2[2];
0N/A a11_1 = srcPixelPtr2[3];
0N/A dstPixelPtr[0] = pix0;
0N/A dstPixelPtr[1] = pix1;
0N/A }
0N/A
0N/A pix0 = k0 * a00_0 + k1 * a01_0 + k2 * a10_0 + k3 * a11_0;
0N/A pix1 = k0 * a00_1 + k1 * a01_1 + k2 * a10_1 + k3 * a11_1;
0N/A dstPixelPtr[0] = pix0;
0N/A dstPixelPtr[1] = pix1;
0N/A }
0N/A
0N/A return MLIB_SUCCESS;
0N/A}
0N/A
0N/A/***************************************************************/
0N/Amlib_status FUN_NAME(3ch)(mlib_affine_param *param)
0N/A{
0N/A DECLAREVAR_BL();
0N/A DTYPE *dstLineEnd;
0N/A FTYPE scale = ONE / MLIB_PREC;
0N/A
0N/A for (j = yStart; j <= yFinish; j++) {
0N/A DTYPE *srcPixelPtr2;
0N/A FTYPE t, u, k0, k1, k2, k3;
0N/A FTYPE a00_0, a01_0, a10_0, a11_0;
0N/A FTYPE a00_1, a01_1, a10_1, a11_1;
0N/A FTYPE a00_2, a01_2, a10_2, a11_2;
0N/A FTYPE pix0, pix1, pix2;
0N/A
0N/A CLIP(3);
0N/A dstLineEnd = (DTYPE *) dstData + 3 * xRight;
0N/A
0N/A t = (X & MLIB_MASK) * scale;
0N/A u = (Y & MLIB_MASK) * scale;
0N/A ySrc = MLIB_POINTER_SHIFT(Y);
0N/A Y += dY;
0N/A xSrc = X >> MLIB_SHIFT;
0N/A X += dX;
0N/A srcPixelPtr = MLIB_POINTER_GET(lineAddr, ySrc) + 3 * xSrc;
0N/A srcPixelPtr2 = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);
0N/A k3 = t * u;
0N/A k2 = (ONE - t) * u;
0N/A k1 = t * (ONE - u);
0N/A k0 = (ONE - t) * (ONE - u);
0N/A a00_0 = srcPixelPtr[0];
0N/A a00_1 = srcPixelPtr[1];
0N/A a00_2 = srcPixelPtr[2];
0N/A a01_0 = srcPixelPtr[3];
0N/A a01_1 = srcPixelPtr[4];
0N/A a01_2 = srcPixelPtr[5];
0N/A a10_0 = srcPixelPtr2[0];
0N/A a10_1 = srcPixelPtr2[1];
0N/A a10_2 = srcPixelPtr2[2];
0N/A a11_0 = srcPixelPtr2[3];
0N/A a11_1 = srcPixelPtr2[4];
0N/A a11_2 = srcPixelPtr2[5];
0N/A
0N/A for (; dstPixelPtr < dstLineEnd; dstPixelPtr += 3) {
0N/A pix0 = k0 * a00_0 + k1 * a01_0 + k2 * a10_0 + k3 * a11_0;
0N/A pix1 = k0 * a00_1 + k1 * a01_1 + k2 * a10_1 + k3 * a11_1;
0N/A pix2 = k0 * a00_2 + k1 * a01_2 + k2 * a10_2 + k3 * a11_2;
0N/A t = (X & MLIB_MASK) * scale;
0N/A u = (Y & MLIB_MASK) * scale;
0N/A ySrc = MLIB_POINTER_SHIFT(Y);
0N/A Y += dY;
0N/A xSrc = X >> MLIB_SHIFT;
0N/A X += dX;
0N/A srcPixelPtr = MLIB_POINTER_GET(lineAddr, ySrc) + 3 * xSrc;
0N/A srcPixelPtr2 = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);
0N/A k3 = t * u;
0N/A k2 = (ONE - t) * u;
0N/A k1 = t * (ONE - u);
0N/A k0 = (ONE - t) * (ONE - u);
0N/A a01_0 = srcPixelPtr[3];
0N/A a01_1 = srcPixelPtr[4];
0N/A a01_2 = srcPixelPtr[5];
0N/A a00_0 = srcPixelPtr[0];
0N/A a00_1 = srcPixelPtr[1];
0N/A a00_2 = srcPixelPtr[2];
0N/A a10_0 = srcPixelPtr2[0];
0N/A a10_1 = srcPixelPtr2[1];
0N/A a10_2 = srcPixelPtr2[2];
0N/A a11_0 = srcPixelPtr2[3];
0N/A a11_1 = srcPixelPtr2[4];
0N/A a11_2 = srcPixelPtr2[5];
0N/A dstPixelPtr[0] = pix0;
0N/A dstPixelPtr[1] = pix1;
0N/A dstPixelPtr[2] = pix2;
0N/A }
0N/A
0N/A pix0 = k0 * a00_0 + k1 * a01_0 + k2 * a10_0 + k3 * a11_0;
0N/A pix1 = k0 * a00_1 + k1 * a01_1 + k2 * a10_1 + k3 * a11_1;
0N/A pix2 = k0 * a00_2 + k1 * a01_2 + k2 * a10_2 + k3 * a11_2;
0N/A dstPixelPtr[0] = pix0;
0N/A dstPixelPtr[1] = pix1;
0N/A dstPixelPtr[2] = pix2;
0N/A }
0N/A
0N/A return MLIB_SUCCESS;
0N/A}
0N/A
0N/A/***************************************************************/
0N/Amlib_status FUN_NAME(4ch)(mlib_affine_param *param)
0N/A{
0N/A DECLAREVAR_BL();
0N/A DTYPE *dstLineEnd;
0N/A FTYPE scale = ONE / MLIB_PREC;
0N/A
0N/A for (j = yStart; j <= yFinish; j++) {
0N/A DTYPE *srcPixelPtr2;
0N/A FTYPE t, u, k0, k1, k2, k3;
0N/A FTYPE a00_0, a01_0, a10_0, a11_0;
0N/A FTYPE a00_1, a01_1, a10_1, a11_1;
0N/A FTYPE a00_2, a01_2, a10_2, a11_2;
0N/A FTYPE a00_3, a01_3, a10_3, a11_3;
0N/A FTYPE pix0, pix1, pix2, pix3;
0N/A
0N/A CLIP(4);
0N/A dstLineEnd = (DTYPE *) dstData + 4 * xRight;
0N/A
0N/A t = (X & MLIB_MASK) * scale;
0N/A u = (Y & MLIB_MASK) * scale;
0N/A ySrc = MLIB_POINTER_SHIFT(Y);
0N/A Y += dY;
0N/A xSrc = X >> MLIB_SHIFT;
0N/A X += dX;
0N/A srcPixelPtr = MLIB_POINTER_GET(lineAddr, ySrc) + 4 * xSrc;
0N/A srcPixelPtr2 = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);
0N/A k3 = t * u;
0N/A k2 = (ONE - t) * u;
0N/A k1 = t * (ONE - u);
0N/A k0 = (ONE - t) * (ONE - u);
0N/A a00_0 = srcPixelPtr[0];
0N/A a00_1 = srcPixelPtr[1];
0N/A a00_2 = srcPixelPtr[2];
0N/A a00_3 = srcPixelPtr[3];
0N/A a01_0 = srcPixelPtr[4];
0N/A a01_1 = srcPixelPtr[5];
0N/A a01_2 = srcPixelPtr[6];
0N/A a01_3 = srcPixelPtr[7];
0N/A a10_0 = srcPixelPtr2[0];
0N/A a10_1 = srcPixelPtr2[1];
0N/A a10_2 = srcPixelPtr2[2];
0N/A a10_3 = srcPixelPtr2[3];
0N/A a11_0 = srcPixelPtr2[4];
0N/A a11_1 = srcPixelPtr2[5];
0N/A a11_2 = srcPixelPtr2[6];
0N/A a11_3 = srcPixelPtr2[7];
0N/A
0N/A for (; dstPixelPtr < dstLineEnd; dstPixelPtr += 4) {
0N/A pix0 = k0 * a00_0 + k1 * a01_0 + k2 * a10_0 + k3 * a11_0;
0N/A pix1 = k0 * a00_1 + k1 * a01_1 + k2 * a10_1 + k3 * a11_1;
0N/A pix2 = k0 * a00_2 + k1 * a01_2 + k2 * a10_2 + k3 * a11_2;
0N/A pix3 = k0 * a00_3 + k1 * a01_3 + k2 * a10_3 + k3 * a11_3;
0N/A t = (X & MLIB_MASK) * scale;
0N/A u = (Y & MLIB_MASK) * scale;
0N/A ySrc = MLIB_POINTER_SHIFT(Y);
0N/A Y += dY;
0N/A xSrc = X >> (MLIB_SHIFT - 2);
0N/A X += dX;
0N/A srcPixelPtr = MLIB_POINTER_GET(lineAddr, ySrc) + (xSrc & ~3);
0N/A srcPixelPtr2 = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);
0N/A k3 = t * u;
0N/A k2 = (ONE - t) * u;
0N/A k1 = t * (ONE - u);
0N/A k0 = (ONE - t) * (ONE - u);
0N/A a00_3 = srcPixelPtr[3];
0N/A a01_3 = srcPixelPtr[7];
0N/A a10_3 = srcPixelPtr2[3];
0N/A a11_3 = srcPixelPtr2[7];
0N/A a00_0 = srcPixelPtr[0];
0N/A a00_1 = srcPixelPtr[1];
0N/A a00_2 = srcPixelPtr[2];
0N/A a01_0 = srcPixelPtr[4];
0N/A a01_1 = srcPixelPtr[5];
0N/A a01_2 = srcPixelPtr[6];
0N/A a10_0 = srcPixelPtr2[0];
0N/A a10_1 = srcPixelPtr2[1];
0N/A a10_2 = srcPixelPtr2[2];
0N/A a11_0 = srcPixelPtr2[4];
0N/A a11_1 = srcPixelPtr2[5];
0N/A a11_2 = srcPixelPtr2[6];
0N/A dstPixelPtr[0] = pix0;
0N/A dstPixelPtr[1] = pix1;
0N/A dstPixelPtr[2] = pix2;
0N/A dstPixelPtr[3] = pix3;
0N/A }
0N/A
0N/A pix0 = k0 * a00_0 + k1 * a01_0 + k2 * a10_0 + k3 * a11_0;
0N/A pix1 = k0 * a00_1 + k1 * a01_1 + k2 * a10_1 + k3 * a11_1;
0N/A pix2 = k0 * a00_2 + k1 * a01_2 + k2 * a10_2 + k3 * a11_2;
0N/A pix3 = k0 * a00_3 + k1 * a01_3 + k2 * a10_3 + k3 * a11_3;
0N/A dstPixelPtr[0] = pix0;
0N/A dstPixelPtr[1] = pix1;
0N/A dstPixelPtr[2] = pix2;
0N/A dstPixelPtr[3] = pix3;
0N/A }
0N/A
0N/A return MLIB_SUCCESS;
0N/A}
0N/A
0N/A/***************************************************************/