| /* |
| * Copyright (c) 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. |
| */ |
| |
| |
| /* |
| * FUNCTION |
| * mlib_ImageZoom - image scaling with edge condition |
| * |
| * SYNOPSIS |
| * mlib_status mlib_ImageZoom(mlib_image *dst, |
| * const mlib_image *src, |
| * mlib_f32 zoomx, |
| * mlib_f32 zoomy, |
| * mlib_filter filter, |
| * mlib_edge edge) |
| * |
| * ARGUMENTS |
| * dst Pointer to destination image |
| * src Pointer to source image |
| * zoomx X zoom factor. |
| * zoomy Y zoom factor. |
| * filter Type of resampling filter. |
| * edge Type of edge condition. |
| * |
| * DESCRIPTION |
| * The center of the source image is mapped to the center of the |
| * destination image. |
| * |
| * The upper-left corner pixel of an image is located at (0.5, 0.5). |
| * |
| * The resampling filter can be one of the following: |
| * MLIB_NEAREST |
| * MLIB_BILINEAR |
| * MLIB_BICUBIC |
| * MLIB_BICUBIC2 |
| * |
| * The edge condition can be one of the following: |
| * MLIB_EDGE_DST_NO_WRITE (default) |
| * MLIB_EDGE_DST_FILL_ZERO |
| * MLIB_EDGE_OP_NEAREST |
| * MLIB_EDGE_SRC_EXTEND |
| * MLIB_EDGE_SRC_PADDED |
| */ |
| |
| #include <mlib_image.h> |
| #include <vis_proto.h> |
| |
| /***************************************************************/ |
| |
| #define _MLIB_VIS_VER_ |
| #include <mlib_ImageZoom.h> |
| |
| /***************************************************************/ |
| |
| #define VARIABLE(FORMAT) \ |
| mlib_s32 j, \ |
| dx = GetElemStruct(DX), \ |
| dy = GetElemStruct(DY), \ |
| x = GetElemSubStruct(current, srcX), \ |
| y = GetElemSubStruct(current, srcY), \ |
| src_stride = GetElemStruct(src_stride), \ |
| dst_stride = GetElemStruct(dst_stride), \ |
| width = GetElemSubStruct(current, width), \ |
| height = GetElemSubStruct(current, height); \ |
| FORMAT *sp = GetElemSubStruct(current, sp), \ |
| *dp = GetElemSubStruct(current, dp) |
| |
| /***************************************************************/ |
| |
| mlib_status mlib_ImageZoom_U8_1_Nearest(mlib_work_image *param) |
| { |
| VARIABLE(mlib_u8); |
| mlib_u8 *dl = dp, *tsp; |
| mlib_s32 y0 = -1, dx7 = 7*dx, dx15 = 8*dx + dx7; |
| |
| tsp = sp; |
| y = GetElemSubStruct(current, srcY) & MLIB_MASK; |
| |
| for (j = 0; j < height; j++) { |
| |
| if ((y0 >> MLIB_SHIFT) == (y >> MLIB_SHIFT)) { |
| mlib_ImageCopy_na(dl - dst_stride, dl, width); |
| } |
| else { |
| mlib_u8 *dp = dl, *dend = dl + width; |
| |
| vis_write_gsr(7); |
| x = GetElemSubStruct(current, srcX) & MLIB_MASK; |
| |
| while (((mlib_addr)dp & 7) && (dp < dend)) { |
| *dp++ = tsp[x >> MLIB_SHIFT]; |
| x += dx; |
| } |
| |
| x += dx7; |
| |
| #pragma pipeloop(0) |
| for (; dp <= dend - 8; dp += 8) { |
| mlib_d64 s0; |
| |
| s0 = vis_faligndata(vis_ld_u8_i(tsp, x >> MLIB_SHIFT), s0); |
| x -= dx; |
| s0 = vis_faligndata(vis_ld_u8_i(tsp, x >> MLIB_SHIFT), s0); |
| x -= dx; |
| s0 = vis_faligndata(vis_ld_u8_i(tsp, x >> MLIB_SHIFT), s0); |
| x -= dx; |
| s0 = vis_faligndata(vis_ld_u8_i(tsp, x >> MLIB_SHIFT), s0); |
| x -= dx; |
| s0 = vis_faligndata(vis_ld_u8_i(tsp, x >> MLIB_SHIFT), s0); |
| x -= dx; |
| s0 = vis_faligndata(vis_ld_u8_i(tsp, x >> MLIB_SHIFT), s0); |
| x -= dx; |
| s0 = vis_faligndata(vis_ld_u8_i(tsp, x >> MLIB_SHIFT), s0); |
| x -= dx; |
| s0 = vis_faligndata(vis_ld_u8_i(tsp, x >> MLIB_SHIFT), s0); |
| x += dx15; |
| |
| *(mlib_d64*)dp = s0; |
| } |
| |
| x -= dx7; |
| |
| while (dp < dend) { |
| *dp++ = tsp[x >> MLIB_SHIFT]; |
| x += dx; |
| } |
| } |
| |
| y0 = y; |
| y += dy; |
| dl = (void*)((mlib_u8*)dl + dst_stride); |
| tsp = (void*)((mlib_u8*)sp + (y >> MLIB_SHIFT) * src_stride); |
| } |
| |
| return MLIB_SUCCESS; |
| } |
| |
| /***************************************************************/ |
| |
| mlib_status mlib_ImageZoom_U8_3_Nearest(mlib_work_image *param) |
| { |
| VARIABLE(mlib_u8); |
| mlib_u8 *dl = dp, *tsp, *tt; |
| mlib_s32 cx, y0 = -1, dx7 = 7*dx, dx15 = 8*dx + dx7; |
| |
| tsp = sp; |
| y = GetElemSubStruct(current, srcY) & MLIB_MASK; |
| |
| for (j = 0; j < height; j++) { |
| |
| if ((y0 >> MLIB_SHIFT) == (y >> MLIB_SHIFT)) { |
| mlib_ImageCopy_na(dl - dst_stride, dl, 3*width); |
| } |
| else { |
| mlib_u8 *dp = dl, *dend = dl + 3*width; |
| |
| vis_write_gsr(7); |
| x = GetElemSubStruct(current, srcX) & MLIB_MASK; |
| |
| while (((mlib_addr)dp & 7) && (dp < dend)) { |
| cx = x >> MLIB_SHIFT; |
| tt = tsp + 2*cx + cx; |
| dp[0] = tt[0]; |
| dp[1] = tt[1]; |
| dp[2] = tt[2]; |
| x += dx; |
| dp += 3; |
| } |
| |
| x += dx7; |
| |
| #pragma pipeloop(0) |
| for (; dp <= dend - 24; dp += 24) { |
| mlib_d64 s0, s1, s2; |
| |
| cx = x >> MLIB_SHIFT; |
| tt = tsp + 2*cx + cx; |
| x -= dx; |
| s2 = vis_faligndata(vis_ld_u8_i(tt, 2), s2); |
| s2 = vis_faligndata(vis_ld_u8_i(tt, 1), s2); |
| s2 = vis_faligndata(vis_ld_u8_i(tt, 0), s2); |
| |
| cx = x >> MLIB_SHIFT; |
| tt = tsp + 2*cx + cx; |
| x -= dx; |
| s2 = vis_faligndata(vis_ld_u8_i(tt, 2), s2); |
| s2 = vis_faligndata(vis_ld_u8_i(tt, 1), s2); |
| s2 = vis_faligndata(vis_ld_u8_i(tt, 0), s2); |
| |
| cx = x >> MLIB_SHIFT; |
| tt = tsp + 2*cx + cx; |
| x -= dx; |
| s2 = vis_faligndata(vis_ld_u8_i(tt, 2), s2); |
| s2 = vis_faligndata(vis_ld_u8_i(tt, 1), s2); |
| s1 = vis_faligndata(vis_ld_u8_i(tt, 0), s1); |
| |
| cx = x >> MLIB_SHIFT; |
| tt = tsp + 2*cx + cx; |
| x -= dx; |
| s1 = vis_faligndata(vis_ld_u8_i(tt, 2), s1); |
| s1 = vis_faligndata(vis_ld_u8_i(tt, 1), s1); |
| s1 = vis_faligndata(vis_ld_u8_i(tt, 0), s1); |
| |
| cx = x >> MLIB_SHIFT; |
| tt = tsp + 2*cx + cx; |
| x -= dx; |
| s1 = vis_faligndata(vis_ld_u8_i(tt, 2), s1); |
| s1 = vis_faligndata(vis_ld_u8_i(tt, 1), s1); |
| s1 = vis_faligndata(vis_ld_u8_i(tt, 0), s1); |
| |
| cx = x >> MLIB_SHIFT; |
| tt = tsp + 2*cx + cx; |
| x -= dx; |
| s1 = vis_faligndata(vis_ld_u8_i(tt, 2), s1); |
| s0 = vis_faligndata(vis_ld_u8_i(tt, 1), s0); |
| s0 = vis_faligndata(vis_ld_u8_i(tt, 0), s0); |
| |
| cx = x >> MLIB_SHIFT; |
| tt = tsp + 2*cx + cx; |
| x -= dx; |
| s0 = vis_faligndata(vis_ld_u8_i(tt, 2), s0); |
| s0 = vis_faligndata(vis_ld_u8_i(tt, 1), s0); |
| s0 = vis_faligndata(vis_ld_u8_i(tt, 0), s0); |
| |
| cx = x >> MLIB_SHIFT; |
| tt = tsp + 2*cx + cx; |
| x += dx15; |
| s0 = vis_faligndata(vis_ld_u8_i(tt, 2), s0); |
| s0 = vis_faligndata(vis_ld_u8_i(tt, 1), s0); |
| s0 = vis_faligndata(vis_ld_u8_i(tt, 0), s0); |
| |
| ((mlib_d64*)dp)[0] = s0; |
| ((mlib_d64*)dp)[1] = s1; |
| ((mlib_d64*)dp)[2] = s2; |
| } |
| |
| x -= dx7; |
| |
| while (dp < dend) { |
| cx = x >> MLIB_SHIFT; |
| tt = tsp + 2*cx + cx; |
| dp[0] = tt[0]; |
| dp[1] = tt[1]; |
| dp[2] = tt[2]; |
| x += dx; |
| dp += 3; |
| } |
| } |
| |
| y0 = y; |
| y += dy; |
| dl = (void*)((mlib_u8*)dl + dst_stride); |
| tsp = (void*)((mlib_u8*)sp + (y >> MLIB_SHIFT) * src_stride); |
| } |
| |
| return MLIB_SUCCESS; |
| } |
| |
| /***************************************************************/ |
| |
| mlib_status mlib_ImageZoom_S16_3_Nearest(mlib_work_image *param) |
| { |
| VARIABLE(mlib_s16); |
| mlib_s16 *dl = dp, *tsp, *tt; |
| mlib_s32 cx, y0 = -1, dx3 = 3*dx, dx7 = 4*dx + dx3; |
| |
| tsp = sp; |
| y = GetElemSubStruct(current, srcY) & MLIB_MASK; |
| |
| for (j = 0; j < height; j++) { |
| |
| if ((y0 >> MLIB_SHIFT) == (y >> MLIB_SHIFT)) { |
| mlib_ImageCopy_na((void*)((mlib_u8*)dl - dst_stride), (void*)dl, 6*width); |
| } |
| else { |
| mlib_s16 *dp = dl, *dend = dl + 3*width; |
| |
| vis_write_gsr(6); |
| x = GetElemSubStruct(current, srcX) & MLIB_MASK; |
| |
| while (((mlib_addr)dp & 7) && (dp < dend)) { |
| cx = x >> MLIB_SHIFT; |
| tt = tsp + 2*cx + cx; |
| dp[0] = tt[0]; |
| dp[1] = tt[1]; |
| dp[2] = tt[2]; |
| x += dx; |
| dp += 3; |
| } |
| |
| x += dx3; |
| |
| #pragma pipeloop(0) |
| for (; dp <= dend - 12; dp += 12) { |
| mlib_d64 s0, s1, s2; |
| |
| cx = x >> MLIB_SHIFT; |
| tt = tsp + 2*cx + cx; |
| x -= dx; |
| s2 = vis_faligndata(vis_ld_u16_i(tt, 4), s2); |
| s2 = vis_faligndata(vis_ld_u16_i(tt, 2), s2); |
| s2 = vis_faligndata(vis_ld_u16_i(tt, 0), s2); |
| |
| cx = x >> MLIB_SHIFT; |
| tt = tsp + 2*cx + cx; |
| x -= dx; |
| s2 = vis_faligndata(vis_ld_u16_i(tt, 4), s2); |
| s1 = vis_faligndata(vis_ld_u16_i(tt, 2), s1); |
| s1 = vis_faligndata(vis_ld_u16_i(tt, 0), s1); |
| |
| cx = x >> MLIB_SHIFT; |
| tt = tsp + 2*cx + cx; |
| x -= dx; |
| s1 = vis_faligndata(vis_ld_u16_i(tt, 4), s1); |
| s1 = vis_faligndata(vis_ld_u16_i(tt, 2), s1); |
| s0 = vis_faligndata(vis_ld_u16_i(tt, 0), s0); |
| |
| cx = x >> MLIB_SHIFT; |
| tt = tsp + 2*cx + cx; |
| x += dx7; |
| s0 = vis_faligndata(vis_ld_u16_i(tt, 4), s0); |
| s0 = vis_faligndata(vis_ld_u16_i(tt, 2), s0); |
| s0 = vis_faligndata(vis_ld_u16_i(tt, 0), s0); |
| |
| ((mlib_d64*)dp)[0] = s0; |
| ((mlib_d64*)dp)[1] = s1; |
| ((mlib_d64*)dp)[2] = s2; |
| } |
| |
| x -= dx3; |
| |
| while (dp < dend) { |
| cx = x >> MLIB_SHIFT; |
| tt = tsp + 2*cx + cx; |
| dp[0] = tt[0]; |
| dp[1] = tt[1]; |
| dp[2] = tt[2]; |
| x += dx; |
| dp += 3; |
| } |
| } |
| |
| y0 = y; |
| y += dy; |
| dl = (void*)((mlib_u8*)dl + dst_stride); |
| tsp = (void*)((mlib_u8*)sp + (y >> MLIB_SHIFT) * src_stride); |
| } |
| |
| return MLIB_SUCCESS; |
| } |
| |
| /***************************************************************/ |
| |
| mlib_status mlib_ImageZoom_S16_1_Nearest(mlib_work_image *param) |
| { |
| VARIABLE(mlib_u16); |
| mlib_u16 *dl = dp, *tsp; |
| mlib_s32 y0 = -1, dx3 = 3*dx, dx7 = 4*dx + dx3; |
| |
| tsp = sp; |
| y = GetElemSubStruct(current, srcY) & MLIB_MASK; |
| |
| for (j = 0; j < height; j++) { |
| |
| if ((y0 >> MLIB_SHIFT) == (y >> MLIB_SHIFT)) { |
| mlib_ImageCopy_na((void*)((mlib_u8*)dl - dst_stride), (void*)dl, 2*width); |
| } |
| else { |
| mlib_u16 *dp = dl, *dend = dl + width; |
| |
| vis_write_gsr(6); |
| x = GetElemSubStruct(current, srcX) & MLIB_MASK; |
| |
| while (((mlib_addr)dp & 7) && (dp < dend)) { |
| *dp++ = tsp[x >> MLIB_SHIFT]; |
| x += dx; |
| } |
| |
| x += dx3; |
| |
| #pragma pipeloop(0) |
| for (; dp <= dend - 4; dp += 4) { |
| mlib_d64 s0; |
| |
| s0 = vis_faligndata(vis_ld_u16_i(tsp, (x >> (MLIB_SHIFT - 1)) &~ 1), s0); |
| x -= dx; |
| s0 = vis_faligndata(vis_ld_u16_i(tsp, (x >> (MLIB_SHIFT - 1)) &~ 1), s0); |
| x -= dx; |
| s0 = vis_faligndata(vis_ld_u16_i(tsp, (x >> (MLIB_SHIFT - 1)) &~ 1), s0); |
| x -= dx; |
| s0 = vis_faligndata(vis_ld_u16_i(tsp, (x >> (MLIB_SHIFT - 1)) &~ 1), s0); |
| x += dx7; |
| |
| *(mlib_d64*)dp = s0; |
| } |
| |
| x -= dx3; |
| |
| while (dp < dend) { |
| *dp++ = tsp[x >> MLIB_SHIFT]; |
| x += dx; |
| } |
| } |
| |
| y0 = y; |
| y += dy; |
| dl = (void*)((mlib_u8*)dl + dst_stride); |
| tsp = (void*)((mlib_u8*)sp + (y >> MLIB_SHIFT) * src_stride); |
| } |
| |
| return MLIB_SUCCESS; |
| } |
| |
| /***************************************************************/ |
