/*
* 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 "vis_proto.h"
#include "mlib_image.h"
#include "mlib_v_ImageLookUpFunc.h"
/***************************************************************/
static void mlib_v_ImageLookUpSI_U8_S16_2_SrcOff0_D1(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_f32 *table);
static void mlib_v_ImageLookUpSI_U8_S16_2_DstNonAl_D1(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_f32 *table);
static void mlib_v_ImageLookUpSI_U8_S16_2_DstA8D1_SMALL(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_s16 **table);
static void mlib_v_ImageLookUpSI_U8_S16_2_D1_SMALL(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_s16 **table);
static void mlib_v_ImageLookUpSI_U8_S16_3_SrcOff0_D1(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_d64 *table);
static void mlib_v_ImageLookUpSI_U8_S16_3_SrcOff1_D1(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_d64 *table);
static void mlib_v_ImageLookUpSI_U8_S16_3_SrcOff2_D1(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_d64 *table);
static void mlib_v_ImageLookUpSI_U8_S16_3_SrcOff3_D1(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_d64 *table);
static void mlib_v_ImageLookUpSI_U8_S16_3_D1_SMALL(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_s16 **table);
static void mlib_v_ImageLookUpSI_U8_S16_4_DstA8D1_D1(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_d64 *table);
static void mlib_v_ImageLookUpSI_U8_S16_4_DstNonAl_D1(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_d64 *table);
static void mlib_v_ImageLookUpSI_U8_S16_4_DstOff0_D1_SMALL(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_s16 **table);
static void mlib_v_ImageLookUpSI_U8_S16_4_DstOff1_D1_SMALL(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_s16 **table);
static void mlib_v_ImageLookUpSI_U8_S16_4_DstOff2_D1_SMALL(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_s16 **table);
static void mlib_v_ImageLookUpSI_U8_S16_4_DstOff3_D1_SMALL(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_s16 **table);
/***************************************************************/
#define VIS_LD_U16_I(X, Y) vis_ld_u16_i((void *)(X), (Y))
/***************************************************************/
void mlib_v_ImageLookUpSI_U8_S16_2_SrcOff0_D1(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_f32 *table)
{
mlib_u32 *sa; /* aligned pointer to source data */
mlib_u8 *sp; /* pointer to source data */
mlib_u32 s0; /* source data */
mlib_f32 *dp; /* aligned pointer to destination */
mlib_f32 acc0, acc1; /* destination data */
mlib_f32 acc2, acc3; /* destination data */
mlib_s32 i; /* loop variable */
mlib_u32 s00, s01, s02, s03;
sa = (mlib_u32 *) src;
dp = (mlib_f32 *) dst;
i = 0;
if (xsize >= 4) {
s0 = *sa++;
s00 = (s0 >> 22) & 0x3FC;
s01 = (s0 >> 14) & 0x3FC;
#pragma pipeloop(0)
for (i = 0; i <= xsize - 8; i += 4, dp += 4) {
s02 = (s0 >> 6) & 0x3FC;
s03 = (s0 << 2) & 0x3FC;
acc0 = *(mlib_f32 *) ((mlib_u8 *) table + s00);
acc1 = *(mlib_f32 *) ((mlib_u8 *) table + s01);
acc2 = *(mlib_f32 *) ((mlib_u8 *) table + s02);
acc3 = *(mlib_f32 *) ((mlib_u8 *) table + s03);
s0 = *sa++;
s00 = (s0 >> 22) & 0x3FC;
s01 = (s0 >> 14) & 0x3FC;
dp[0] = acc0;
dp[1] = acc1;
dp[2] = acc2;
dp[3] = acc3;
}
s02 = (s0 >> 6) & 0x3FC;
s03 = (s0 << 2) & 0x3FC;
acc0 = *(mlib_f32 *) ((mlib_u8 *) table + s00);
acc1 = *(mlib_f32 *) ((mlib_u8 *) table + s01);
acc2 = *(mlib_f32 *) ((mlib_u8 *) table + s02);
acc3 = *(mlib_f32 *) ((mlib_u8 *) table + s03);
dp[0] = acc0;
dp[1] = acc1;
dp[2] = acc2;
dp[3] = acc3;
dp += 4;
i += 4;
}
sp = (mlib_u8 *) sa;
if (i <= xsize - 2) {
*dp++ = table[sp[0]];
*dp++ = table[sp[1]];
i += 2;
sp += 2;
}
if (i < xsize)
*dp = table[sp[0]];
}
/***************************************************************/
void mlib_v_ImageLookUpSI_U8_S16_2_DstNonAl_D1(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_f32 *table)
{
mlib_u32 *sa; /* aligned pointer to source data */
mlib_u8 *sp; /* pointer to source data */
mlib_u32 s0; /* source data */
mlib_s16 *dl; /* pointer to start of destination */
mlib_d64 *dp; /* aligned pointer to destination */
mlib_d64 acc0, acc1, acc2; /* destination data */
mlib_s32 i; /* loop variable */
mlib_s16 *dend; /* pointer to end of destination */
mlib_s32 emask; /* edge mask */
mlib_s32 off;
mlib_u32 s00, s01, s02, s03;
sa = (mlib_u32 *) src;
sp = (void *)src;
dl = dst;
dend = dl + (xsize << 1) - 1;
dp = (mlib_d64 *) ((mlib_addr) dl & (~7));
off = (mlib_addr) dp - (mlib_addr) dl;
vis_alignaddr(dp, off);
emask = vis_edge16(dl, dend);
acc0 = vis_freg_pair(table[sp[0]], table[sp[1]]);
vis_pst_16(vis_faligndata(acc0, acc0), dp++, emask);
sp += 2;
xsize -= 2;
if (xsize >= 2) {
acc1 = vis_freg_pair(table[sp[0]], table[sp[1]]);
*dp++ = vis_faligndata(acc0, acc1);
acc0 = acc1;
sp += 2;
xsize -= 2;
}
sa++;
i = 0;
if (xsize >= 4) {
s0 = *sa++;
s00 = (s0 >> 22) & 0x3FC;
s01 = (s0 >> 14) & 0x3FC;
#pragma pipeloop(0)
for (i = 0; i <= xsize - 8; i += 4, dp += 2) {
s02 = (s0 >> 6) & 0x3FC;
s03 = (s0 << 2) & 0x3FC;
acc1 = vis_freg_pair(*(mlib_f32 *) ((mlib_u8 *) table + s00),
*(mlib_f32 *) ((mlib_u8 *) table + s01));
acc2 = vis_freg_pair(*(mlib_f32 *) ((mlib_u8 *) table + s02),
*(mlib_f32 *) ((mlib_u8 *) table + s03));
s0 = *sa++;
s00 = (s0 >> 22) & 0x3FC;
s01 = (s0 >> 14) & 0x3FC;
dp[0] = vis_faligndata(acc0, acc1);
dp[1] = vis_faligndata(acc1, acc2);
acc0 = acc2;
}
s02 = (s0 >> 6) & 0x3FC;
s03 = (s0 << 2) & 0x3FC;
acc1 = vis_freg_pair(*(mlib_f32 *) ((mlib_u8 *) table + s00),
*(mlib_f32 *) ((mlib_u8 *) table + s01));
acc2 = vis_freg_pair(*(mlib_f32 *) ((mlib_u8 *) table + s02),
*(mlib_f32 *) ((mlib_u8 *) table + s03));
dp[0] = vis_faligndata(acc0, acc1);
dp[1] = vis_faligndata(acc1, acc2);
acc0 = acc2;
sp = (mlib_u8 *) sa;
dp += 2;
i += 4;
}
if (i <= xsize - 2) {
acc1 = vis_freg_pair(table[sp[0]], table[sp[1]]);
*dp++ = vis_faligndata(acc0, acc1);
acc0 = acc1;
i += 2;
sp += 2;
}
if ((mlib_addr) dp <= (mlib_addr) dend) {
emask = vis_edge16(dp, dend);
acc1 = vis_freg_pair(table[sp[0]], table[sp[1]]);
vis_pst_16(vis_faligndata(acc0, acc1), dp++, emask);
}
if ((mlib_addr) dp <= (mlib_addr) dend) {
emask = vis_edge16(dp, dend);
vis_pst_16(vis_faligndata(acc1, acc1), dp++, emask);
}
}
/***************************************************************/
void mlib_v_ImageLookUpSI_U8_S16_2_DstA8D1_SMALL(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_s16 **table)
{
mlib_u8 *sp; /* pointer to source data */
mlib_u32 s0, s1; /* source data */
mlib_s16 *dl; /* pointer to start of destination */
mlib_d64 *dp; /* aligned pointer to destination */
mlib_d64 t0, t1, t2; /* destination data */
mlib_d64 t3, acc; /* destination data */
mlib_s32 i; /* loop variable */
const mlib_s16 *tab0 = table[0];
const mlib_s16 *tab1 = table[1];
sp = (void *)src;
dl = dst;
dp = (mlib_d64 *) dl;
vis_alignaddr((void *)0, 6);
if (xsize >= 2) {
s0 = (sp[0] << 1);
s1 = (sp[1] << 1);
sp += 2;
#pragma pipeloop(0)
for (i = 0; i <= xsize - 4; i += 2, sp += 2) {
t3 = VIS_LD_U16_I(tab1, s1);
t2 = VIS_LD_U16_I(tab0, s1);
t1 = VIS_LD_U16_I(tab1, s0);
t0 = VIS_LD_U16_I(tab0, s0);
acc = vis_faligndata(t3, acc);
acc = vis_faligndata(t2, acc);
acc = vis_faligndata(t1, acc);
acc = vis_faligndata(t0, acc);
s0 = (sp[0] << 1);
s1 = (sp[1] << 1);
*dp++ = acc;
}
t3 = VIS_LD_U16_I(tab1, s1);
t2 = VIS_LD_U16_I(tab0, s1);
t1 = VIS_LD_U16_I(tab1, s0);
t0 = VIS_LD_U16_I(tab0, s0);
acc = vis_faligndata(t3, acc);
acc = vis_faligndata(t2, acc);
acc = vis_faligndata(t1, acc);
acc = vis_faligndata(t0, acc);
*dp++ = acc;
}
if ((xsize & 1) != 0) {
s0 = (sp[0] << 1);
t1 = VIS_LD_U16_I(tab1, s0);
t0 = VIS_LD_U16_I(tab0, s0);
acc = vis_faligndata(t1, acc);
acc = vis_faligndata(t0, acc);
*(mlib_f32 *) dp = vis_read_hi(acc);
}
}
/***************************************************************/
void mlib_v_ImageLookUpSI_U8_S16_2_D1_SMALL(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_s16 **table)
{
mlib_u8 *sp; /* pointer to source data */
mlib_u32 s0, s1, s2; /* source data */
mlib_s16 *dl; /* pointer to start of destination */
mlib_d64 *dp; /* aligned pointer to destination */
mlib_d64 t0, t1, t2; /* destination data */
mlib_d64 t3, acc; /* destination data */
mlib_s32 i; /* loop variable */
const mlib_s16 *tab0 = table[0];
const mlib_s16 *tab1 = table[1];
sp = (void *)src;
dl = dst;
vis_alignaddr((void *)0, 6);
s0 = *sp++;
*dl++ = tab0[s0];
dp = (mlib_d64 *) dl;
xsize--;
s0 <<= 1;
if (xsize >= 2) {
s1 = (sp[0] << 1);
s2 = (sp[1] << 1);
sp += 2;
#pragma pipeloop(0)
for (i = 0; i <= xsize - 4; i += 2, sp += 2) {
t3 = VIS_LD_U16_I(tab0, s2);
t2 = VIS_LD_U16_I(tab1, s1);
t1 = VIS_LD_U16_I(tab0, s1);
t0 = VIS_LD_U16_I(tab1, s0);
acc = vis_faligndata(t3, acc);
acc = vis_faligndata(t2, acc);
acc = vis_faligndata(t1, acc);
acc = vis_faligndata(t0, acc);
s0 = s2;
s1 = (sp[0] << 1);
s2 = (sp[1] << 1);
*dp++ = acc;
}
t3 = VIS_LD_U16_I(tab0, s2);
t2 = VIS_LD_U16_I(tab1, s1);
t1 = VIS_LD_U16_I(tab0, s1);
t0 = VIS_LD_U16_I(tab1, s0);
acc = vis_faligndata(t3, acc);
acc = vis_faligndata(t2, acc);
acc = vis_faligndata(t1, acc);
acc = vis_faligndata(t0, acc);
s0 = s2;
*dp++ = acc;
}
dl = (mlib_s16 *) dp;
if ((xsize & 1) != 0) {
s1 = (sp[0] << 1);
t1 = VIS_LD_U16_I(tab0, s1);
t0 = VIS_LD_U16_I(tab1, s0);
acc = vis_faligndata(t1, acc);
acc = vis_faligndata(t0, acc);
*(mlib_f32 *) dp = vis_read_hi(acc);
s0 = s1;
dl += 2;
}
s0 >>= 1;
*dl = tab1[s0];
}
/***************************************************************/
void mlib_v_ImageLookUpSI_U8_S16_2(const mlib_u8 *src,
mlib_s32 slb,
mlib_s16 *dst,
mlib_s32 dlb,
mlib_s32 xsize,
mlib_s32 ysize,
const mlib_s16 **table)
{
if ((xsize * ysize) < 550) {
mlib_u8 *sl;
mlib_s16 *dl;
mlib_s32 j;
const mlib_s16 *tab0 = table[0];
const mlib_s16 *tab1 = table[1];
sl = (void *)src;
dl = dst;
/* row loop */
for (j = 0; j < ysize; j++) {
mlib_u8 *sp = sl;
mlib_s16 *dp = dl;
mlib_s32 off, s0, size = xsize;
off = ((8 - ((mlib_addr) dp & 7)) & 7);
if ((off >= 4) && (size > 0)) {
s0 = *sp++;
*dp++ = tab0[s0];
*dp++ = tab1[s0];
size--;
}
if (size > 0) {
if (((mlib_addr) dp & 7) == 0) {
mlib_v_ImageLookUpSI_U8_S16_2_DstA8D1_SMALL(sp, dp, size, table);
}
else {
mlib_v_ImageLookUpSI_U8_S16_2_D1_SMALL(sp, dp, size, table);
}
}
sl = (mlib_u8 *) ((mlib_u8 *) sl + slb);
dl = (mlib_s16 *) ((mlib_u8 *) dl + dlb);
}
}
else {
mlib_u8 *sl;
mlib_s16 *dl;
mlib_u32 tab[256];
mlib_u16 *tab0 = (mlib_u16 *) table[0];
mlib_u16 *tab1 = (mlib_u16 *) table[1];
mlib_s32 i, j;
mlib_u32 s0, s1, s2;
s0 = tab0[0];
s1 = tab1[0];
for (i = 1; i < 256; i++) {
s2 = (s0 << 16) + s1;
s0 = tab0[i];
s1 = tab1[i];
tab[i - 1] = s2;
}
s2 = (s0 << 16) + s1;
tab[255] = s2;
sl = (void *)src;
dl = dst;
/* row loop */
for (j = 0; j < ysize; j++) {
mlib_u8 *sp = sl;
mlib_s16 *dp = dl;
mlib_s32 off, s0, size = xsize;
if (((mlib_addr) dp & 3) == 0) {
off = (4 - (mlib_addr) sp & 3) & 3;
off = (off < size) ? off : size;
#pragma pipeloop(0)
for (i = 0; i < off; i++, sp++) {
*(mlib_u32 *) dp = tab[(*sp)];
dp += 2;
}
size -= off;
if (size > 0) {
mlib_v_ImageLookUpSI_U8_S16_2_SrcOff0_D1(sp, dp, size,
(mlib_f32 *) tab);
}
}
else {
off = ((4 - ((mlib_addr) sp & 3)) & 3);
off = (off < size) ? off : size;
for (i = 0; i < off; i++) {
s0 = tab[(*sp)];
*dp++ = (s0 >> 16);
*dp++ = (s0 & 0xFFFF);
size--;
sp++;
}
if (size > 0) {
mlib_v_ImageLookUpSI_U8_S16_2_DstNonAl_D1(sp, dp, size,
(mlib_f32 *) tab);
}
}
sl = (mlib_u8 *) ((mlib_u8 *) sl + slb);
dl = (mlib_s16 *) ((mlib_u8 *) dl + dlb);
}
}
}
/***************************************************************/
void mlib_v_ImageLookUpSI_U8_S16_3_SrcOff0_D1(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_d64 *table)
{
mlib_u8 *sp; /* pointer to source data */
mlib_u32 *sa; /* aligned pointer to source data */
mlib_u32 s0; /* source data */
mlib_s16 *dl; /* pointer to start of destination */
mlib_d64 *dp; /* aligned pointer to destination */
mlib_d64 t0, t1, t2, t3; /* destination data */
mlib_d64 acc0, acc1, acc2; /* destination data */
mlib_s32 i; /* loop variable */
mlib_s16 *ptr;
dl = dst;
sp = (void *)src;
dp = (mlib_d64 *) dl;
sa = (mlib_u32 *) sp;
vis_alignaddr((void *)0, 6);
i = 0;
if (xsize >= 4) {
s0 = *sa++;
#pragma pipeloop(0)
for (i = 0; i <= xsize - 8; i += 4, dp += 3) {
t0 = *(mlib_d64 *) ((mlib_u8 *) table + ((s0 >> 21) & 0x7F8));
t1 = *(mlib_d64 *) ((mlib_u8 *) table + ((s0 >> 13) & 0x7F8));
t2 = *(mlib_d64 *) ((mlib_u8 *) table + ((s0 >> 5) & 0x7F8));
t3 = *(mlib_d64 *) ((mlib_u8 *) table + ((s0 << 3) & 0x7F8));
acc0 = vis_faligndata(t0, t0);
acc1 = vis_faligndata(acc0, acc0);
acc2 = vis_faligndata(acc0, t1);
acc0 = vis_faligndata(acc1, acc1);
acc1 = vis_faligndata(acc1, acc2);
acc2 = vis_faligndata(acc2, t2);
acc0 = vis_faligndata(acc0, acc1);
acc1 = vis_faligndata(acc1, acc2);
acc2 = vis_faligndata(acc2, t3);
s0 = *sa++;
dp[0] = acc0;
dp[1] = acc1;
dp[2] = acc2;
}
t0 = *(mlib_d64 *) ((mlib_u8 *) table + ((s0 >> 21) & 0x7F8));
t1 = *(mlib_d64 *) ((mlib_u8 *) table + ((s0 >> 13) & 0x7F8));
t2 = *(mlib_d64 *) ((mlib_u8 *) table + ((s0 >> 5) & 0x7F8));
t3 = *(mlib_d64 *) ((mlib_u8 *) table + ((s0 << 3) & 0x7F8));
acc0 = vis_faligndata(t0, t0);
acc1 = vis_faligndata(acc0, acc0);
acc2 = vis_faligndata(acc0, t1);
acc0 = vis_faligndata(acc1, acc1);
acc1 = vis_faligndata(acc1, acc2);
acc2 = vis_faligndata(acc2, t2);
acc0 = vis_faligndata(acc0, acc1);
acc1 = vis_faligndata(acc1, acc2);
acc2 = vis_faligndata(acc2, t3);
dp[0] = acc0;
dp[1] = acc1;
dp[2] = acc2;
i += 4;
dp += 3;
}
dl = (mlib_s16 *) dp;
#pragma pipeloop(0)
for (; i < xsize; i++) {
ptr = (mlib_s16 *) (table + src[i]);
dl[0] = ptr[0];
dl[1] = ptr[1];
dl[2] = ptr[2];
dl += 3;
}
}
/***************************************************************/
void mlib_v_ImageLookUpSI_U8_S16_3_SrcOff1_D1(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_d64 *table)
{
mlib_u8 *sp; /* pointer to source data */
mlib_u32 *sa; /* aligned pointer to source data */
mlib_u32 s0, s1; /* source data */
mlib_s16 *dl; /* pointer to start of destination */
mlib_d64 *dp; /* aligned pointer to destination */
mlib_d64 t0, t1, t2, t3; /* destination data */
mlib_d64 acc0, acc1, acc2; /* destination data */
mlib_s32 i; /* loop variable */
mlib_s16 *ptr;
dl = dst;
sp = (void *)src;
dp = (mlib_d64 *) dl;
sa = (mlib_u32 *) (sp - 1);
i = 0;
s0 = *sa++;
vis_alignaddr((void *)0, 6);
if (xsize >= 4) {
s1 = *sa++;
#pragma pipeloop(0)
for (i = 0; i <= xsize - 8; i += 4, dp += 3) {
t0 = *(mlib_d64 *) ((mlib_u8 *) table + ((s0 >> 13) & 0x7F8));
t1 = *(mlib_d64 *) ((mlib_u8 *) table + ((s0 >> 5) & 0x7F8));
t2 = *(mlib_d64 *) ((mlib_u8 *) table + ((s0 << 3) & 0x7F8));
t3 = *(mlib_d64 *) ((mlib_u8 *) table + ((s1 >> 21) & 0x7F8));
acc0 = vis_faligndata(t0, t0);
acc1 = vis_faligndata(acc0, acc0);
acc2 = vis_faligndata(acc0, t1);
acc0 = vis_faligndata(acc1, acc1);
acc1 = vis_faligndata(acc1, acc2);
acc2 = vis_faligndata(acc2, t2);
acc0 = vis_faligndata(acc0, acc1);
acc1 = vis_faligndata(acc1, acc2);
acc2 = vis_faligndata(acc2, t3);
s0 = s1;
s1 = *sa++;
dp[0] = acc0;
dp[1] = acc1;
dp[2] = acc2;
}
t0 = *(mlib_d64 *) ((mlib_u8 *) table + ((s0 >> 13) & 0x7F8));
t1 = *(mlib_d64 *) ((mlib_u8 *) table + ((s0 >> 5) & 0x7F8));
t2 = *(mlib_d64 *) ((mlib_u8 *) table + ((s0 << 3) & 0x7F8));
t3 = *(mlib_d64 *) ((mlib_u8 *) table + ((s1 >> 21) & 0x7F8));
acc0 = vis_faligndata(t0, t0);
acc1 = vis_faligndata(acc0, acc0);
acc2 = vis_faligndata(acc0, t1);
acc0 = vis_faligndata(acc1, acc1);
acc1 = vis_faligndata(acc1, acc2);
acc2 = vis_faligndata(acc2, t2);
acc0 = vis_faligndata(acc0, acc1);
acc1 = vis_faligndata(acc1, acc2);
acc2 = vis_faligndata(acc2, t3);
dp[0] = acc0;
dp[1] = acc1;
dp[2] = acc2;
i += 4;
dp += 3;
}
dl = (mlib_s16 *) dp;
#pragma pipeloop(0)
for (; i < xsize; i++) {
ptr = (mlib_s16 *) (table + src[i]);
dl[0] = ptr[0];
dl[1] = ptr[1];
dl[2] = ptr[2];
dl += 3;
}
}
/***************************************************************/
void mlib_v_ImageLookUpSI_U8_S16_3_SrcOff2_D1(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_d64 *table)
{
mlib_u8 *sp; /* pointer to source data */
mlib_u32 *sa; /* aligned pointer to source data */
mlib_u32 s0, s1; /* source data */
mlib_s16 *dl; /* pointer to start of destination */
mlib_d64 *dp; /* aligned pointer to destination */
mlib_d64 t0, t1, t2, t3; /* destination data */
mlib_d64 acc0, acc1, acc2; /* destination data */
mlib_s32 i; /* loop variable */
mlib_s16 *ptr;
dl = dst;
sp = (void *)src;
dp = (mlib_d64 *) dl;
sa = (mlib_u32 *) (sp - 2);
i = 0;
s0 = *sa++;
vis_alignaddr((void *)0, 6);
if (xsize >= 4) {
s1 = *sa++;
#pragma pipeloop(0)
for (i = 0; i <= xsize - 8; i += 4, dp += 3) {
t0 = *(mlib_d64 *) ((mlib_u8 *) table + ((s0 >> 5) & 0x7F8));
t1 = *(mlib_d64 *) ((mlib_u8 *) table + ((s0 << 3) & 0x7F8));
t2 = *(mlib_d64 *) ((mlib_u8 *) table + ((s1 >> 21) & 0x7F8));
t3 = *(mlib_d64 *) ((mlib_u8 *) table + ((s1 >> 13) & 0x7F8));
acc0 = vis_faligndata(t0, t0);
acc1 = vis_faligndata(acc0, acc0);
acc2 = vis_faligndata(acc0, t1);
acc0 = vis_faligndata(acc1, acc1);
acc1 = vis_faligndata(acc1, acc2);
acc2 = vis_faligndata(acc2, t2);
acc0 = vis_faligndata(acc0, acc1);
acc1 = vis_faligndata(acc1, acc2);
acc2 = vis_faligndata(acc2, t3);
s0 = s1;
s1 = *sa++;
dp[0] = acc0;
dp[1] = acc1;
dp[2] = acc2;
}
t0 = *(mlib_d64 *) ((mlib_u8 *) table + ((s0 >> 5) & 0x7F8));
t1 = *(mlib_d64 *) ((mlib_u8 *) table + ((s0 << 3) & 0x7F8));
t2 = *(mlib_d64 *) ((mlib_u8 *) table + ((s1 >> 21) & 0x7F8));
t3 = *(mlib_d64 *) ((mlib_u8 *) table + ((s1 >> 13) & 0x7F8));
acc0 = vis_faligndata(t0, t0);
acc1 = vis_faligndata(acc0, acc0);
acc2 = vis_faligndata(acc0, t1);
acc0 = vis_faligndata(acc1, acc1);
acc1 = vis_faligndata(acc1, acc2);
acc2 = vis_faligndata(acc2, t2);
acc0 = vis_faligndata(acc0, acc1);
acc1 = vis_faligndata(acc1, acc2);
acc2 = vis_faligndata(acc2, t3);
dp[0] = acc0;
dp[1] = acc1;
dp[2] = acc2;
i += 4;
dp += 3;
}
dl = (mlib_s16 *) dp;
#pragma pipeloop(0)
for (; i < xsize; i++) {
ptr = (mlib_s16 *) (table + src[i]);
dl[0] = ptr[0];
dl[1] = ptr[1];
dl[2] = ptr[2];
dl += 3;
}
}
/***************************************************************/
void mlib_v_ImageLookUpSI_U8_S16_3_SrcOff3_D1(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_d64 *table)
{
mlib_u8 *sp; /* pointer to source data */
mlib_u32 *sa; /* aligned pointer to source data */
mlib_u32 s0, s1; /* source data */
mlib_s16 *dl; /* pointer to start of destination */
mlib_d64 *dp; /* aligned pointer to destination */
mlib_d64 t0, t1, t2, t3; /* destination data */
mlib_d64 acc0, acc1, acc2; /* destination data */
mlib_s32 i; /* loop variable */
mlib_s16 *ptr;
dl = dst;
sp = (void *)src;
dp = (mlib_d64 *) dl;
sa = (mlib_u32 *) (sp - 3);
i = 0;
s0 = *sa++;
vis_alignaddr((void *)0, 6);
if (xsize >= 4) {
s1 = *sa++;
#pragma pipeloop(0)
for (i = 0; i <= xsize - 8; i += 4, dp += 3) {
t0 = *(mlib_d64 *) ((mlib_u8 *) table + ((s0 << 3) & 0x7F8));
t1 = *(mlib_d64 *) ((mlib_u8 *) table + ((s1 >> 21) & 0x7F8));
t2 = *(mlib_d64 *) ((mlib_u8 *) table + ((s1 >> 13) & 0x7F8));
t3 = *(mlib_d64 *) ((mlib_u8 *) table + ((s1 >> 5) & 0x7F8));
acc0 = vis_faligndata(t0, t0);
acc1 = vis_faligndata(acc0, acc0);
acc2 = vis_faligndata(acc0, t1);
acc0 = vis_faligndata(acc1, acc1);
acc1 = vis_faligndata(acc1, acc2);
acc2 = vis_faligndata(acc2, t2);
acc0 = vis_faligndata(acc0, acc1);
acc1 = vis_faligndata(acc1, acc2);
acc2 = vis_faligndata(acc2, t3);
s0 = s1;
s1 = *sa++;
dp[0] = acc0;
dp[1] = acc1;
dp[2] = acc2;
}
t0 = *(mlib_d64 *) ((mlib_u8 *) table + ((s0 << 3) & 0x7F8));
t1 = *(mlib_d64 *) ((mlib_u8 *) table + ((s1 >> 21) & 0x7F8));
t2 = *(mlib_d64 *) ((mlib_u8 *) table + ((s1 >> 13) & 0x7F8));
t3 = *(mlib_d64 *) ((mlib_u8 *) table + ((s1 >> 5) & 0x7F8));
acc0 = vis_faligndata(t0, t0);
acc1 = vis_faligndata(acc0, acc0);
acc2 = vis_faligndata(acc0, t1);
acc0 = vis_faligndata(acc1, acc1);
acc1 = vis_faligndata(acc1, acc2);
acc2 = vis_faligndata(acc2, t2);
acc0 = vis_faligndata(acc0, acc1);
acc1 = vis_faligndata(acc1, acc2);
acc2 = vis_faligndata(acc2, t3);
dp[0] = acc0;
dp[1] = acc1;
dp[2] = acc2;
i += 4;
dp += 3;
}
dl = (mlib_s16 *) dp;
#pragma pipeloop(0)
for (; i < xsize; i++) {
ptr = (mlib_s16 *) (table + src[i]);
dl[0] = ptr[0];
dl[1] = ptr[1];
dl[2] = ptr[2];
dl += 3;
}
}
/***************************************************************/
void mlib_v_ImageLookUpSI_U8_S16_3_D1_SMALL(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_s16 **table)
{
mlib_u8 *sp; /* pointer to source data */
mlib_s16 *dl; /* pointer to start of destination */
mlib_d64 *dp; /* aligned pointer to destination */
mlib_d64 t0, t1, t2, t3; /* destination data */
mlib_d64 acc0, acc1, acc2; /* destination data */
mlib_s32 i; /* loop variable */
const mlib_s16 *tab0 = table[0];
const mlib_s16 *tab1 = table[1];
const mlib_s16 *tab2 = table[2];
mlib_u32 s00, s01, s02, s03;
sp = (void *)src;
dl = dst;
dp = (mlib_d64 *) dl;
vis_alignaddr((void *)0, 6);
i = 0;
if (xsize >= 4) {
s00 = (sp[0] << 1);
s01 = (sp[1] << 1);
s02 = (sp[2] << 1);
s03 = (sp[3] << 1);
sp += 4;
#pragma pipeloop(0)
for (i = 0; i <= xsize - 8; i += 4, sp += 4) {
t3 = VIS_LD_U16_I(tab0, s01);
t2 = VIS_LD_U16_I(tab2, s00);
t1 = VIS_LD_U16_I(tab1, s00);
t0 = VIS_LD_U16_I(tab0, s00);
acc0 = vis_faligndata(t3, acc0);
acc0 = vis_faligndata(t2, acc0);
acc0 = vis_faligndata(t1, acc0);
acc0 = vis_faligndata(t0, acc0);
t3 = VIS_LD_U16_I(tab1, s02);
t2 = VIS_LD_U16_I(tab0, s02);
t1 = VIS_LD_U16_I(tab2, s01);
t0 = VIS_LD_U16_I(tab1, s01);
acc1 = vis_faligndata(t3, acc1);
acc1 = vis_faligndata(t2, acc1);
acc1 = vis_faligndata(t1, acc1);
acc1 = vis_faligndata(t0, acc1);
t3 = VIS_LD_U16_I(tab2, s03);
t2 = VIS_LD_U16_I(tab1, s03);
t1 = VIS_LD_U16_I(tab0, s03);
t0 = VIS_LD_U16_I(tab2, s02);
acc2 = vis_faligndata(t3, acc2);
acc2 = vis_faligndata(t2, acc2);
acc2 = vis_faligndata(t1, acc2);
acc2 = vis_faligndata(t0, acc2);
s00 = (sp[0] << 1);
s01 = (sp[1] << 1);
s02 = (sp[2] << 1);
s03 = (sp[3] << 1);
*dp++ = acc0;
*dp++ = acc1;
*dp++ = acc2;
}
t3 = VIS_LD_U16_I(tab0, s01);
t2 = VIS_LD_U16_I(tab2, s00);
t1 = VIS_LD_U16_I(tab1, s00);
t0 = VIS_LD_U16_I(tab0, s00);
acc0 = vis_faligndata(t3, acc0);
acc0 = vis_faligndata(t2, acc0);
acc0 = vis_faligndata(t1, acc0);
acc0 = vis_faligndata(t0, acc0);
t3 = VIS_LD_U16_I(tab1, s02);
t2 = VIS_LD_U16_I(tab0, s02);
t1 = VIS_LD_U16_I(tab2, s01);
t0 = VIS_LD_U16_I(tab1, s01);
acc1 = vis_faligndata(t3, acc1);
acc1 = vis_faligndata(t2, acc1);
acc1 = vis_faligndata(t1, acc1);
acc1 = vis_faligndata(t0, acc1);
t3 = VIS_LD_U16_I(tab2, s03);
t2 = VIS_LD_U16_I(tab1, s03);
t1 = VIS_LD_U16_I(tab0, s03);
t0 = VIS_LD_U16_I(tab2, s02);
acc2 = vis_faligndata(t3, acc2);
acc2 = vis_faligndata(t2, acc2);
acc2 = vis_faligndata(t1, acc2);
acc2 = vis_faligndata(t0, acc2);
*dp++ = acc0;
*dp++ = acc1;
*dp++ = acc2;
i += 4;
}
dl = (mlib_s16 *) dp;
#pragma pipeloop(0)
for (; i < xsize; i++) {
s00 = sp[0];
dl[0] = tab0[s00];
dl[1] = tab1[s00];
dl[2] = tab2[s00];
dl += 3;
sp++;
}
}
/***************************************************************/
void mlib_v_ImageLookUpSI_U8_S16_3(const mlib_u8 *src,
mlib_s32 slb,
mlib_s16 *dst,
mlib_s32 dlb,
mlib_s32 xsize,
mlib_s32 ysize,
const mlib_s16 **table)
{
if ((xsize * ysize) < 550) {
mlib_u8 *sl;
mlib_s16 *dl;
mlib_s32 i, j;
const mlib_s16 *tab0 = table[0];
const mlib_s16 *tab1 = table[1];
const mlib_s16 *tab2 = table[2];
sl = (void *)src;
dl = dst;
/* row loop */
for (j = 0; j < ysize; j++) {
mlib_u8 *sp = sl;
mlib_s16 *dp = dl;
mlib_s32 off, s0, size = xsize;
off = ((mlib_addr) dp & 7) >> 1;
off = (off < size) ? off : size;
for (i = 0; i < off; i++) {
s0 = *sp++;
*dp++ = tab0[s0];
*dp++ = tab1[s0];
*dp++ = tab2[s0];
size--;
}
if (size > 0) {
mlib_v_ImageLookUpSI_U8_S16_3_D1_SMALL(sp, dp, size, table);
}
sl = (mlib_u8 *) ((mlib_u8 *) sl + slb);
dl = (mlib_s16 *) ((mlib_u8 *) dl + dlb);
}
}
else {
mlib_u8 *sl;
mlib_s16 *dl;
mlib_u32 tab[512];
mlib_u16 *tab0 = (mlib_u16 *) table[0];
mlib_u16 *tab1 = (mlib_u16 *) table[1];
mlib_u16 *tab2 = (mlib_u16 *) table[2];
mlib_s32 i, j;
mlib_u32 s0, s1, s2, s3;
s0 = tab0[0];
s1 = tab1[0];
s2 = tab2[0];
for (i = 1; i < 256; i++) {
s3 = (s0 << 16) + s1;
s0 = tab0[i];
s1 = tab1[i];
tab[2 * i - 2] = s3;
tab[2 * i - 1] = (s2 << 16);
s2 = tab2[i];
}
s3 = (s0 << 16) + s1;
tab[510] = s3;
tab[511] = (s2 << 16);
sl = (void *)src;
dl = dst;
/* row loop */
for (j = 0; j < ysize; j++) {
mlib_u8 *sp = sl;
mlib_s16 *dp = dl;
mlib_s32 off, size = xsize;
mlib_s16 *ptr;
off = ((mlib_addr) dp & 7) >> 1;
off = (off < size) ? off : size;
#pragma pipeloop(0)
for (i = 0; i < off; i++) {
ptr = (mlib_s16 *) (tab + 2 * sp[i]);
dp[0] = ptr[0];
dp[1] = ptr[1];
dp[2] = ptr[2];
dp += 3;
}
size -= off;
sp += off;
if (size > 0) {
off = (mlib_addr) sp & 3;
if (off == 0) {
mlib_v_ImageLookUpSI_U8_S16_3_SrcOff0_D1(sp, dp, size,
(mlib_d64 *) tab);
}
else if (off == 1) {
mlib_v_ImageLookUpSI_U8_S16_3_SrcOff1_D1(sp, dp, size,
(mlib_d64 *) tab);
}
else if (off == 2) {
mlib_v_ImageLookUpSI_U8_S16_3_SrcOff2_D1(sp, dp, size,
(mlib_d64 *) tab);
}
else if (off == 3) {
mlib_v_ImageLookUpSI_U8_S16_3_SrcOff3_D1(sp, dp, size,
(mlib_d64 *) tab);
}
}
sl = (mlib_u8 *) ((mlib_u8 *) sl + slb);
dl = (mlib_s16 *) ((mlib_u8 *) dl + dlb);
}
}
}
/***************************************************************/
void mlib_v_ImageLookUpSI_U8_S16_4_DstA8D1_D1(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_d64 *table)
{
mlib_u32 *sa; /* aligned pointer to source data */
mlib_u8 *sp; /* pointer to source data */
mlib_u32 s0; /* source data */
mlib_d64 *dp; /* aligned pointer to destination */
mlib_d64 acc0, acc1; /* destination data */
mlib_d64 acc2, acc3; /* destination data */
mlib_s32 i; /* loop variable */
mlib_u32 s00, s01, s02, s03;
sa = (mlib_u32 *) src;
dp = (mlib_d64 *) dst;
i = 0;
if (xsize >= 4) {
s0 = *sa++;
s00 = (s0 >> 21) & 0x7F8;
s01 = (s0 >> 13) & 0x7F8;
#pragma pipeloop(0)
for (i = 0; i <= xsize - 8; i += 4, dp += 4) {
s02 = (s0 >> 5) & 0x7F8;
s03 = (s0 << 3) & 0x7F8;
acc0 = *(mlib_d64 *) ((mlib_u8 *) table + s00);
acc1 = *(mlib_d64 *) ((mlib_u8 *) table + s01);
acc2 = *(mlib_d64 *) ((mlib_u8 *) table + s02);
acc3 = *(mlib_d64 *) ((mlib_u8 *) table + s03);
s0 = *sa++;
s00 = (s0 >> 21) & 0x7F8;
s01 = (s0 >> 13) & 0x7F8;
dp[0] = acc0;
dp[1] = acc1;
dp[2] = acc2;
dp[3] = acc3;
}
s02 = (s0 >> 5) & 0x7F8;
s03 = (s0 << 3) & 0x7F8;
acc0 = *(mlib_d64 *) ((mlib_u8 *) table + s00);
acc1 = *(mlib_d64 *) ((mlib_u8 *) table + s01);
acc2 = *(mlib_d64 *) ((mlib_u8 *) table + s02);
acc3 = *(mlib_d64 *) ((mlib_u8 *) table + s03);
dp[0] = acc0;
dp[1] = acc1;
dp[2] = acc2;
dp[3] = acc3;
dp += 4;
i += 4;
}
sp = (mlib_u8 *) sa;
if (i <= xsize - 2) {
*dp++ = table[sp[0]];
*dp++ = table[sp[1]];
i += 2;
sp += 2;
}
if (i < xsize)
*dp++ = table[sp[0]];
}
/***************************************************************/
void mlib_v_ImageLookUpSI_U8_S16_4_DstNonAl_D1(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_d64 *table)
{
mlib_u32 *sa; /* aligned pointer to source data */
mlib_u8 *sp; /* pointer to source data */
mlib_u32 s0; /* source data */
mlib_s16 *dl; /* pointer to start of destination */
mlib_d64 *dp; /* aligned pointer to destination */
mlib_d64 acc0, acc1; /* destination data */
mlib_d64 acc2, acc3, acc4; /* destination data */
mlib_s32 i; /* loop variable */
mlib_s16 *dend; /* pointer to end of destination */
mlib_s32 emask; /* edge mask */
mlib_s32 off;
mlib_u32 s00, s01, s02, s03;
sp = (void *)src;
dl = dst;
dend = dl + (xsize << 2) - 1;
dp = (mlib_d64 *) ((mlib_addr) dl & (~7));
off = (mlib_addr) dp - (mlib_addr) dl;
vis_alignaddr(dp, off);
emask = vis_edge16(dl, dend);
acc0 = table[sp[0]];
vis_pst_16(vis_faligndata(acc0, acc0), dp++, emask);
sp++;
sa = (mlib_u32 *) sp;
xsize--;
i = 0;
if (xsize >= 4) {
s0 = *sa++;
s00 = (s0 >> 21) & 0x7F8;
s01 = (s0 >> 13) & 0x7F8;
#pragma pipeloop(0)
for (i = 0; i <= xsize - 8; i += 4, dp += 4) {
s02 = (s0 >> 5) & 0x7F8;
s03 = (s0 << 3) & 0x7F8;
acc1 = *(mlib_d64 *) ((mlib_u8 *) table + s00);
acc2 = *(mlib_d64 *) ((mlib_u8 *) table + s01);
acc3 = *(mlib_d64 *) ((mlib_u8 *) table + s02);
acc4 = *(mlib_d64 *) ((mlib_u8 *) table + s03);
s0 = *sa++;
s00 = (s0 >> 21) & 0x7F8;
s01 = (s0 >> 13) & 0x7F8;
dp[0] = vis_faligndata(acc0, acc1);
dp[1] = vis_faligndata(acc1, acc2);
dp[2] = vis_faligndata(acc2, acc3);
dp[3] = vis_faligndata(acc3, acc4);
acc0 = acc4;
}
s02 = (s0 >> 5) & 0x7F8;
s03 = (s0 << 3) & 0x7F8;
acc1 = *(mlib_d64 *) ((mlib_u8 *) table + s00);
acc2 = *(mlib_d64 *) ((mlib_u8 *) table + s01);
acc3 = *(mlib_d64 *) ((mlib_u8 *) table + s02);
acc4 = *(mlib_d64 *) ((mlib_u8 *) table + s03);
dp[0] = vis_faligndata(acc0, acc1);
dp[1] = vis_faligndata(acc1, acc2);
dp[2] = vis_faligndata(acc2, acc3);
dp[3] = vis_faligndata(acc3, acc4);
acc0 = acc4;
dp += 4;
i += 4;
}
sp = (mlib_u8 *) sa;
if (i <= xsize - 2) {
acc1 = table[sp[0]];
acc2 = table[sp[1]];
*dp++ = vis_faligndata(acc0, acc1);
*dp++ = vis_faligndata(acc1, acc2);
i += 2;
sp += 2;
acc0 = acc2;
}
if (i < xsize) {
acc1 = table[sp[0]];
*dp++ = vis_faligndata(acc0, acc1);
acc0 = acc1;
}
emask = vis_edge16(dp, dend);
vis_pst_16(vis_faligndata(acc0, acc0), dp++, emask);
}
/***************************************************************/
void mlib_v_ImageLookUpSI_U8_S16_4_DstOff0_D1_SMALL(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_s16 **table)
{
mlib_u8 *sp; /* pointer to source data */
mlib_u32 s0; /* source data */
mlib_s16 *dl; /* pointer to start of destination */
mlib_d64 *dp; /* aligned pointer to destination */
mlib_d64 t0, t1, t2, t3; /* destination data */
mlib_d64 acc; /* destination data */
mlib_s32 i; /* loop variable */
const mlib_s16 *tab0 = table[0];
const mlib_s16 *tab1 = table[1];
const mlib_s16 *tab2 = table[2];
const mlib_s16 *tab3 = table[3];
sp = (void *)src;
dl = dst;
dp = (mlib_d64 *) dl;
vis_alignaddr((void *)0, 6);
if (xsize >= 1) {
s0 = (*sp++) << 1;
#pragma pipeloop(0)
for (i = 0; i <= xsize - 2; i++) {
t3 = VIS_LD_U16_I(tab3, s0);
t2 = VIS_LD_U16_I(tab2, s0);
t1 = VIS_LD_U16_I(tab1, s0);
t0 = VIS_LD_U16_I(tab0, s0);
acc = vis_faligndata(t3, acc);
acc = vis_faligndata(t2, acc);
acc = vis_faligndata(t1, acc);
acc = vis_faligndata(t0, acc);
s0 = (*sp++) << 1;
*dp++ = acc;
}
t3 = VIS_LD_U16_I(tab3, s0);
t2 = VIS_LD_U16_I(tab2, s0);
t1 = VIS_LD_U16_I(tab1, s0);
t0 = VIS_LD_U16_I(tab0, s0);
acc = vis_faligndata(t3, acc);
acc = vis_faligndata(t2, acc);
acc = vis_faligndata(t1, acc);
acc = vis_faligndata(t0, acc);
*dp++ = acc;
}
}
/***************************************************************/
void mlib_v_ImageLookUpSI_U8_S16_4_DstOff1_D1_SMALL(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_s16 **table)
{
mlib_u8 *sp; /* pointer to source data */
mlib_u32 s0, s1; /* source data */
mlib_s16 *dl; /* pointer to start of destination */
mlib_d64 *dp; /* aligned pointer to destination */
mlib_d64 t0, t1, t2, t3; /* destination data */
mlib_d64 acc; /* destination data */
mlib_s32 i; /* loop variable */
const mlib_s16 *tab0 = table[0];
const mlib_s16 *tab1 = table[1];
const mlib_s16 *tab2 = table[2];
const mlib_s16 *tab3 = table[3];
sp = (void *)src;
dl = dst;
dp = (mlib_d64 *) dl;
vis_alignaddr((void *)0, 6);
s0 = (*sp++) << 1;
if (xsize >= 1) {
s1 = (*sp++) << 1;
#pragma pipeloop(0)
for (i = 0; i <= xsize - 2; i++) {
t3 = VIS_LD_U16_I(tab0, s1);
t2 = VIS_LD_U16_I(tab3, s0);
t1 = VIS_LD_U16_I(tab2, s0);
t0 = VIS_LD_U16_I(tab1, s0);
acc = vis_faligndata(t3, acc);
acc = vis_faligndata(t2, acc);
acc = vis_faligndata(t1, acc);
acc = vis_faligndata(t0, acc);
s0 = s1;
s1 = (*sp++) << 1;
*dp++ = acc;
}
t3 = VIS_LD_U16_I(tab0, s1);
t2 = VIS_LD_U16_I(tab3, s0);
t1 = VIS_LD_U16_I(tab2, s0);
t0 = VIS_LD_U16_I(tab1, s0);
acc = vis_faligndata(t3, acc);
acc = vis_faligndata(t2, acc);
acc = vis_faligndata(t1, acc);
acc = vis_faligndata(t0, acc);
s0 = s1;
*dp++ = acc;
}
dl = (mlib_s16 *) dp;
s0 >>= 1;
dl[0] = tab1[s0];
dl[1] = tab2[s0];
dl[2] = tab3[s0];
}
/***************************************************************/
void mlib_v_ImageLookUpSI_U8_S16_4_DstOff2_D1_SMALL(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_s16 **table)
{
mlib_u8 *sp; /* pointer to source data */
mlib_u32 s0, s1; /* source data */
mlib_s16 *dl; /* pointer to start of destination */
mlib_d64 *dp; /* aligned pointer to destination */
mlib_d64 t0, t1, t2, t3; /* destination data */
mlib_d64 acc; /* destination data */
mlib_s32 i; /* loop variable */
const mlib_s16 *tab0 = table[0];
const mlib_s16 *tab1 = table[1];
const mlib_s16 *tab2 = table[2];
const mlib_s16 *tab3 = table[3];
sp = (void *)src;
dl = dst;
dp = (mlib_d64 *) dl;
vis_alignaddr((void *)0, 6);
s0 = (*sp++) << 1;
if (xsize >= 1) {
s1 = (*sp++) << 1;
#pragma pipeloop(0)
for (i = 0; i <= xsize - 2; i++) {
t3 = VIS_LD_U16_I(tab1, s1);
t2 = VIS_LD_U16_I(tab0, s1);
t1 = VIS_LD_U16_I(tab3, s0);
t0 = VIS_LD_U16_I(tab2, s0);
acc = vis_faligndata(t3, acc);
acc = vis_faligndata(t2, acc);
acc = vis_faligndata(t1, acc);
acc = vis_faligndata(t0, acc);
s0 = s1;
s1 = (*sp++) << 1;
*dp++ = acc;
}
t3 = VIS_LD_U16_I(tab1, s1);
t2 = VIS_LD_U16_I(tab0, s1);
t1 = VIS_LD_U16_I(tab3, s0);
t0 = VIS_LD_U16_I(tab2, s0);
acc = vis_faligndata(t3, acc);
acc = vis_faligndata(t2, acc);
acc = vis_faligndata(t1, acc);
acc = vis_faligndata(t0, acc);
s0 = s1;
*dp++ = acc;
}
dl = (mlib_s16 *) dp;
s0 >>= 1;
dl[0] = tab2[s0];
dl[1] = tab3[s0];
}
/***************************************************************/
void mlib_v_ImageLookUpSI_U8_S16_4_DstOff3_D1_SMALL(const mlib_u8 *src,
mlib_s16 *dst,
mlib_s32 xsize,
const mlib_s16 **table)
{
mlib_u8 *sp; /* pointer to source data */
mlib_u32 s0, s1; /* source data */
mlib_s16 *dl; /* pointer to start of destination */
mlib_d64 *dp; /* aligned pointer to destination */
mlib_d64 t0, t1, t2, t3; /* destination data */
mlib_d64 acc; /* destination data */
mlib_s32 i; /* loop variable */
const mlib_s16 *tab0 = table[0];
const mlib_s16 *tab1 = table[1];
const mlib_s16 *tab2 = table[2];
const mlib_s16 *tab3 = table[3];
sp = (void *)src;
dl = dst;
dp = (mlib_d64 *) dl;
vis_alignaddr((void *)0, 6);
s0 = (*sp++) << 1;
if (xsize >= 1) {
s1 = (*sp++) << 1;
#pragma pipeloop(0)
for (i = 0; i <= xsize - 2; i++) {
t3 = VIS_LD_U16_I(tab2, s1);
t2 = VIS_LD_U16_I(tab1, s1);
t1 = VIS_LD_U16_I(tab0, s1);
t0 = VIS_LD_U16_I(tab3, s0);
acc = vis_faligndata(t3, acc);
acc = vis_faligndata(t2, acc);
acc = vis_faligndata(t1, acc);
acc = vis_faligndata(t0, acc);
s0 = s1;
s1 = (*sp++) << 1;
*dp++ = acc;
}
t3 = VIS_LD_U16_I(tab2, s1);
t2 = VIS_LD_U16_I(tab1, s1);
t1 = VIS_LD_U16_I(tab0, s1);
t0 = VIS_LD_U16_I(tab3, s0);
acc = vis_faligndata(t3, acc);
acc = vis_faligndata(t2, acc);
acc = vis_faligndata(t1, acc);
acc = vis_faligndata(t0, acc);
s0 = s1;
*dp++ = acc;
}
dl = (mlib_s16 *) dp;
s0 >>= 1;
dl[0] = tab3[s0];
}
/***************************************************************/
void mlib_v_ImageLookUpSI_U8_S16_4(const mlib_u8 *src,
mlib_s32 slb,
mlib_s16 *dst,
mlib_s32 dlb,
mlib_s32 xsize,
mlib_s32 ysize,
const mlib_s16 **table)
{
if ((xsize * ysize) < 550) {
mlib_u8 *sl;
mlib_s16 *dl;
mlib_s32 j;
const mlib_s16 *tab0 = table[0];
const mlib_s16 *tab1 = table[1];
const mlib_s16 *tab2 = table[2];
sl = (void *)src;
dl = dst;
/* row loop */
for (j = 0; j < ysize; j++) {
mlib_u8 *sp = sl;
mlib_s16 *dp = dl;
mlib_s32 off, s0, size = xsize;
if (size > 0) {
off = ((8 - ((mlib_addr) dp & 7)) & 7) >> 1;
if (off == 0) {
mlib_v_ImageLookUpSI_U8_S16_4_DstOff0_D1_SMALL(sp, dp, size, table);
}
else if (off == 1) {
s0 = *sp;
*dp++ = tab0[s0];
size--;
mlib_v_ImageLookUpSI_U8_S16_4_DstOff1_D1_SMALL(sp, dp, size, table);
}
else if (off == 2) {
s0 = *sp;
*dp++ = tab0[s0];
*dp++ = tab1[s0];
size--;
mlib_v_ImageLookUpSI_U8_S16_4_DstOff2_D1_SMALL(sp, dp, size, table);
}
else if (off == 3) {
s0 = *sp;
*dp++ = tab0[s0];
*dp++ = tab1[s0];
*dp++ = tab2[s0];
size--;
mlib_v_ImageLookUpSI_U8_S16_4_DstOff3_D1_SMALL(sp, dp, size, table);
}
}
sl = (mlib_u8 *) ((mlib_u8 *) sl + slb);
dl = (mlib_s16 *) ((mlib_u8 *) dl + dlb);
}
}
else {
mlib_u8 *sl;
mlib_s16 *dl;
mlib_u32 tab[512];
mlib_u16 *tab0 = (mlib_u16 *) table[0];
mlib_u16 *tab1 = (mlib_u16 *) table[1];
mlib_u16 *tab2 = (mlib_u16 *) table[2];
mlib_u16 *tab3 = (mlib_u16 *) table[3];
mlib_s32 i, j;
mlib_u32 s0, s1, s2, s3, s4, s5;
s0 = tab0[0];
s1 = tab1[0];
s2 = tab2[0];
s3 = tab3[0];
for (i = 1; i < 256; i++) {
s4 = (s0 << 16) + s1;
s5 = (s2 << 16) + s3;
s0 = tab0[i];
s1 = tab1[i];
s2 = tab2[i];
s3 = tab3[i];
tab[2 * i - 2] = s4;
tab[2 * i - 1] = s5;
}
s4 = (s0 << 16) + s1;
s5 = (s2 << 16) + s3;
tab[510] = s4;
tab[511] = s5;
sl = (void *)src;
dl = dst;
/* row loop */
for (j = 0; j < ysize; j++) {
mlib_u8 *sp = sl;
mlib_s16 *dp = dl;
mlib_s32 off, s0, size = xsize;
mlib_s16 *ptr;
if (((mlib_addr) dp & 7) == 0) {
off = ((4 - (mlib_addr) sp & 3) & 3);
off = (off < size) ? off : size;
#pragma pipeloop(0)
for (i = 0; i < off; i++) {
s0 = (*sp++);
*(mlib_u32 *) dp = tab[2 * s0];
*(mlib_u32 *) (dp + 2) = tab[2 * s0 + 1];
dp += 4;
}
size -= off;
if (size > 0) {
mlib_v_ImageLookUpSI_U8_S16_4_DstA8D1_D1(sp, dp, size,
(mlib_d64 *) tab);
}
}
else {
off = (3 - ((mlib_addr) sp & 3));
off = (off < size) ? off : size;
for (i = 0; i < off; i++) {
ptr = (mlib_s16 *) (tab + 2 * sp[i]);
dp[0] = ptr[0];
dp[1] = ptr[1];
dp[2] = ptr[2];
dp[3] = ptr[3];
dp += 4;
}
sp += off;
size -= off;
if (size > 0) {
mlib_v_ImageLookUpSI_U8_S16_4_DstNonAl_D1(sp, dp, size,
(mlib_d64 *) tab);
}
}
sl = (mlib_u8 *) ((mlib_u8 *) sl + slb);
dl = (mlib_s16 *) ((mlib_u8 *) dl + dlb);
}
}
}
/***************************************************************/