2
|
1 |
/*
|
5506
|
2 |
* Copyright (c) 2003, Oracle and/or its affiliates. All rights reserved.
|
2
|
3 |
* DO NOT ALTER OR REMOVE COPYRIGHT NOTICES OR THIS FILE HEADER.
|
|
4 |
*
|
|
5 |
* This code is free software; you can redistribute it and/or modify it
|
|
6 |
* under the terms of the GNU General Public License version 2 only, as
|
5506
|
7 |
* published by the Free Software Foundation. Oracle designates this
|
2
|
8 |
* particular file as subject to the "Classpath" exception as provided
|
5506
|
9 |
* by Oracle in the LICENSE file that accompanied this code.
|
2
|
10 |
*
|
|
11 |
* This code is distributed in the hope that it will be useful, but WITHOUT
|
|
12 |
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
13 |
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
|
|
14 |
* version 2 for more details (a copy is included in the LICENSE file that
|
|
15 |
* accompanied this code).
|
|
16 |
*
|
|
17 |
* You should have received a copy of the GNU General Public License version
|
|
18 |
* 2 along with this work; if not, write to the Free Software Foundation,
|
|
19 |
* Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA.
|
|
20 |
*
|
5506
|
21 |
* Please contact Oracle, 500 Oracle Parkway, Redwood Shores, CA 94065 USA
|
|
22 |
* or visit www.oracle.com if you need additional information or have any
|
|
23 |
* questions.
|
2
|
24 |
*/
|
|
25 |
|
|
26 |
|
|
27 |
/*
|
|
28 |
* FUNCTION
|
|
29 |
* Internal functions for mlib_ImageAffine with bilinear filtering.
|
|
30 |
*/
|
|
31 |
|
|
32 |
#include "mlib_ImageAffine.h"
|
|
33 |
|
|
34 |
/***************************************************************/
|
|
35 |
#define DTYPE mlib_d64
|
|
36 |
#define FTYPE DTYPE
|
|
37 |
|
|
38 |
#define FUN_NAME(CHAN) mlib_ImageAffine_d64_##CHAN##_bl
|
|
39 |
|
|
40 |
/***************************************************************/
|
|
41 |
mlib_status FUN_NAME(1ch)(mlib_affine_param *param)
|
|
42 |
{
|
|
43 |
DECLAREVAR_BL();
|
|
44 |
DTYPE *dstLineEnd;
|
|
45 |
FTYPE scale = ONE / MLIB_PREC;
|
|
46 |
mlib_s32 srcYStride1;
|
|
47 |
|
|
48 |
srcYStride /= sizeof(DTYPE);
|
|
49 |
srcYStride1 = srcYStride + 1;
|
|
50 |
|
|
51 |
for (j = yStart; j <= yFinish; j++) {
|
|
52 |
FTYPE t, u, k0, k1, k2, k3;
|
|
53 |
FTYPE a00_0, a01_0, a10_0, a11_0;
|
|
54 |
FTYPE pix0;
|
|
55 |
|
|
56 |
CLIP(1);
|
|
57 |
dstLineEnd = (DTYPE *) dstData + xRight;
|
|
58 |
|
|
59 |
t = (X & MLIB_MASK) * scale;
|
|
60 |
u = (Y & MLIB_MASK) * scale;
|
|
61 |
ySrc = MLIB_POINTER_SHIFT(Y);
|
|
62 |
Y += dY;
|
|
63 |
xSrc = X >> MLIB_SHIFT;
|
|
64 |
X += dX;
|
|
65 |
srcPixelPtr = MLIB_POINTER_GET(lineAddr, ySrc) + xSrc;
|
|
66 |
k3 = t * u;
|
|
67 |
k2 = (ONE - t) * u;
|
|
68 |
k1 = t * (ONE - u);
|
|
69 |
k0 = (ONE - t) * (ONE - u);
|
|
70 |
a00_0 = srcPixelPtr[0];
|
|
71 |
a01_0 = srcPixelPtr[1];
|
|
72 |
a10_0 = srcPixelPtr[srcYStride];
|
|
73 |
a11_0 = srcPixelPtr[srcYStride1];
|
|
74 |
|
|
75 |
for (; dstPixelPtr < dstLineEnd; dstPixelPtr++) {
|
|
76 |
pix0 = k0 * a00_0 + k1 * a01_0 + k2 * a10_0 + k3 * a11_0;
|
|
77 |
t = (X & MLIB_MASK) * scale;
|
|
78 |
u = (Y & MLIB_MASK) * scale;
|
|
79 |
ySrc = MLIB_POINTER_SHIFT(Y);
|
|
80 |
Y += dY;
|
|
81 |
xSrc = X >> MLIB_SHIFT;
|
|
82 |
X += dX;
|
|
83 |
srcPixelPtr = *(DTYPE **) ((mlib_u8 *) lineAddr + ySrc) + xSrc;
|
|
84 |
k3 = t * u;
|
|
85 |
k2 = (ONE - t) * u;
|
|
86 |
k1 = t * (ONE - u);
|
|
87 |
k0 = (ONE - t) * (ONE - u);
|
|
88 |
a00_0 = srcPixelPtr[0];
|
|
89 |
a01_0 = srcPixelPtr[1];
|
|
90 |
a10_0 = srcPixelPtr[srcYStride];
|
|
91 |
a11_0 = srcPixelPtr[srcYStride1];
|
|
92 |
dstPixelPtr[0] = pix0;
|
|
93 |
}
|
|
94 |
|
|
95 |
pix0 = k0 * a00_0 + k1 * a01_0 + k2 * a10_0 + k3 * a11_0;
|
|
96 |
dstPixelPtr[0] = pix0;
|
|
97 |
}
|
|
98 |
|
|
99 |
return MLIB_SUCCESS;
|
|
100 |
}
|
|
101 |
|
|
102 |
/***************************************************************/
|
|
103 |
mlib_status FUN_NAME(2ch)(mlib_affine_param *param)
|
|
104 |
{
|
|
105 |
DECLAREVAR_BL();
|
|
106 |
DTYPE *dstLineEnd;
|
|
107 |
FTYPE scale = ONE / MLIB_PREC;
|
|
108 |
|
|
109 |
for (j = yStart; j <= yFinish; j++) {
|
|
110 |
DTYPE *srcPixelPtr2;
|
|
111 |
FTYPE t, u, k0, k1, k2, k3;
|
|
112 |
FTYPE a00_0, a01_0, a10_0, a11_0;
|
|
113 |
FTYPE a00_1, a01_1, a10_1, a11_1;
|
|
114 |
FTYPE pix0, pix1;
|
|
115 |
|
|
116 |
CLIP(2);
|
|
117 |
dstLineEnd = (DTYPE *) dstData + 2 * xRight;
|
|
118 |
|
|
119 |
t = (X & MLIB_MASK) * scale;
|
|
120 |
u = (Y & MLIB_MASK) * scale;
|
|
121 |
ySrc = MLIB_POINTER_SHIFT(Y);
|
|
122 |
Y += dY;
|
|
123 |
xSrc = X >> MLIB_SHIFT;
|
|
124 |
X += dX;
|
|
125 |
srcPixelPtr = MLIB_POINTER_GET(lineAddr, ySrc) + 2 * xSrc;
|
|
126 |
srcPixelPtr2 = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);
|
|
127 |
k3 = t * u;
|
|
128 |
k2 = (ONE - t) * u;
|
|
129 |
k1 = t * (ONE - u);
|
|
130 |
k0 = (ONE - t) * (ONE - u);
|
|
131 |
a00_0 = srcPixelPtr[0];
|
|
132 |
a00_1 = srcPixelPtr[1];
|
|
133 |
a01_0 = srcPixelPtr[2];
|
|
134 |
a01_1 = srcPixelPtr[3];
|
|
135 |
a10_0 = srcPixelPtr2[0];
|
|
136 |
a10_1 = srcPixelPtr2[1];
|
|
137 |
a11_0 = srcPixelPtr2[2];
|
|
138 |
a11_1 = srcPixelPtr2[3];
|
|
139 |
|
|
140 |
for (; dstPixelPtr < dstLineEnd; dstPixelPtr += 2) {
|
|
141 |
pix0 = k0 * a00_0 + k1 * a01_0 + k2 * a10_0 + k3 * a11_0;
|
|
142 |
pix1 = k0 * a00_1 + k1 * a01_1 + k2 * a10_1 + k3 * a11_1;
|
|
143 |
t = (X & MLIB_MASK) * scale;
|
|
144 |
u = (Y & MLIB_MASK) * scale;
|
|
145 |
ySrc = MLIB_POINTER_SHIFT(Y);
|
|
146 |
Y += dY;
|
|
147 |
xSrc = X >> MLIB_SHIFT;
|
|
148 |
X += dX;
|
|
149 |
srcPixelPtr = MLIB_POINTER_GET(lineAddr, ySrc) + 2 * xSrc;
|
|
150 |
srcPixelPtr2 = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);
|
|
151 |
k3 = t * u;
|
|
152 |
k2 = (ONE - t) * u;
|
|
153 |
k1 = t * (ONE - u);
|
|
154 |
k0 = (ONE - t) * (ONE - u);
|
|
155 |
a01_0 = srcPixelPtr[2];
|
|
156 |
a01_1 = srcPixelPtr[3];
|
|
157 |
a00_0 = srcPixelPtr[0];
|
|
158 |
a00_1 = srcPixelPtr[1];
|
|
159 |
a10_0 = srcPixelPtr2[0];
|
|
160 |
a10_1 = srcPixelPtr2[1];
|
|
161 |
a11_0 = srcPixelPtr2[2];
|
|
162 |
a11_1 = srcPixelPtr2[3];
|
|
163 |
dstPixelPtr[0] = pix0;
|
|
164 |
dstPixelPtr[1] = pix1;
|
|
165 |
}
|
|
166 |
|
|
167 |
pix0 = k0 * a00_0 + k1 * a01_0 + k2 * a10_0 + k3 * a11_0;
|
|
168 |
pix1 = k0 * a00_1 + k1 * a01_1 + k2 * a10_1 + k3 * a11_1;
|
|
169 |
dstPixelPtr[0] = pix0;
|
|
170 |
dstPixelPtr[1] = pix1;
|
|
171 |
}
|
|
172 |
|
|
173 |
return MLIB_SUCCESS;
|
|
174 |
}
|
|
175 |
|
|
176 |
/***************************************************************/
|
|
177 |
mlib_status FUN_NAME(3ch)(mlib_affine_param *param)
|
|
178 |
{
|
|
179 |
DECLAREVAR_BL();
|
|
180 |
DTYPE *dstLineEnd;
|
|
181 |
FTYPE scale = ONE / MLIB_PREC;
|
|
182 |
|
|
183 |
for (j = yStart; j <= yFinish; j++) {
|
|
184 |
DTYPE *srcPixelPtr2;
|
|
185 |
FTYPE t, u, k0, k1, k2, k3;
|
|
186 |
FTYPE a00_0, a01_0, a10_0, a11_0;
|
|
187 |
FTYPE a00_1, a01_1, a10_1, a11_1;
|
|
188 |
FTYPE a00_2, a01_2, a10_2, a11_2;
|
|
189 |
FTYPE pix0, pix1, pix2;
|
|
190 |
|
|
191 |
CLIP(3);
|
|
192 |
dstLineEnd = (DTYPE *) dstData + 3 * xRight;
|
|
193 |
|
|
194 |
t = (X & MLIB_MASK) * scale;
|
|
195 |
u = (Y & MLIB_MASK) * scale;
|
|
196 |
ySrc = MLIB_POINTER_SHIFT(Y);
|
|
197 |
Y += dY;
|
|
198 |
xSrc = X >> MLIB_SHIFT;
|
|
199 |
X += dX;
|
|
200 |
srcPixelPtr = MLIB_POINTER_GET(lineAddr, ySrc) + 3 * xSrc;
|
|
201 |
srcPixelPtr2 = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);
|
|
202 |
k3 = t * u;
|
|
203 |
k2 = (ONE - t) * u;
|
|
204 |
k1 = t * (ONE - u);
|
|
205 |
k0 = (ONE - t) * (ONE - u);
|
|
206 |
a00_0 = srcPixelPtr[0];
|
|
207 |
a00_1 = srcPixelPtr[1];
|
|
208 |
a00_2 = srcPixelPtr[2];
|
|
209 |
a01_0 = srcPixelPtr[3];
|
|
210 |
a01_1 = srcPixelPtr[4];
|
|
211 |
a01_2 = srcPixelPtr[5];
|
|
212 |
a10_0 = srcPixelPtr2[0];
|
|
213 |
a10_1 = srcPixelPtr2[1];
|
|
214 |
a10_2 = srcPixelPtr2[2];
|
|
215 |
a11_0 = srcPixelPtr2[3];
|
|
216 |
a11_1 = srcPixelPtr2[4];
|
|
217 |
a11_2 = srcPixelPtr2[5];
|
|
218 |
|
|
219 |
for (; dstPixelPtr < dstLineEnd; dstPixelPtr += 3) {
|
|
220 |
pix0 = k0 * a00_0 + k1 * a01_0 + k2 * a10_0 + k3 * a11_0;
|
|
221 |
pix1 = k0 * a00_1 + k1 * a01_1 + k2 * a10_1 + k3 * a11_1;
|
|
222 |
pix2 = k0 * a00_2 + k1 * a01_2 + k2 * a10_2 + k3 * a11_2;
|
|
223 |
t = (X & MLIB_MASK) * scale;
|
|
224 |
u = (Y & MLIB_MASK) * scale;
|
|
225 |
ySrc = MLIB_POINTER_SHIFT(Y);
|
|
226 |
Y += dY;
|
|
227 |
xSrc = X >> MLIB_SHIFT;
|
|
228 |
X += dX;
|
|
229 |
srcPixelPtr = MLIB_POINTER_GET(lineAddr, ySrc) + 3 * xSrc;
|
|
230 |
srcPixelPtr2 = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);
|
|
231 |
k3 = t * u;
|
|
232 |
k2 = (ONE - t) * u;
|
|
233 |
k1 = t * (ONE - u);
|
|
234 |
k0 = (ONE - t) * (ONE - u);
|
|
235 |
a01_0 = srcPixelPtr[3];
|
|
236 |
a01_1 = srcPixelPtr[4];
|
|
237 |
a01_2 = srcPixelPtr[5];
|
|
238 |
a00_0 = srcPixelPtr[0];
|
|
239 |
a00_1 = srcPixelPtr[1];
|
|
240 |
a00_2 = srcPixelPtr[2];
|
|
241 |
a10_0 = srcPixelPtr2[0];
|
|
242 |
a10_1 = srcPixelPtr2[1];
|
|
243 |
a10_2 = srcPixelPtr2[2];
|
|
244 |
a11_0 = srcPixelPtr2[3];
|
|
245 |
a11_1 = srcPixelPtr2[4];
|
|
246 |
a11_2 = srcPixelPtr2[5];
|
|
247 |
dstPixelPtr[0] = pix0;
|
|
248 |
dstPixelPtr[1] = pix1;
|
|
249 |
dstPixelPtr[2] = pix2;
|
|
250 |
}
|
|
251 |
|
|
252 |
pix0 = k0 * a00_0 + k1 * a01_0 + k2 * a10_0 + k3 * a11_0;
|
|
253 |
pix1 = k0 * a00_1 + k1 * a01_1 + k2 * a10_1 + k3 * a11_1;
|
|
254 |
pix2 = k0 * a00_2 + k1 * a01_2 + k2 * a10_2 + k3 * a11_2;
|
|
255 |
dstPixelPtr[0] = pix0;
|
|
256 |
dstPixelPtr[1] = pix1;
|
|
257 |
dstPixelPtr[2] = pix2;
|
|
258 |
}
|
|
259 |
|
|
260 |
return MLIB_SUCCESS;
|
|
261 |
}
|
|
262 |
|
|
263 |
/***************************************************************/
|
|
264 |
mlib_status FUN_NAME(4ch)(mlib_affine_param *param)
|
|
265 |
{
|
|
266 |
DECLAREVAR_BL();
|
|
267 |
DTYPE *dstLineEnd;
|
|
268 |
FTYPE scale = ONE / MLIB_PREC;
|
|
269 |
|
|
270 |
for (j = yStart; j <= yFinish; j++) {
|
|
271 |
DTYPE *srcPixelPtr2;
|
|
272 |
FTYPE t, u, k0, k1, k2, k3;
|
|
273 |
FTYPE a00_0, a01_0, a10_0, a11_0;
|
|
274 |
FTYPE a00_1, a01_1, a10_1, a11_1;
|
|
275 |
FTYPE a00_2, a01_2, a10_2, a11_2;
|
|
276 |
FTYPE a00_3, a01_3, a10_3, a11_3;
|
|
277 |
FTYPE pix0, pix1, pix2, pix3;
|
|
278 |
|
|
279 |
CLIP(4);
|
|
280 |
dstLineEnd = (DTYPE *) dstData + 4 * xRight;
|
|
281 |
|
|
282 |
t = (X & MLIB_MASK) * scale;
|
|
283 |
u = (Y & MLIB_MASK) * scale;
|
|
284 |
ySrc = MLIB_POINTER_SHIFT(Y);
|
|
285 |
Y += dY;
|
|
286 |
xSrc = X >> MLIB_SHIFT;
|
|
287 |
X += dX;
|
|
288 |
srcPixelPtr = MLIB_POINTER_GET(lineAddr, ySrc) + 4 * xSrc;
|
|
289 |
srcPixelPtr2 = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);
|
|
290 |
k3 = t * u;
|
|
291 |
k2 = (ONE - t) * u;
|
|
292 |
k1 = t * (ONE - u);
|
|
293 |
k0 = (ONE - t) * (ONE - u);
|
|
294 |
a00_0 = srcPixelPtr[0];
|
|
295 |
a00_1 = srcPixelPtr[1];
|
|
296 |
a00_2 = srcPixelPtr[2];
|
|
297 |
a00_3 = srcPixelPtr[3];
|
|
298 |
a01_0 = srcPixelPtr[4];
|
|
299 |
a01_1 = srcPixelPtr[5];
|
|
300 |
a01_2 = srcPixelPtr[6];
|
|
301 |
a01_3 = srcPixelPtr[7];
|
|
302 |
a10_0 = srcPixelPtr2[0];
|
|
303 |
a10_1 = srcPixelPtr2[1];
|
|
304 |
a10_2 = srcPixelPtr2[2];
|
|
305 |
a10_3 = srcPixelPtr2[3];
|
|
306 |
a11_0 = srcPixelPtr2[4];
|
|
307 |
a11_1 = srcPixelPtr2[5];
|
|
308 |
a11_2 = srcPixelPtr2[6];
|
|
309 |
a11_3 = srcPixelPtr2[7];
|
|
310 |
|
|
311 |
for (; dstPixelPtr < dstLineEnd; dstPixelPtr += 4) {
|
|
312 |
pix0 = k0 * a00_0 + k1 * a01_0 + k2 * a10_0 + k3 * a11_0;
|
|
313 |
pix1 = k0 * a00_1 + k1 * a01_1 + k2 * a10_1 + k3 * a11_1;
|
|
314 |
pix2 = k0 * a00_2 + k1 * a01_2 + k2 * a10_2 + k3 * a11_2;
|
|
315 |
pix3 = k0 * a00_3 + k1 * a01_3 + k2 * a10_3 + k3 * a11_3;
|
|
316 |
t = (X & MLIB_MASK) * scale;
|
|
317 |
u = (Y & MLIB_MASK) * scale;
|
|
318 |
ySrc = MLIB_POINTER_SHIFT(Y);
|
|
319 |
Y += dY;
|
|
320 |
xSrc = X >> (MLIB_SHIFT - 2);
|
|
321 |
X += dX;
|
|
322 |
srcPixelPtr = MLIB_POINTER_GET(lineAddr, ySrc) + (xSrc & ~3);
|
|
323 |
srcPixelPtr2 = (DTYPE *) ((mlib_u8 *) srcPixelPtr + srcYStride);
|
|
324 |
k3 = t * u;
|
|
325 |
k2 = (ONE - t) * u;
|
|
326 |
k1 = t * (ONE - u);
|
|
327 |
k0 = (ONE - t) * (ONE - u);
|
|
328 |
a00_3 = srcPixelPtr[3];
|
|
329 |
a01_3 = srcPixelPtr[7];
|
|
330 |
a10_3 = srcPixelPtr2[3];
|
|
331 |
a11_3 = srcPixelPtr2[7];
|
|
332 |
a00_0 = srcPixelPtr[0];
|
|
333 |
a00_1 = srcPixelPtr[1];
|
|
334 |
a00_2 = srcPixelPtr[2];
|
|
335 |
a01_0 = srcPixelPtr[4];
|
|
336 |
a01_1 = srcPixelPtr[5];
|
|
337 |
a01_2 = srcPixelPtr[6];
|
|
338 |
a10_0 = srcPixelPtr2[0];
|
|
339 |
a10_1 = srcPixelPtr2[1];
|
|
340 |
a10_2 = srcPixelPtr2[2];
|
|
341 |
a11_0 = srcPixelPtr2[4];
|
|
342 |
a11_1 = srcPixelPtr2[5];
|
|
343 |
a11_2 = srcPixelPtr2[6];
|
|
344 |
dstPixelPtr[0] = pix0;
|
|
345 |
dstPixelPtr[1] = pix1;
|
|
346 |
dstPixelPtr[2] = pix2;
|
|
347 |
dstPixelPtr[3] = pix3;
|
|
348 |
}
|
|
349 |
|
|
350 |
pix0 = k0 * a00_0 + k1 * a01_0 + k2 * a10_0 + k3 * a11_0;
|
|
351 |
pix1 = k0 * a00_1 + k1 * a01_1 + k2 * a10_1 + k3 * a11_1;
|
|
352 |
pix2 = k0 * a00_2 + k1 * a01_2 + k2 * a10_2 + k3 * a11_2;
|
|
353 |
pix3 = k0 * a00_3 + k1 * a01_3 + k2 * a10_3 + k3 * a11_3;
|
|
354 |
dstPixelPtr[0] = pix0;
|
|
355 |
dstPixelPtr[1] = pix1;
|
|
356 |
dstPixelPtr[2] = pix2;
|
|
357 |
dstPixelPtr[3] = pix3;
|
|
358 |
}
|
|
359 |
|
|
360 |
return MLIB_SUCCESS;
|
|
361 |
}
|
|
362 |
|
|
363 |
/***************************************************************/
|