blob: cd763f534a4e681c0f44d7ccd49642e0c9e42ef7 [file] [log] [blame]
/*
* 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)
/***************************************************************/