JDK14/Java14源码在线阅读
/*
* 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.
*/
/*
* The functions step along the lines from xLeft to xRight and apply
* the bicubic filtering.
*
*/
#include "vis_proto.h"
#include "mlib_ImageAffine.h"
#include "mlib_v_ImageFilters.h"
/*#define MLIB_VIS2*/
/***************************************************************/
#define DTYPE mlib_u8
#define FILTER_BITS 8
/***************************************************************/
#ifdef MLIB_VIS2
#define MLIB_WRITE_BMASK(bmask) vis_write_bmask(bmask, 0)
#else
#define MLIB_WRITE_BMASK(bmask)
#endif /* MLIB_VIS2 */
/***************************************************************/
#define sPtr srcPixelPtr
/***************************************************************/
#define NEXT_PIXEL_1BC_U8() \
xSrc = (X>>MLIB_SHIFT)-1; \
ySrc = (Y>>MLIB_SHIFT)-1; \
sPtr = (mlib_u8 *)lineAddr[ySrc] + xSrc
/***************************************************************/
#ifndef MLIB_VIS2
#define ALIGN_ADDR(da, dp) \
da = vis_alignaddr(dp, 0)
#else
#define ALIGN_ADDR(da, dp) \
vis_alignaddr(dp, 0); \
da = (mlib_d64*)(((mlib_addr)(dp)) &~ 7)
#endif /* MLIB_VIS2 */
/***************************************************************/
#define LOAD_BC_U8_1CH_1PIXEL(mlib_filters_u8) \
ALIGN_ADDR(dpSrc, sPtr); \
data0 = dpSrc[0]; \
data1 = dpSrc[1]; \
row00 = vis_faligndata(data0, data1); \
sPtr += srcYStride; \
ALIGN_ADDR(dpSrc, sPtr); \
data0 = dpSrc[0]; \
data1 = dpSrc[1]; \
row10 = vis_faligndata(data0, data1); \
sPtr += srcYStride; \
ALIGN_ADDR(dpSrc, sPtr); \
data0 = dpSrc[0]; \
data1 = dpSrc[1]; \
row20 = vis_faligndata(data0, data1); \
sPtr += srcYStride; \
ALIGN_ADDR(dpSrc, sPtr); \
data0 = dpSrc[0]; \
data1 = dpSrc[1]; \
row30 = vis_faligndata(data0, data1); \
filterposy = (Y >> FILTER_SHIFT) & FILTER_MASK; \
yFilter = *((mlib_d64 *) ((mlib_u8 *)mlib_filters_u8 + filterposy)); \
filterposx = (X >> FILTER_SHIFT) & FILTER_MASK; \
xFilter = *((mlib_d64 *)((mlib_u8 *)mlib_filters_u8 + filterposx)); \
X += dX; \
Y += dY
/***************************************************************/
#ifndef MLIB_VIS2
#define SUM_4x16(v1, v3) \
vis_alignaddr((void*)2, 0); \
v0 = vis_faligndata(v3, v3); \
v2 = vis_fpadd16(v3, v0); \
v1 = vis_write_lo(v1, vis_fpadd16s(vis_read_hi(v2), vis_read_lo(v2)))
#else
#define SUM_4x16(v1, v3) \
v2 = vis_freg_pair(vis_fpadd16s(vis_read_hi(v3), vis_read_lo(v3)), \
vis_fpadd16s(vis_read_hi(v3), vis_read_lo(v3))); \
v3 = vis_bshuffle(v2, v2); \
v1 = vis_write_lo(v1, vis_fpadd16s(vis_read_hi(v3), vis_read_lo(v3)))
#endif /* MLIB_VIS2 */
/***************************************************************/
#define RESULT_1BC_U8_1PIXEL(ind) \
v0 = vis_fmul8x16au(vis_read_hi(row0##ind), vis_read_hi(yFilter)); \
v1 = vis_fmul8x16al(vis_read_hi(row1##ind), vis_read_hi(yFilter)); \
sum = vis_fpadd16(v0, v1); \
v2 = vis_fmul8x16au(vis_read_hi(row2##ind), vis_read_lo(yFilter)); \
sum = vis_fpadd16(sum, v2); \
v3 = vis_fmul8x16al(vis_read_hi(row3##ind), vis_read_lo(yFilter)); \
sum = vis_fpadd16(sum, v3); \
v0 = vis_fmul8sux16(sum, xFilter); \
v1 = vis_fmul8ulx16(sum, xFilter); \
v3 = vis_fpadd16(v1, v0); \
SUM_4x16(v1, v3); \
res = vis_write_lo(res, vis_fpack16(v1))
/***************************************************************/
#define BC_U8_1CH(index, ind1, ind2, mlib_filters_u8) \
ALIGN_ADDR(dpSrc, sPtr); \
data0 = dpSrc[0]; \
v0 = vis_fmul8x16au(vis_read_hi(row0##ind1), vis_read_hi(yFilter)); \
filterposy = (Y >> FILTER_SHIFT); \
data1 = dpSrc[1]; \
v1 = vis_fmul8x16al(vis_read_hi(row1##ind1), vis_read_hi(yFilter)); \
row0##ind2 = vis_faligndata(data0, data1); \
filterposx = (X >> FILTER_SHIFT); \
sPtr += srcYStride; \
ALIGN_ADDR(dpSrc, sPtr); \
sum = vis_fpadd16(v0, v1); \
data0 = dpSrc[0]; \
v2 = vis_fmul8x16au(vis_read_hi(row2##ind1), vis_read_lo(yFilter)); \
X += dX; \
data1 = dpSrc[1]; \
row1##ind2 = vis_faligndata(data0, data1); \
sPtr += srcYStride; \
ALIGN_ADDR(dpSrc, sPtr); \
Y += dY; \
sum = vis_fpadd16(sum, v2); \
xSrc = (X>>MLIB_SHIFT)-1; \
v3 = vis_fmul8x16al(vis_read_hi(row3##ind1), vis_read_lo(yFilter)); \
data0 = dpSrc[0]; \
ySrc = (Y>>MLIB_SHIFT)-1; \
sum = vis_fpadd16(sum, v3); \
data1 = dpSrc[1]; \
filterposy &= FILTER_MASK; \
v0 = vis_fmul8sux16(sum, xFilter); \
row2##ind2 = vis_faligndata(data0, data1); \
sPtr += srcYStride; \
v1 = vis_fmul8ulx16(sum, xFilter); \
filterposx &= FILTER_MASK; \
ALIGN_ADDR(dpSrc, sPtr); \
data0 = dpSrc[0]; \
d##index = vis_fpadd16(v0, v1); \
data1 = dpSrc[1]; \
row3##ind2 = vis_faligndata(data0, data1); \
yFilter = *((mlib_d64 *) ((mlib_u8 *)mlib_filters_u8 + filterposy)); \
xFilter = *((mlib_d64 *)((mlib_u8 *)mlib_filters_u8 + filterposx)); \
sPtr = (mlib_u8 *)lineAddr[ySrc] + xSrc
/***************************************************************/
#ifndef MLIB_VIS2
#define FADD_1BC_U8() \
p0 = vis_fpadd16s(vis_read_hi(d0), vis_read_lo(d0)); \
p1 = vis_fpadd16s(vis_read_hi(d1), vis_read_lo(d1)); \
p2 = vis_fpadd16s(vis_read_hi(d2), vis_read_lo(d2)); \
p3 = vis_fpadd16s(vis_read_hi(d3), vis_read_lo(d3)); \
m02 = vis_fpmerge(p0, p2); \
m13 = vis_fpmerge(p1, p3); \
m0213 = vis_fpmerge(vis_read_hi(m02), vis_read_hi(m13)); \
e0 = vis_fpmerge(vis_read_hi(m0213), vis_read_lo(m0213)); \
m0213 = vis_fpmerge(vis_read_lo(m02), vis_read_lo(m13)); \
e1 = vis_fpmerge(vis_read_hi(m0213), vis_read_lo(m0213)); \
res = vis_fpadd16(e0, e1)
#else
#define FADD_1BC_U8() \
v0 = vis_freg_pair(vis_fpadd16s(vis_read_hi(d0), vis_read_lo(d0)), \
vis_fpadd16s(vis_read_hi(d1), vis_read_lo(d1))); \
v1 = vis_freg_pair(vis_fpadd16s(vis_read_hi(d2), vis_read_lo(d2)), \
vis_fpadd16s(vis_read_hi(d3), vis_read_lo(d3))); \
v2 = vis_bshuffle(v0, v0); \
v3 = vis_bshuffle(v1, v1); \
res = vis_freg_pair(vis_fpadd16s(vis_read_hi(v2), vis_read_lo(v2)), \
vis_fpadd16s(vis_read_hi(v3), vis_read_lo(v3)))
#endif /* MLIB_VIS2 */
/***************************************************************/
mlib_status mlib_ImageAffine_u8_1ch_bc (mlib_affine_param *param)
{
DECLAREVAR_BC();
mlib_s32 filterposx, filterposy;
mlib_d64 data0, data1;
mlib_d64 sum;
mlib_d64 row00, row10, row20, row30;
mlib_d64 row01, row11, row21, row31;
mlib_d64 xFilter, yFilter;
mlib_d64 v0, v1, v2, v3;
mlib_d64 d0, d1, d2, d3;
#ifndef MLIB_VIS2
mlib_f32 p0, p1, p2, p3;
mlib_d64 e0, e1;
mlib_d64 m02, m13, m0213;
#endif /* MLIB_VIS2 */
mlib_d64 *dpSrc;
mlib_s32 align, cols, i;
mlib_d64 res;
const mlib_s16 *mlib_filters_table;
if (filter == MLIB_BICUBIC) {
mlib_filters_table = mlib_filters_u8_bc;
} else {
mlib_filters_table = mlib_filters_u8_bc2;
}
for (j = yStart; j <= yFinish; j++) {
vis_write_gsr(3 << 3);
MLIB_WRITE_BMASK(0x0145ABEF);
CLIP(1);
cols = xRight - xLeft + 1;
align = (4 - ((mlib_addr)dstPixelPtr) & 3) & 3;
align = (cols < align)? cols : align;
for (i = 0; i < align; i++) {
NEXT_PIXEL_1BC_U8();
LOAD_BC_U8_1CH_1PIXEL(mlib_filters_table);
RESULT_1BC_U8_1PIXEL(0);
vis_st_u8(res, dstPixelPtr++);
}
if (i <= cols - 10) {
NEXT_PIXEL_1BC_U8();
LOAD_BC_U8_1CH_1PIXEL(mlib_filters_table);
NEXT_PIXEL_1BC_U8();
BC_U8_1CH(0, 0, 1, mlib_filters_table);
BC_U8_1CH(1, 1, 0, mlib_filters_table);
BC_U8_1CH(2, 0, 1, mlib_filters_table);
BC_U8_1CH(3, 1, 0, mlib_filters_table);
FADD_1BC_U8();
BC_U8_1CH(0, 0, 1, mlib_filters_table);
BC_U8_1CH(1, 1, 0, mlib_filters_table);
BC_U8_1CH(2, 0, 1, mlib_filters_table);
BC_U8_1CH(3, 1, 0, mlib_filters_table);
#pragma pipeloop(0)
for (; i <= cols - 14; i+=4) {
*(mlib_f32*)dstPixelPtr = vis_fpack16(res);
FADD_1BC_U8();
BC_U8_1CH(0, 0, 1, mlib_filters_table);
BC_U8_1CH(1, 1, 0, mlib_filters_table);
BC_U8_1CH(2, 0, 1, mlib_filters_table);
BC_U8_1CH(3, 1, 0, mlib_filters_table);
dstPixelPtr += 4;
}
*(mlib_f32*)dstPixelPtr = vis_fpack16(res);
dstPixelPtr += 4;
FADD_1BC_U8();
*(mlib_f32*)dstPixelPtr = vis_fpack16(res);
dstPixelPtr += 4;
RESULT_1BC_U8_1PIXEL(0);
vis_st_u8(res, dstPixelPtr++);
LOAD_BC_U8_1CH_1PIXEL(mlib_filters_table);
RESULT_1BC_U8_1PIXEL(0);
vis_st_u8(res, dstPixelPtr++);
i += 10;
}
for (; i < cols; i++) {
NEXT_PIXEL_1BC_U8();
LOAD_BC_U8_1CH_1PIXEL(mlib_filters_table);
RESULT_1BC_U8_1PIXEL(0);
vis_st_u8(res, dstPixelPtr++);
}
}
return MLIB_SUCCESS;
}
/***************************************************************/
#define FADD_2BC_U8() \
d0 = vis_fpadd16(d00, d10); \
d1 = vis_fpadd16(d01, d11); \
d2 = vis_fpadd16(d02, d12); \
d3 = vis_fpadd16(d03, d13); \
p0 = vis_fpadd16s(vis_read_hi(d0), vis_read_lo(d0)); \
p1 = vis_fpadd16s(vis_read_hi(d1), vis_read_lo(d1)); \
p2 = vis_fpadd16s(vis_read_hi(d2), vis_read_lo(d2)); \
p3 = vis_fpadd16s(vis_read_hi(d3), vis_read_lo(d3)); \
e0 = vis_freg_pair(p0, p1); \
e1 = vis_freg_pair(p2, p3); \
res = vis_fpack16_pair(e0, e1)
/***************************************************************/
#define LOAD_BC_U8_2CH_1PIXEL(mlib_filters_u8) \
filterposy = (Y >> FILTER_SHIFT) & FILTER_MASK; \
yFilter = *((mlib_d64 *) ((mlib_u8 *)mlib_filters_u8 + filterposy)); \
filterposx = (X >> FILTER_SHIFT) & FILTER_MASK; \
xFilter = *((mlib_d64 *)((mlib_u8 *)mlib_filters_u8 + filterposx)); \
X += dX; \
Y += dY; \
ALIGN_ADDR(dpSrc, sPtr); \
data0 = dpSrc[0]; \
data1 = dpSrc[1]; \
row0 = vis_faligndata(data0, data1); \
sPtr += srcYStride; \
ALIGN_ADDR(dpSrc, sPtr); \
data0 = dpSrc[0]; \
data1 = dpSrc[1]; \
row1 = vis_faligndata(data0, data1); \
sPtr += srcYStride; \
ALIGN_ADDR(dpSrc, sPtr); \
data0 = dpSrc[0]; \
data1 = dpSrc[1]; \
row2 = vis_faligndata(data0, data1); \
sPtr += srcYStride; \
ALIGN_ADDR(dpSrc, sPtr); \
data0 = dpSrc[0]; \
data1 = dpSrc[1]; \
row3 = vis_faligndata(data0, data1)
/***************************************************************/
#define NEXT_PIXEL_2BC_U8() \
xSrc = (X>>MLIB_SHIFT)-1; \
ySrc = (Y>>MLIB_SHIFT)-1; \
sPtr = (mlib_u8 *)lineAddr[ySrc] + (xSrc<<1)
/***************************************************************/
#define RESULT_2BC_U8_1PIXEL() \
v00 = vis_fmul8x16au(vis_read_hi(row0), vis_read_hi(yFilter)); \
dr = vis_fpmerge(vis_read_hi(xFilter), vis_read_lo(xFilter)); \
v01 = vis_fmul8x16au(vis_read_lo(row0), vis_read_hi(yFilter)); \
dr = vis_fpmerge(vis_read_hi(dr), vis_read_lo(dr)); \
v10 = vis_fmul8x16al(vis_read_hi(row1), vis_read_hi(yFilter)); \
dr1 = vis_fpmerge(vis_read_lo(dr), vis_read_lo(dr)); \
v11 = vis_fmul8x16al(vis_read_lo(row1), vis_read_hi(yFilter)); \
dr = vis_fpmerge(vis_read_hi(dr), vis_read_hi(dr)); \
v20 = vis_fmul8x16au(vis_read_hi(row2), vis_read_lo(yFilter)); \
xFilter0 = vis_fpmerge(vis_read_hi(dr), vis_read_hi(dr1)); \
v21 = vis_fmul8x16au(vis_read_lo(row2), vis_read_lo(yFilter)); \
xFilter1 = vis_fpmerge(vis_read_lo(dr), vis_read_lo(dr1)); \
v30 = vis_fmul8x16al(vis_read_hi(row3), vis_read_lo(yFilter)); \
sum0 = vis_fpadd16(v00, v10); \
v31 = vis_fmul8x16al(vis_read_lo(row3), vis_read_lo(yFilter)); \
sum1 = vis_fpadd16(v01, v11); \
sum0 = vis_fpadd16(sum0, v20); \
sum1 = vis_fpadd16(sum1, v21); \
sum0 = vis_fpadd16(sum0, v30); \
sum1 = vis_fpadd16(sum1, v31); \
v00 = vis_fmul8sux16(sum0, xFilter0); \
v01 = vis_fmul8sux16(sum1, xFilter1); \
v10 = vis_fmul8ulx16(sum0, xFilter0); \
sum0 = vis_fpadd16(v00, v10); \
v11 = vis_fmul8ulx16(sum1, xFilter1); \
sum1 = vis_fpadd16(v01, v11); \
d0 = vis_fpadd16(sum0, sum1); \
v00 = vis_write_lo(v00, vis_fpadd16s(vis_read_hi(d0), \
vis_read_lo(d0))); \
res = vis_write_lo(res, vis_fpack16(v00))
/***************************************************************/
#define BC_U8_2CH(index, mlib_filters_u8) \
v00 = vis_fmul8x16au(vis_read_hi(row0), vis_read_hi(yFilter)); \
dr = vis_fpmerge(vis_read_hi(xFilter), vis_read_lo(xFilter)); \
v01 = vis_fmul8x16au(vis_read_lo(row0), vis_read_hi(yFilter)); \
dr = vis_fpmerge(vis_read_hi(dr), vis_read_lo(dr)); \
v10 = vis_fmul8x16al(vis_read_hi(row1), vis_read_hi(yFilter)); \
dr1 = vis_fpmerge(vis_read_lo(dr), vis_read_lo(dr)); \
v11 = vis_fmul8x16al(vis_read_lo(row1), vis_read_hi(yFilter)); \
dr = vis_fpmerge(vis_read_hi(dr), vis_read_hi(dr)); \
v20 = vis_fmul8x16au(vis_read_hi(row2), vis_read_lo(yFilter)); \
xFilter0 = vis_fpmerge(vis_read_hi(dr), vis_read_hi(dr1)); \
v21 = vis_fmul8x16au(vis_read_lo(row2), vis_read_lo(yFilter)); \
xFilter1 = vis_fpmerge(vis_read_lo(dr), vis_read_lo(dr1)); \
v30 = vis_fmul8x16al(vis_read_hi(row3), vis_read_lo(yFilter)); \
v31 = vis_fmul8x16al(vis_read_lo(row3), vis_read_lo(yFilter)); \
ALIGN_ADDR(dpSrc, sPtr); \
data0 = dpSrc[0]; \
sum0 = vis_fpadd16(v00, v10); \
filterposy = (Y >> FILTER_SHIFT); \
data1 = dpSrc[1]; \
row0 = vis_faligndata(data0, data1); \
filterposx = (X >> FILTER_SHIFT); \
sPtr += srcYStride; \
ALIGN_ADDR(dpSrc, sPtr); \
data0 = dpSrc[0]; \
sum1 = vis_fpadd16(v01, v11); \
X += dX; \
data1 = dpSrc[1]; \
sum0 = vis_fpadd16(sum0, v20); \
row1 = vis_faligndata(data0, data1); \
sPtr += srcYStride; \
ALIGN_ADDR(dpSrc, sPtr); \
Y += dY; \
sum1 = vis_fpadd16(sum1, v21); \
xSrc = (X>>MLIB_SHIFT)-1; \
data0 = dpSrc[0]; \
ySrc = (Y>>MLIB_SHIFT)-1; \
sum0 = vis_fpadd16(sum0, v30); \
data1 = dpSrc[1]; \
filterposy &= FILTER_MASK; \
sum1 = vis_fpadd16(sum1, v31); \
v00 = vis_fmul8sux16(sum0, xFilter0); \
row2 = vis_faligndata(data0, data1); \
v01 = vis_fmul8sux16(sum1, xFilter1); \
sPtr += srcYStride; \
v10 = vis_fmul8ulx16(sum0, xFilter0); \
filterposx &= FILTER_MASK; \
ALIGN_ADDR(dpSrc, sPtr); \
v11= vis_fmul8ulx16(sum1, xFilter1); \
data0 = dpSrc[0]; \
d0##index = vis_fpadd16(v00, v10); \
data1 = dpSrc[1]; \
row3 = vis_faligndata(data0, data1); \
yFilter = *((mlib_d64 *) ((mlib_u8 *)mlib_filters_u8 + filterposy)); \
d1##index = vis_fpadd16(v01, v11); \
xFilter = *((mlib_d64 *)((mlib_u8 *)mlib_filters_u8 + filterposx)); \
sPtr = (mlib_u8 *)lineAddr[ySrc] + (xSrc<<1)
/***************************************************************/
mlib_status mlib_ImageAffine_u8_2ch_bc (mlib_affine_param *param)
{
DECLAREVAR_BC();
DTYPE *dstLineEnd;
mlib_s32 filterposx, filterposy;
mlib_d64 data0, data1;
mlib_d64 sum0, sum1;
mlib_d64 row0, row1, row2, row3;
mlib_f32 p0, p1, p2, p3;
mlib_d64 xFilter;
mlib_d64 xFilter0, xFilter1, yFilter;
mlib_d64 v00, v10, v20, v30;
mlib_d64 v01, v11, v21, v31;
mlib_d64 d0, d1, d2, d3;
mlib_d64 d00, d01, d02, d03;
mlib_d64 d10, d11, d12, d13;
mlib_d64 e0, e1;
mlib_d64 *dpSrc;
mlib_s32 cols, i, mask, off;
mlib_d64 dr, dr1;
mlib_d64 res, *dp;
const mlib_s16 *mlib_filters_table;
if (filter == MLIB_BICUBIC) {
mlib_filters_table = mlib_filters_u8_bc;
} else {
mlib_filters_table = mlib_filters_u8_bc2;
}
for (j = yStart; j <= yFinish; j++) {
vis_write_gsr(3 << 3);
CLIP(2);
dstLineEnd = (DTYPE*)dstData + 2 * xRight;
cols = xRight - xLeft + 1;
dp = vis_alignaddr(dstPixelPtr, 0);
off = dstPixelPtr - (mlib_u8*)dp;
dstLineEnd += 1;
mask = vis_edge8(dstPixelPtr, dstLineEnd);
i = 0;
if (i <= cols - 10) {
NEXT_PIXEL_2BC_U8();
LOAD_BC_U8_2CH_1PIXEL(mlib_filters_table);
NEXT_PIXEL_2BC_U8();
BC_U8_2CH(0, mlib_filters_table);
BC_U8_2CH(1, mlib_filters_table);
BC_U8_2CH(2, mlib_filters_table);
BC_U8_2CH(3, mlib_filters_table);
FADD_2BC_U8();
BC_U8_2CH(0, mlib_filters_table);
BC_U8_2CH(1, mlib_filters_table);
BC_U8_2CH(2, mlib_filters_table);
BC_U8_2CH(3, mlib_filters_table);
#pragma pipeloop(0)
for (; i <= cols-14; i+=4) {
vis_alignaddr((void *)(8 - (mlib_addr)dstPixelPtr), 0);
res = vis_faligndata(res, res);
vis_pst_8(res, dp++, mask);
vis_pst_8(res, dp, ~mask);
FADD_2BC_U8();
BC_U8_2CH(0, mlib_filters_table);
BC_U8_2CH(1, mlib_filters_table);
BC_U8_2CH(2, mlib_filters_table);
BC_U8_2CH(3, mlib_filters_table);
}
vis_alignaddr((void *)(8 - (mlib_addr)dstPixelPtr), 0);
res = vis_faligndata(res, res);
vis_pst_8(res, dp++, mask);
vis_pst_8(res, dp, ~mask);
FADD_2BC_U8();
vis_alignaddr((void *)(8 - (mlib_addr)dstPixelPtr), 0);
res = vis_faligndata(res, res);
vis_pst_8(res, dp++, mask);
vis_pst_8(res, dp, ~mask);
dstPixelPtr = (mlib_u8*)dp + off;
RESULT_2BC_U8_1PIXEL();
vis_alignaddr((void *)7, 0);
vis_st_u8(res, dstPixelPtr+1);
res = vis_faligndata(res, res);
vis_st_u8(res, dstPixelPtr);
dstPixelPtr += 2;
LOAD_BC_U8_2CH_1PIXEL(mlib_filters_table);
RESULT_2BC_U8_1PIXEL();
vis_alignaddr((void *)7, 0);
vis_st_u8(res, dstPixelPtr+1);
res = vis_faligndata(res, res);
vis_st_u8(res, dstPixelPtr);
dstPixelPtr += 2;
i += 10;
}
for (; i < cols; i++) {
NEXT_PIXEL_2BC_U8();
LOAD_BC_U8_2CH_1PIXEL(mlib_filters_table);
RESULT_2BC_U8_1PIXEL();
vis_alignaddr((void *)7, 0);
vis_st_u8(res, dstPixelPtr+1);
res = vis_faligndata(res, res);
vis_st_u8(res, dstPixelPtr);
dstPixelPtr += 2;
}
}
return MLIB_SUCCESS;
}
/***************************************************************/
#ifndef MLIB_VIS2
#define FADD_3BC_U8() \
vis_alignaddr((void*)6, 0); \
d3 = vis_faligndata(d0, d1); \
vis_alignaddr((void*)2, 0); \
d4 = vis_faligndata(d1, d2); \
d0 = vis_fpadd16(d0, d3); \
d2 = vis_fpadd16(d2, d4); \
d1 = vis_faligndata(d2, d2); \
d0 = vis_fpadd16(d0, d1); \
f0.f = vis_fpack16(d0)
#else
#define FADD_3BC_U8() \
vis_alignaddr((void*)4, 0); \
d3 = vis_bshuffle(d0, d1); \
d1 = vis_faligndata(d1, d2); \
d2 = vis_faligndata(d2, d2); \
d4 = vis_bshuffle(d1, d2); \
d0 = vis_fpadd16(d0, d3); \
d1 = vis_fpadd16(d1, d4); \
d0 = vis_fpadd16(d0, d1); \
f0.f = vis_fpack16(d0)
#endif /* MLIB_VIS2 */
/***************************************************************/
#define LOAD_BC_U8_3CH_1PIXEL(mlib_filters_u8, mlib_filters_u8_3) \
filterposy = (Y >> FILTER_SHIFT) & FILTER_MASK; \
yFilter = *((mlib_d64 *) ((mlib_u8 *)mlib_filters_u8 + filterposy)); \
filterposx = (X >> FILTER_SHIFT) & FILTER_MASK; \
xPtr=((mlib_d64 *)((mlib_u8 *)mlib_filters_u8_3+3*filterposx)); \
xFilter0 = xPtr[0]; \
xFilter1 = xPtr[1]; \
xFilter2 = xPtr[2]; \
X += dX; \
Y += dY; \
ALIGN_ADDR(dpSrc, sPtr); \
data0 = dpSrc[0]; \
data1 = dpSrc[1]; \
data2 = dpSrc[2]; \
row00 = vis_faligndata(data0, data1); \
row01 = vis_faligndata(data1, data2); \
sPtr += srcYStride; \
ALIGN_ADDR(dpSrc, sPtr); \
data0 = dpSrc[0]; \
data1 = dpSrc[1]; \
data2 = dpSrc[2]; \
row10 = vis_faligndata(data0, data1); \
row11 = vis_faligndata(data1, data2); \
sPtr += srcYStride; \
ALIGN_ADDR(dpSrc, sPtr); \
data0 = dpSrc[0]; \
data1 = dpSrc[1]; \
data2 = dpSrc[2]; \
row20 = vis_faligndata(data0, data1); \
row21 = vis_faligndata(data1, data2); \
sPtr += srcYStride; \
ALIGN_ADDR(dpSrc, sPtr); \
data0 = dpSrc[0]; \
data1 = dpSrc[1]; \
data2 = dpSrc[2]; \
row30 = vis_faligndata(data0, data1); \
row31 = vis_faligndata(data1, data2)
/***************************************************************/
#define STORE_BC_U8_3CH_1PIXEL() \
dstPixelPtr[0] = f0.t[0]; \
dstPixelPtr[1] = f0.t[1]; \
dstPixelPtr[2] = f0.t[2]; \
dstPixelPtr += 3
/***************************************************************/
#define NEXT_PIXEL_3BC_U8() \
xSrc = (X>>MLIB_SHIFT)-1; \
ySrc = (Y>>MLIB_SHIFT)-1; \
sPtr = (mlib_u8 *)lineAddr[ySrc] + (3*xSrc)
/***************************************************************/
#define RESULT_3BC_U8_1PIXEL() \
v00 = vis_fmul8x16au(vis_read_hi(row00), vis_read_hi(yFilter)); \
v01 = vis_fmul8x16au(vis_read_lo(row00), vis_read_hi(yFilter)); \
v02 = vis_fmul8x16au(vis_read_hi(row01), vis_read_hi(yFilter)); \
v10 = vis_fmul8x16al(vis_read_hi(row10), vis_read_hi(yFilter)); \
v11 = vis_fmul8x16al(vis_read_lo(row10), vis_read_hi(yFilter)); \
v12 = vis_fmul8x16al(vis_read_hi(row11), vis_read_hi(yFilter)); \
v20 = vis_fmul8x16au(vis_read_hi(row20), vis_read_lo(yFilter)); \
sum0 = vis_fpadd16(v00, v10); \
v21 = vis_fmul8x16au(vis_read_lo(row20), vis_read_lo(yFilter)); \
sum1 = vis_fpadd16(v01, v11); \
v22 = vis_fmul8x16au(vis_read_hi(row21), vis_read_lo(yFilter)); \
sum2 = vis_fpadd16(v02, v12); \
v30 = vis_fmul8x16al(vis_read_hi(row30), vis_read_lo(yFilter)); \
sum0 = vis_fpadd16(sum0, v20); \
v31 = vis_fmul8x16al(vis_read_lo(row30), vis_read_lo(yFilter)); \
sum1 = vis_fpadd16(sum1, v21); \
v32 = vis_fmul8x16al(vis_read_hi(row31), vis_read_lo(yFilter)); \
sum2 = vis_fpadd16(sum2, v22); \
sum0 = vis_fpadd16(sum0, v30); \
sum1 = vis_fpadd16(sum1, v31); \
v00 = vis_fmul8sux16(sum0, xFilter0); \
sum2 = vis_fpadd16(sum2, v32); \
v01 = vis_fmul8ulx16(sum0, xFilter0); \
v10 = vis_fmul8sux16(sum1, xFilter1); \
d0 = vis_fpadd16(v00, v01); \
v11 = vis_fmul8ulx16(sum1, xFilter1); \
v20 = vis_fmul8sux16(sum2, xFilter2); \
d1 = vis_fpadd16(v10, v11); \
v21 = vis_fmul8ulx16(sum2, xFilter2); \
d2 = vis_fpadd16(v20, v21); \
FADD_3BC_U8();
/***************************************************************/
#define BC_U8_3CH(mlib_filters_u8, mlib_filters_u8_3) \
v00 = vis_fmul8x16au(vis_read_hi(row00), vis_read_hi(yFilter)); \
v01 = vis_fmul8x16au(vis_read_lo(row00), vis_read_hi(yFilter)); \
v02 = vis_fmul8x16au(vis_read_hi(row01), vis_read_hi(yFilter)); \
ALIGN_ADDR(dpSrc, sPtr); \
data0 = dpSrc[0]; \
filterposy = (Y >> FILTER_SHIFT); \
v10 = vis_fmul8x16al(vis_read_hi(row10), vis_read_hi(yFilter)); \
data1 = dpSrc[1]; \
v11 = vis_fmul8x16al(vis_read_lo(row10), vis_read_hi(yFilter)); \
sum0 = vis_fpadd16(v00, v10); \
data2 = dpSrc[2]; \
row00 = vis_faligndata(data0, data1); \
v12 = vis_fmul8x16al(vis_read_hi(row11), vis_read_hi(yFilter)); \
row01 = vis_faligndata(data1, data2); \
filterposx = (X >> FILTER_SHIFT); \
sPtr += srcYStride; \
ALIGN_ADDR(dpSrc, sPtr); \
v20 = vis_fmul8x16au(vis_read_hi(row20), vis_read_lo(yFilter)); \
sum1 = vis_fpadd16(v01, v11); \
data0 = dpSrc[0]; \
X += dX; \
data1 = dpSrc[1]; \
v21 = vis_fmul8x16au(vis_read_lo(row20), vis_read_lo(yFilter)); \
sum2 = vis_fpadd16(v02, v12); \
data2 = dpSrc[2]; \
row10 = vis_faligndata(data0, data1); \
v22 = vis_fmul8x16au(vis_read_hi(row21), vis_read_lo(yFilter)); \
row11 = vis_faligndata(data1, data2); \
sPtr += srcYStride; \
ALIGN_ADDR(dpSrc, sPtr); \
Y += dY; \
xSrc = (X>>MLIB_SHIFT)-1; \
v30 = vis_fmul8x16al(vis_read_hi(row30), vis_read_lo(yFilter)); \
sum0 = vis_fpadd16(sum0, v20); \
data0 = dpSrc[0]; \
ySrc = (Y>>MLIB_SHIFT)-1; \
data1 = dpSrc[1]; \
v31 = vis_fmul8x16al(vis_read_lo(row30), vis_read_lo(yFilter)); \
sum1 = vis_fpadd16(sum1, v21); \
data2 = dpSrc[2]; \
filterposy &= FILTER_MASK; \
row20 = vis_faligndata(data0, data1); \
v32 = vis_fmul8x16al(vis_read_hi(row31), vis_read_lo(yFilter)); \
row21 = vis_faligndata(data1, data2); \
sPtr += srcYStride; \
filterposx &= FILTER_MASK; \
sum2 = vis_fpadd16(sum2, v22); \
ALIGN_ADDR(dpSrc, sPtr); \
sum0 = vis_fpadd16(sum0, v30); \
data0 = dpSrc[0]; \
sum1 = vis_fpadd16(sum1, v31); \
v00 = vis_fmul8sux16(sum0, xFilter0); \
data1 = dpSrc[1]; \
sum2 = vis_fpadd16(sum2, v32); \
v01 = vis_fmul8ulx16(sum0, xFilter0); \
data2 = dpSrc[2]; \
row30 = vis_faligndata(data0, data1); \
v10 = vis_fmul8sux16(sum1, xFilter1); \
d0 = vis_fpadd16(v00, v01); \
row31 = vis_faligndata(data1, data2); \
yFilter = *((mlib_d64 *)((mlib_u8 *)mlib_filters_u8 + filterposy)); \
v11 = vis_fmul8ulx16(sum1, xFilter1); \
xPtr=((mlib_d64 *)((mlib_u8 *)mlib_filters_u8_3+3*filterposx)); \
xFilter0 = xPtr[0]; \
v20 = vis_fmul8sux16(sum2, xFilter2); \
d1 = vis_fpadd16(v10, v11); \
xFilter1 = xPtr[1]; \
v21 = vis_fmul8ulx16(sum2, xFilter2); \
xFilter2 = xPtr[2]; \
sPtr = (mlib_u8 *)lineAddr[ySrc] + (3*xSrc); \
d2 = vis_fpadd16(v20, v21)
/***************************************************************/
mlib_status mlib_ImageAffine_u8_3ch_bc (mlib_affine_param *param)
{
DECLAREVAR_BC();
mlib_s32 filterposx, filterposy;
mlib_d64 data0, data1, data2;
mlib_d64 sum0, sum1, sum2;
mlib_d64 row00, row10, row20, row30;
mlib_d64 row01, row11, row21, row31;
mlib_d64 xFilter0, xFilter1, xFilter2, yFilter;
mlib_d64 v00, v10, v20, v30;
mlib_d64 v01, v11, v21, v31;
mlib_d64 v02, v12, v22, v32;
mlib_d64 d0, d1, d2, d3, d4;
mlib_d64 *dpSrc;
mlib_s32 cols, i;
mlib_d64 *xPtr;
union {
mlib_u8 t[4];
mlib_f32 f;
} f0;
const mlib_s16 *mlib_filters_table ;
const mlib_s16 *mlib_filters_table_3;
if (filter == MLIB_BICUBIC) {
mlib_filters_table = mlib_filters_u8_bc;
mlib_filters_table_3 = mlib_filters_u8_bc_3;
} else {
mlib_filters_table = mlib_filters_u8_bc2;
mlib_filters_table_3 = mlib_filters_u8_bc2_3;
}
vis_write_gsr(3 << 3);
MLIB_WRITE_BMASK(0x6789ABCD);
for (j = yStart; j <= yFinish; j ++) {
CLIP(3);
cols = xRight - xLeft + 1;
i = 0;
if (i <= cols - 4) {
NEXT_PIXEL_3BC_U8();
LOAD_BC_U8_3CH_1PIXEL(mlib_filters_table, mlib_filters_table_3);
NEXT_PIXEL_3BC_U8();
BC_U8_3CH(mlib_filters_table, mlib_filters_table_3);
FADD_3BC_U8();
BC_U8_3CH(mlib_filters_table, mlib_filters_table_3);
#pragma pipeloop(0)
for (; i < cols-4; i++) {
STORE_BC_U8_3CH_1PIXEL();
FADD_3BC_U8();
BC_U8_3CH(mlib_filters_table, mlib_filters_table_3);
}
STORE_BC_U8_3CH_1PIXEL();
FADD_3BC_U8();
STORE_BC_U8_3CH_1PIXEL();
RESULT_3BC_U8_1PIXEL();
STORE_BC_U8_3CH_1PIXEL();
LOAD_BC_U8_3CH_1PIXEL(mlib_filters_table, mlib_filters_table_3);
RESULT_3BC_U8_1PIXEL();
STORE_BC_U8_3CH_1PIXEL();
i += 4;
}
for (; i < cols; i++) {
NEXT_PIXEL_3BC_U8();
LOAD_BC_U8_3CH_1PIXEL(mlib_filters_table, mlib_filters_table_3);
RESULT_3BC_U8_1PIXEL();
STORE_BC_U8_3CH_1PIXEL();
}
}
return MLIB_SUCCESS;
}
/***************************************************************/
#define FADD_4BC_U8() \
d0 = vis_fpadd16(d00, d10); \
d1 = vis_fpadd16(d20, d30); \
d0 = vis_fpadd16(d0, d1); \
d2 = vis_fpadd16(d01, d11); \
d3 = vis_fpadd16(d21, d31); \
d2 = vis_fpadd16(d2, d3); \
res = vis_fpack16_pair(d0, d2)
/***************************************************************/
#define LOAD_BC_U8_4CH_1PIXEL(mlib_filters_u8, mlib_filters_u8_4) \
filterposy = (Y >> FILTER_SHIFT) & FILTER_MASK; \
yFilter = *((mlib_d64 *) ((mlib_u8 *)mlib_filters_u8 + filterposy)); \
filterposx = (X >> FILTER_SHIFT) & FILTER_MASK; \
xPtr=((mlib_d64 *)((mlib_u8 *)mlib_filters_u8_4+4*filterposx)); \
xFilter0 = xPtr[0]; \
xFilter1 = xPtr[1]; \
xFilter2 = xPtr[2]; \
xFilter3 = xPtr[3]; \
X += dX; \
Y += dY; \
ALIGN_ADDR(dpSrc, sPtr); \
data0 = dpSrc[0]; \
data1 = dpSrc[1]; \
data2 = dpSrc[2]; \
row00 = vis_faligndata(data0, data1); \
row01 = vis_faligndata(data1, data2); \
sPtr += srcYStride; \
ALIGN_ADDR(dpSrc, sPtr); \
data0 = dpSrc[0]; \
data1 = dpSrc[1]; \
data2 = dpSrc[2]; \
row10 = vis_faligndata(data0, data1); \
row11 = vis_faligndata(data1, data2); \
sPtr += srcYStride; \
ALIGN_ADDR(dpSrc, sPtr); \
data0 = dpSrc[0]; \
data1 = dpSrc[1]; \
data2 = dpSrc[2]; \
row20 = vis_faligndata(data0, data1); \
row21 = vis_faligndata(data1, data2); \
sPtr += srcYStride; \
ALIGN_ADDR(dpSrc, sPtr); \
data0 = dpSrc[0]; \
data1 = dpSrc[1]; \
data2 = dpSrc[2]; \
row30 = vis_faligndata(data0, data1); \
row31 = vis_faligndata(data1, data2)
/***************************************************************/
#define NEXT_PIXEL_4BC_U8() \
xSrc = (X>>MLIB_SHIFT)-1; \
ySrc = (Y>>MLIB_SHIFT)-1; \
sPtr = (mlib_u8 *)lineAddr[ySrc] + (4*xSrc)
/***************************************************************/
#define RESULT_4BC_U8_1PIXEL(ind) \
v00 = vis_fmul8x16au(vis_read_hi(row00), vis_read_hi(yFilter)); \
v01 = vis_fmul8x16au(vis_read_lo(row00), vis_read_hi(yFilter)); \
v02 = vis_fmul8x16au(vis_read_hi(row01), vis_read_hi(yFilter)); \
v03 = vis_fmul8x16au(vis_read_lo(row01), vis_read_hi(yFilter)); \
v10 = vis_fmul8x16al(vis_read_hi(row10), vis_read_hi(yFilter)); \
v11 = vis_fmul8x16al(vis_read_lo(row10), vis_read_hi(yFilter)); \
sum0 = vis_fpadd16(v00, v10); \
v12 = vis_fmul8x16al(vis_read_hi(row11), vis_read_hi(yFilter)); \
sum1 = vis_fpadd16(v01, v11); \
v13 = vis_fmul8x16al(vis_read_lo(row11), vis_read_hi(yFilter)); \
sum2 = vis_fpadd16(v02, v12); \
v20 = vis_fmul8x16au(vis_read_hi(row20), vis_read_lo(yFilter)); \
sum3 = vis_fpadd16(v03, v13); \
v21 = vis_fmul8x16au(vis_read_lo(row20), vis_read_lo(yFilter)); \
sum0 = vis_fpadd16(sum0, v20); \
v22 = vis_fmul8x16au(vis_read_hi(row21), vis_read_lo(yFilter)); \
sum1 = vis_fpadd16(sum1, v21); \
v23 = vis_fmul8x16au(vis_read_lo(row21), vis_read_lo(yFilter)); \
sum2 = vis_fpadd16(sum2, v22); \
v30 = vis_fmul8x16al(vis_read_hi(row30), vis_read_lo(yFilter)); \
sum3 = vis_fpadd16(sum3, v23); \
v31 = vis_fmul8x16al(vis_read_lo(row30), vis_read_lo(yFilter)); \
sum0 = vis_fpadd16(sum0, v30); \
v32 = vis_fmul8x16al(vis_read_hi(row31), vis_read_lo(yFilter)); \
sum1 = vis_fpadd16(sum1, v31); \
v33 = vis_fmul8x16al(vis_read_lo(row31), vis_read_lo(yFilter)); \
sum2 = vis_fpadd16(sum2, v32); \
v00 = vis_fmul8sux16(sum0, xFilter0); \
sum3 = vis_fpadd16(sum3, v33); \
v01 = vis_fmul8ulx16(sum0, xFilter0); \
v10 = vis_fmul8sux16(sum1, xFilter1); \
d0##ind = vis_fpadd16(v00, v01); \
v11 = vis_fmul8ulx16(sum1, xFilter1); \
v20 = vis_fmul8sux16(sum2, xFilter2); \
d1##ind = vis_fpadd16(v10, v11); \
v21 = vis_fmul8ulx16(sum2, xFilter2); \
v30 = vis_fmul8sux16(sum3, xFilter3); \
d2##ind = vis_fpadd16(v20, v21); \
v31 = vis_fmul8ulx16(sum3, xFilter3); \
d3##ind = vis_fpadd16(v30, v31)
/***************************************************************/
#define BC_U8_4CH(ind, mlib_filters_u8, mlib_filters_u8_4) \
v00 = vis_fmul8x16au(vis_read_hi(row00), vis_read_hi(yFilter)); \
v01 = vis_fmul8x16au(vis_read_lo(row00), vis_read_hi(yFilter)); \
v02 = vis_fmul8x16au(vis_read_hi(row01), vis_read_hi(yFilter)); \
v03 = vis_fmul8x16au(vis_read_lo(row01), vis_read_hi(yFilter)); \
ALIGN_ADDR(dpSrc, sPtr); \
data0 = dpSrc[0]; \
filterposy = (Y >> FILTER_SHIFT); \
v10 = vis_fmul8x16al(vis_read_hi(row10), vis_read_hi(yFilter)); \
data1 = dpSrc[1]; \
v11 = vis_fmul8x16al(vis_read_lo(row10), vis_read_hi(yFilter)); \
sum0 = vis_fpadd16(v00, v10); \
data2 = dpSrc[2]; \
row00 = vis_faligndata(data0, data1); \
v12 = vis_fmul8x16al(vis_read_hi(row11), vis_read_hi(yFilter)); \
row01 = vis_faligndata(data1, data2); \
filterposx = (X >> FILTER_SHIFT); \
v13 = vis_fmul8x16al(vis_read_lo(row11), vis_read_hi(yFilter)); \
sPtr += srcYStride; \
ALIGN_ADDR(dpSrc, sPtr); \
v20 = vis_fmul8x16au(vis_read_hi(row20), vis_read_lo(yFilter)); \
sum1 = vis_fpadd16(v01, v11); \
data0 = dpSrc[0]; \
X += dX; \
data1 = dpSrc[1]; \
v21 = vis_fmul8x16au(vis_read_lo(row20), vis_read_lo(yFilter)); \
sum2 = vis_fpadd16(v02, v12); \
data2 = dpSrc[2]; \
row10 = vis_faligndata(data0, data1); \
v22 = vis_fmul8x16au(vis_read_hi(row21), vis_read_lo(yFilter)); \
row11 = vis_faligndata(data1, data2); \
sPtr += srcYStride; \
ALIGN_ADDR(dpSrc, sPtr); \
v23 = vis_fmul8x16au(vis_read_lo(row21), vis_read_lo(yFilter)); \
sum3 = vis_fpadd16(v03, v13); \
Y += dY; \
xSrc = (X>>MLIB_SHIFT)-1; \
v30 = vis_fmul8x16al(vis_read_hi(row30), vis_read_lo(yFilter)); \
sum0 = vis_fpadd16(sum0, v20); \
data0 = dpSrc[0]; \
ySrc = (Y>>MLIB_SHIFT)-1; \
data1 = dpSrc[1]; \
v31 = vis_fmul8x16al(vis_read_lo(row30), vis_read_lo(yFilter)); \
sum1 = vis_fpadd16(sum1, v21); \
data2 = dpSrc[2]; \
filterposy &= FILTER_MASK; \
row20 = vis_faligndata(data0, data1); \
v32 = vis_fmul8x16al(vis_read_hi(row31), vis_read_lo(yFilter)); \
row21 = vis_faligndata(data1, data2); \
sPtr += srcYStride; \
filterposx &= FILTER_MASK; \
v33 = vis_fmul8x16al(vis_read_lo(row31), vis_read_lo(yFilter)); \
sum2 = vis_fpadd16(sum2, v22); \
ALIGN_ADDR(dpSrc, sPtr); \
sum3 = vis_fpadd16(sum3, v23); \
sum0 = vis_fpadd16(sum0, v30); \
data0 = dpSrc[0]; \
sum1 = vis_fpadd16(sum1, v31); \
v00 = vis_fmul8sux16(sum0, xFilter0); \
data1 = dpSrc[1]; \
sum2 = vis_fpadd16(sum2, v32); \
v01 = vis_fmul8ulx16(sum0, xFilter0); \
sum3 = vis_fpadd16(sum3, v33); \
data2 = dpSrc[2]; \
row30 = vis_faligndata(data0, data1); \
v10 = vis_fmul8sux16(sum1, xFilter1); \
d0##ind = vis_fpadd16(v00, v01); \
row31 = vis_faligndata(data1, data2); \
yFilter = *((mlib_d64 *)((mlib_u8 *)mlib_filters_u8 + filterposy)); \
/**代码未完, 请加载全部代码(NowJava.com).**/
关注时代Java
关注时代Java