void
mlib_IPWT_S32_Sat(
void *sp,
mlib_PWS *pws,
mlib_s32 n)
{
mlib_s32 *dstData = sp;
mlib_s32 *xd = pws->dst_x;
mlib_d64 *buffer;
mlib_d64 rr;
mlib_s32 i, res, ch;
mlib_s32 idx;
mlib_s32 channels = pws->channels;
for (ch = 0; ch < channels; ch++) {
buffer = (mlib_d64 *)pws->buffer + ch;
#ifdef __SUNPRO_C
#pragma nomemorydepend
#pragma pipeloop(0)
#endif /* __SUNPRO_C */
for (i = 0; i < n; i++) {
idx = xd[i] * channels + ch;
rr = buffer[0];
SAT32(res, rr);
dstData[idx] = res;
buffer += channels;
}
}
}
mlib_status mlib_AffineEdges(mlib_affine_param *param,
const mlib_image *dst,
const mlib_image *src,
void *buff_lcl,
mlib_s32 buff_size,
mlib_s32 kw,
mlib_s32 kh,
mlib_s32 kw1,
mlib_s32 kh1,
mlib_edge edge,
const mlib_d64 *mtx,
mlib_s32 shiftx,
mlib_s32 shifty)
{
mlib_u8 *buff = buff_lcl;
mlib_u8 **lineAddr = param->lineAddr;
mlib_s32 srcWidth, dstWidth, srcHeight, dstHeight, srcYStride, dstYStride;
mlib_s32 *leftEdges, *rightEdges, *xStarts, *yStarts, bsize0, bsize1 = 0;
mlib_u8 *srcData, *dstData;
mlib_u8 *paddings;
void *warp_tbl = NULL;
mlib_s32 yStart = 0, yFinish = -1, dX, dY;
mlib_d64 xClip, yClip, wClip, hClip;
mlib_d64 delta = 0.;
mlib_d64 minX, minY, maxX, maxY;
mlib_d64 coords[4][2];
mlib_d64 a = mtx[0], b = mtx[1], tx = mtx[2], c = mtx[3], d = mtx[4], ty = mtx[5];
mlib_d64 a2, b2, tx2, c2, d2, ty2;
mlib_d64 dx, dy, div;
mlib_s32 sdx, sdy;
mlib_d64 dTop;
mlib_d64 val0;
mlib_s32 top, bot;
mlib_s32 topIdx, max_xsize = 0;
mlib_s32 i, j, t;
srcData = mlib_ImageGetData(src);
dstData = mlib_ImageGetData(dst);
srcWidth = mlib_ImageGetWidth(src);
srcHeight = mlib_ImageGetHeight(src);
dstWidth = mlib_ImageGetWidth(dst);
dstHeight = mlib_ImageGetHeight(dst);
srcYStride = mlib_ImageGetStride(src);
dstYStride = mlib_ImageGetStride(dst);
paddings = mlib_ImageGetPaddings(src);
if (srcWidth >= (1 << 15) || srcHeight >= (1 << 15)) {
return MLIB_FAILURE;
}
div = a * d - b * c;
if (div == 0.0) {
return MLIB_FAILURE;
}
bsize0 = (dstHeight * sizeof(mlib_s32) + 7) & ~7;
if (lineAddr == NULL) {
bsize1 = ((srcHeight + 4 * kh) * sizeof(mlib_u8 *) + 7) & ~7;
}
param->buff_malloc = NULL;
if ((4 * bsize0 + bsize1) > buff_size) {
buff = param->buff_malloc = mlib_malloc(4 * bsize0 + bsize1);
if (buff == NULL)
return MLIB_FAILURE;
}
leftEdges = (mlib_s32 *) (buff);
rightEdges = (mlib_s32 *) (buff += bsize0);
xStarts = (mlib_s32 *) (buff += bsize0);
yStarts = (mlib_s32 *) (buff += bsize0);
if (lineAddr == NULL) {
mlib_u8 *srcLinePtr = srcData;
lineAddr = (mlib_u8 **) (buff += bsize0);
for (i = 0; i < 2 * kh; i++)
lineAddr[i] = srcLinePtr;
lineAddr += 2 * kh;
for (i = 0; i < srcHeight - 1; i++) {
lineAddr[i] = srcLinePtr;
srcLinePtr += srcYStride;
}
for (i = srcHeight - 1; i < srcHeight + 2 * kh; i++)
lineAddr[i] = srcLinePtr;
}
if ((mlib_s32) edge < 0) { /* process edges */
minX = 0;
minY = 0;
maxX = srcWidth;
maxY = srcHeight;
}
else {
if (kw > 1)
delta = -0.5; /* for MLIB_NEAREST filter delta = 0. */
minX = (kw1 - delta);
minY = (kh1 - delta);
maxX = srcWidth - ((kw - 1) - (kw1 - delta));
maxY = srcHeight - ((kh - 1) - (kh1 - delta));
if (edge == MLIB_EDGE_SRC_PADDED) {
if (minX < paddings[0])
minX = paddings[0];
if (minY < paddings[1])
minY = paddings[1];
if (maxX > (srcWidth - paddings[2]))
maxX = srcWidth - paddings[2];
if (maxY > (srcHeight - paddings[3]))
maxY = srcHeight - paddings[3];
}
}
xClip = minX;
yClip = minY;
wClip = maxX;
hClip = maxY;
/*
* STORE_PARAM(param, src);
* STORE_PARAM(param, dst);
*/
param->src = (void *)src;
param->dst = (void *)dst;
STORE_PARAM(param, lineAddr);
STORE_PARAM(param, dstData);
STORE_PARAM(param, srcYStride);
STORE_PARAM(param, dstYStride);
STORE_PARAM(param, leftEdges);
STORE_PARAM(param, rightEdges);
STORE_PARAM(param, xStarts);
STORE_PARAM(param, yStarts);
STORE_PARAM(param, max_xsize);
STORE_PARAM(param, yStart);
STORE_PARAM(param, yFinish);
STORE_PARAM(param, warp_tbl);
if ((xClip >= wClip) || (yClip >= hClip)) {
return MLIB_SUCCESS;
}
a2 = d;
b2 = -b;
tx2 = (-d * tx + b * ty);
c2 = -c;
d2 = a;
ty2 = (c * tx - a * ty);
dx = a2;
dy = c2;
tx -= 0.5;
ty -= 0.5;
coords[0][0] = xClip * a + yClip * b + tx;
coords[0][1] = xClip * c + yClip * d + ty;
coords[2][0] = wClip * a + hClip * b + tx;
coords[2][1] = wClip * c + hClip * d + ty;
if (div > 0) {
coords[1][0] = wClip * a + yClip * b + tx;
coords[1][1] = wClip * c + yClip * d + ty;
coords[3][0] = xClip * a + hClip * b + tx;
coords[3][1] = xClip * c + hClip * d + ty;
}
else {
coords[3][0] = wClip * a + yClip * b + tx;
coords[3][1] = wClip * c + yClip * d + ty;
coords[1][0] = xClip * a + hClip * b + tx;
coords[1][1] = xClip * c + hClip * d + ty;
}
topIdx = 0;
for (i = 1; i < 4; i++) {
if (coords[i][1] < coords[topIdx][1])
topIdx = i;
}
dTop = coords[topIdx][1];
val0 = dTop;
SAT32(top);
bot = -1;
if (top >= dstHeight) {
return MLIB_SUCCESS;
}
if (dTop >= 0.0) {
mlib_d64 xLeft, xRight, x;
mlib_s32 nextIdx;
if (dTop == top) {
xLeft = coords[topIdx][0];
xRight = coords[topIdx][0];
nextIdx = (topIdx + 1) & 0x3;
if (dTop == coords[nextIdx][1]) {
x = coords[nextIdx][0];
xLeft = (xLeft <= x) ? xLeft : x;
xRight = (xRight >= x) ? xRight : x;
}
nextIdx = (topIdx - 1) & 0x3;
if (dTop == coords[nextIdx][1]) {
x = coords[nextIdx][0];
xLeft = (xLeft <= x) ? xLeft : x;
xRight = (xRight >= x) ? xRight : x;
}
val0 = xLeft;
SAT32(t);
leftEdges[top] = (t >= xLeft) ? t : ++t;
if (xLeft >= MLIB_S32_MAX)
leftEdges[top] = MLIB_S32_MAX;
val0 = xRight;
SAT32(rightEdges[top]);
}
else
top++;
}
else
top = 0;
for (i = 0; i < 2; i++) {
mlib_d64 dY1 = coords[(topIdx - i) & 0x3][1];
mlib_d64 dX1 = coords[(topIdx - i) & 0x3][0];
mlib_d64 dY2 = coords[(topIdx - i - 1) & 0x3][1];
mlib_d64 dX2 = coords[(topIdx - i - 1) & 0x3][0];
mlib_d64 x = dX1, slope = (dX2 - dX1) / (dY2 - dY1);
mlib_s32 y1;
mlib_s32 y2;
if (dY1 == dY2)
continue;
if (dY1 < 0.0)
y1 = 0;
else {
val0 = dY1 + 1;
SAT32(y1);
}
val0 = dY2;
SAT32(y2);
if (y2 >= dstHeight)
y2 = (mlib_s32) (dstHeight - 1);
x += slope * (y1 - dY1);
#ifdef __SUNPRO_C
#pragma pipeloop(0)
#endif /* __SUNPRO_C */
for (j = y1; j <= y2; j++) {
val0 = x;
SAT32(t);
leftEdges[j] = (t >= x) ? t : ++t;
if (x >= MLIB_S32_MAX)
leftEdges[j] = MLIB_S32_MAX;
x += slope;
}
}
for (i = 0; i < 2; i++) {
mlib_d64 dY1 = coords[(topIdx + i) & 0x3][1];
mlib_d64 dX1 = coords[(topIdx + i) & 0x3][0];
mlib_d64 dY2 = coords[(topIdx + i + 1) & 0x3][1];
mlib_d64 dX2 = coords[(topIdx + i + 1) & 0x3][0];
mlib_d64 x = dX1, slope = (dX2 - dX1) / (dY2 - dY1);
mlib_s32 y1;
mlib_s32 y2;
if (dY1 == dY2)
continue;
if (dY1 < 0.0)
y1 = 0;
else {
val0 = dY1 + 1;
SAT32(y1);
}
val0 = dY2;
SAT32(y2);
if (y2 >= dstHeight)
y2 = (mlib_s32) (dstHeight - 1);
x += slope * (y1 - dY1);
#ifdef __SUNPRO_C
#pragma pipeloop(0)
#endif /* __SUNPRO_C */
for (j = y1; j <= y2; j++) {
val0 = x;
SAT32(rightEdges[j]);
x += slope;
}
bot = y2;
}
{
mlib_d64 dxCl = xClip * div;
mlib_d64 dyCl = yClip * div;
mlib_d64 dwCl = wClip * div;
mlib_d64 dhCl = hClip * div;
mlib_s32 xCl = (mlib_s32) (xClip + delta);
mlib_s32 yCl = (mlib_s32) (yClip + delta);
mlib_s32 wCl = (mlib_s32) (wClip + delta);
mlib_s32 hCl = (mlib_s32) (hClip + delta);
/*
* mlib_s32 xCl = (mlib_s32)(xClip + delta);
* mlib_s32 yCl = (mlib_s32)(yClip + delta);
* mlib_s32 wCl = (mlib_s32)(wClip);
* mlib_s32 hCl = (mlib_s32)(hClip);
*/
if (edge == MLIB_EDGE_SRC_PADDED) {
xCl = kw1;
yCl = kh1;
wCl = (mlib_s32) (srcWidth - ((kw - 1) - kw1));
hCl = (mlib_s32) (srcHeight - ((kh - 1) - kh1));
}
div = 1.0 / div;
sdx = (mlib_s32) (a2 * div * (1 << shiftx));
sdy = (mlib_s32) (c2 * div * (1 << shifty));
if (div > 0) {
#ifdef __SUNPRO_C
#pragma pipeloop(0)
#endif /* __SUNPRO_C */
for (i = top; i <= bot; i++) {
mlib_s32 xLeft = leftEdges[i];
mlib_s32 xRight = rightEdges[i];
mlib_s32 xs, ys, x_e, y_e, x_s, y_s;
mlib_d64 dxs, dys, dxe, dye;
mlib_d64 xl, ii, xr;
xLeft = (xLeft < 0) ? 0 : xLeft;
xRight = (xRight >= dstWidth) ? (mlib_s32) (dstWidth - 1) : xRight;
xl = xLeft + 0.5;
ii = i + 0.5;
xr = xRight + 0.5;
dxs = xl * a2 + ii * b2 + tx2;
dys = xl * c2 + ii * d2 + ty2;
if ((dxs < dxCl) || (dxs >= dwCl) || (dys < dyCl) || (dys >= dhCl)) {
dxs += dx;
dys += dy;
xLeft++;
if ((dxs < dxCl) || (dxs >= dwCl) || (dys < dyCl) || (dys >= dhCl))
xRight = -1;
}
dxe = xr * a2 + ii * b2 + tx2;
dye = xr * c2 + ii * d2 + ty2;
if ((dxe < dxCl) || (dxe >= dwCl) || (dye < dyCl) || (dye >= dhCl)) {
dxe -= dx;
dye -= dy;
xRight--;
if ((dxe < dxCl) || (dxe >= dwCl) || (dye < dyCl) || (dye >= dhCl))
xRight = -1;
}
xs = (mlib_s32) ((dxs * div + delta) * (1 << shiftx));
x_s = xs >> shiftx;
ys = (mlib_s32) ((dys * div + delta) * (1 << shifty));
y_s = ys >> shifty;
if (x_s < xCl)
xs = (xCl << shiftx);
else if (x_s >= wCl)
xs = ((wCl << shiftx) - 1);
if (y_s < yCl)
ys = (yCl << shifty);
else if (y_s >= hCl)
ys = ((hCl << shifty) - 1);
if (xRight >= xLeft) {
x_e = ((xRight - xLeft) * sdx + xs) >> shiftx;
y_e = ((xRight - xLeft) * sdy + ys) >> shifty;
if ((x_e < xCl) || (x_e >= wCl)) {
if (sdx > 0)
sdx -= 1;
else
sdx += 1;
}
if ((y_e < yCl) || (y_e >= hCl)) {
if (sdy > 0)
sdy -= 1;
else
sdy += 1;
}
}
leftEdges[i] = xLeft;
rightEdges[i] = xRight;
xStarts[i] = xs;
yStarts[i] = ys;
if ((xRight - xLeft + 1) > max_xsize)
max_xsize = (xRight - xLeft + 1);
}
}
else {
#ifdef __SUNPRO_C
#pragma pipeloop(0)
#endif /* __SUNPRO_C */
for (i = top; i <= bot; i++) {